a
    ¬ˆc:y  ã                   @   sÌ   d dl Z d dlZd dlmZ d dlZd dlmZ d dlm	Z	 d dlm
Z
mZ d dlmZmZ d dlmZmZmZ d dlmZ d	d
„ ZG dd„ dƒZdd„ Zdd„ Zdd„ Zdd„ Zdd„ ZG dd„ dƒZdS )é    N)Úassert_array_almost_equal)Úraises)Úsolve_sylvester)Úsolve_continuous_lyapunovÚsolve_discrete_lyapunov)Úsolve_continuous_areÚsolve_discrete_are)Ú
block_diagÚsolveÚLinAlgError)Úmatrixc                 C   sZ   t j t j t j t¡¡d| ¡}t |¡�}t| 	¡ ƒW  d  ƒ S 1 sL0    Y  dS )zo
    Load npz data file under data/
    Returns a copy of the data, rather than keeping the npz file open.
    ÚdataN)
ÚosÚpathÚjoinÚabspathÚdirnameÚ__file__ÚnpÚloadÚdictÚitems)ÚnameÚfilenameÚf© r   úb/home/yuhw/wc/wire-cell-python/wcpy/lib/python3.9/site-packages/scipy/linalg/tests/test_solvers.pyÚ
_load_data   s
    ÿr   c                   @   sâ  e Zd Ze ddgddgg¡e ddgddgg¡fe d	d
gddgg¡e ddgdd
gg¡fe dd
gddgg¡e ddgdd
gg¡fe d	d
gddgg¡e d
d
gdd
gg¡fe g d¢g d¢g d¢g d¢g d¢g¡e g d¢g d¢g d¢g d¢g d¢g¡fe g d¢g d¢g d¢g d ¢g d!¢g d"¢g d#¢g d$¢g d%¢g d&¢g d'¢g¡e d¡fed(dgd)d*ggƒed(dgƒjed(dgƒjj fed(dgd)d*ggƒe ed(dgƒjed(dgƒjj ¡fgZd+d,„ Z	d-d.„ Z
d4d0d1„Zd2d3„ Zd/S )5ÚTestSolveLyapunové   é   é   é   é	   é
   é   é   ù      ð?      ð?ç       @ù      @      Àç      @ù       @       Àù       @       @ù      ð¿      ð¿ç      ð?ç      @ç      ð¿)r!   r#   é   r   r"   )r   r    r!   é   r"   )r"   é   r3   r3   r!   )r   r1   r    r   é   )r1   r!   r!   r   r1   )r    r"   r   r   r   )r"   r   r   r    r   )r   r   r!   r   r!   )r   r    r   r   r   )r   r   r!   r   r"   )yš™™™™™¹?        y²�ï§ÆK·?        yË¡E¶óý´?        yã¥›Ä °²?        yü©ñÒMb°?        y)\�Âõ(¬?        yZd;ßO�§?        y‹lçû©ñ¢?        yyé&1¬œ?        yÛù~j¼t“?        y{®Gáz„?        )ù      ð?        ù                r6   r6   r6   r6   r6   r6   r6   r6   r6   )r6   r5   r6   r6   r6   r6   r6   r6   r6   r6   r6   )r6   r6   r5   r6   r6   r6   r6   r6   r6   r6   r6   )r6   r6   r6   r5   r6   r6   r6   r6   r6   r6   r6   )r6   r6   r6   r6   r5   r6   r6   r6   r6   r6   r6   )r6   r6   r6   r6   r6   r5   r6   r6   r6   r6   r6   )r6   r6   r6   r6   r6   r6   r5   r6   r6   r6   r6   )r6   r6   r6   r6   r6   r6   r6   r5   r6   r6   r6   )r6   r6   r6   r6   r6   r6   r6   r6   r5   r6   r6   )r6   r6   r6   r6   r6   r6   r6   r6   r6   r5   r6   r   g      à¿éÿÿÿÿc                 C   sH   t  d¡}t  d¡}ttt||ƒ ttt||ƒ ttt|t  d¡ƒ d S )N©r!   r    r!   r    )r   ÚonesÚeyeÚassert_raisesÚ
ValueErrorr   )ÚselfÚnsqÚsqr   r   r   Ú$test_continuous_squareness_and_shapeX   s
    

z6TestSolveLyapunov.test_continuous_squareness_and_shapec                 C   s4   t ||ƒ}tt ||¡t || ¡  ¡ ¡ |ƒ d S ©N)r   r   r   ÚdotÚconjÚ	transpose)r=   ÚaÚqÚxr   r   r   Úcheck_continuous_case_   s    
 ÿz'TestSolveLyapunov.check_continuous_caseNc                 C   s<   t |||d�}tt t ||¡| ¡  ¡ ¡| d| ƒ d S )N©Úmethodr0   )r   r   r   rB   rC   rD   )r=   rE   rF   rJ   rG   r   r   r   Úcheck_discrete_cased   s    $ÿz%TestSolveLyapunov.check_discrete_casec                 C   sh   | j D ]\}|  |d |d ¡ |  |d |d ¡ | j|d |d dd� | j|d |d dd� qd S )Nr   r   ÚdirectrI   Zbilinear)ÚcasesrH   rK   ©r=   Úcaser   r   r   Ú
test_casesi   s
    
zTestSolveLyapunov.test_cases)N)Ú__name__Ú
__module__Ú__qualname__r   Úarrayr:   r   ÚTrM   r@   rH   rK   rP   r   r   r   r   r      sX   ÿÿÿÿÿÿþ
â!ß#ÿ"ÿÈ<
r   c            
      C   s–  t dƒ} t dƒ}t dƒ}t dƒ}t dƒ}t dgd¡t dgdgg¡tdd	ƒdd ft d
dgddgg¡t dgdgg¡t ddgddgg¡dd ft g d¢g d¢g d¢g d¢g¡t ddgddgddgddgg¡t g d¢g d¢g d¢g d¢g¡t d¡d ft g d ¢g d!¢g d"¢g d#¢g d$¢g d%¢g d&¢g d'¢g¡t g d(¢g d)¢g¡jd* t g d+¢g d,¢g d-¢g d.¢g d/¢g d0¢g d1¢g d2¢g¡t d¡d ft g d3¢g d4¢g d5¢g d6¢g d7¢g d8¢g d9¢g d:¢g d;¢g	¡t g d<¢g d=¢g d>¢g d?¢g d@¢g dA¢g dA¢g dA¢g dA¢g	¡t d¡t d¡d f| dB | dC | dD | dE d ft ddgddFgg¡t dGgdgg¡t dH¡ddIftdJdKƒt dLdMgd*dNgg¡t dOdPgdPdQgg¡t dH¡tdGdƒ d ft ddRgddgg¡t dgdgg¡t d¡dd ft dSdgddSgg¡t d¡t d¡t d¡d ft ddgd
dgg¡t dgdgg¡t dTdUgdUdFgg¡dd ft g dV¢g dW¢g dX¢g¡d t d¡t g dY¢g dZ¢g d[¢g¡ t g d\¢¡¡ t g dY¢g dZ¢g d[¢g¡¡d t d¡dR d]ft g d^¢g d_¢g d`¢g da¢g¡t g db¢g¡jt g dc¢¡dd ft g dd¢g de¢g df¢g dg¢g¡t dh¡t di¡dd f|dB |dC |dD |dE d ftjdjdjddk�t djdj¡dF  t 	tdt 
dl¡dƒ¡ tjdjdjddk� t dj¡t dj¡t dj¡d ft t dm¡d¡t t dnd¡¡t dnd¡t dnd¡j dd]f|dB |dC |dD |dE d f|dB |dC |dD |dE d]f|dB |dC |dD |dE d]fg}do}dpdq„ }t|ƒD ]\}}	||	|| ƒ �qxd S )rNzcarex_6_data.npzzcarex_15_data.npzzcarex_18_data.npzzcarex_19_data.npzzcarex_20_data.npzr.   r   r   r(   r"   r!   ç      Àç      Àr7   r#   r3   ç      @©r   r   r   r   )r   g=
×£p=þ¿gö(\�ÂõØ?g…ëQ¸À)r   gœÄ °rh¡¿g×£p=
×Àgq=
×£p@)gœÄ °rh¡?g/n£¼R¿g®Gáz®ï¿gáz®GáÊ¿g
×£p=
×?gš™™™™™ù¿gffffffî¿gü©ñÒMb ¿g¸…ëQ¸ž?)g/Ý$�@ç7‰A`åÐ@çj¼t“æ?çZd;ßO�—?)rZ   g/Ý$�@ç‘í|?5^ò?çyé&1¬Ô?)r[   r]   gÕxé&1Ô?çé&1¬º?)r\   r^   r_   gsh‘í|?µ?r    )gƒÀÊ¡E¶ï¿g!°rh‘íà?r   r   r   r   r   r   )çNbX9´à?g7‰A`åÐð¿çßO�—nã?r   r   r   r   r   )r   r`   gÙÎ÷Sãñ¿ra   r   r   r   r   )r   r   r`   gøSã¥›Äø¿g`åÐ"Ûùæ?r   r   r   )r   r   r   ç/Ý$�í?g=
×£p=ú¿gÅ °rh‘é?r   r   )r   r   r   r   rb   gð§ÆK7‰û¿g¢E¶óýÔì?r   )r   r   r   r   r   rb   g^ºI+ý¿g¼t“Vð?)r   r   r   r   r   r   rb   gJ+‡ÿ¿)g¸…ëQ¸@rX   gÍÌÌÌÌÌB@ç¤p=
×£@gáz®Gá@g
×£p=
@rc   r/   )g
×£p=
ÀgR¸…ëQÀgffffffÀg�Âõ(\�Àg�Âõ(\�
Àg�Âõ(\�Àg{®GázÀg®Gáz®Àçü©ñÒMbP?)r.   ç        re   re   ç      à?re   re   çš™™™™™¹?)re   r.   re   re   rg   re   re   re   )re   re   r.   re   re   rf   re   re   )re   re   re   r.   re   re   re   re   )rf   rg   re   re   rg   re   re   re   )re   re   rf   re   re   rg   re   re   )re   re   re   re   re   re   rg   re   )rg   re   re   re   re   re   re   rg   )	gú~j¼tÀg{®Gáz@re   re   g-²�ï§ Àre   re   re   g×£p=
×ë?)	g¾Ÿ/Ý$Ö¿gZd;ßO�ï?re   re   g¸…ëQ¸Àre   re   re   g
×£p=
ï?)	g‰A`åÐ¢ÀgªñÒMbÐ.@g-²�ï§FÀre   gÍÌÌÌÌÌÀre   re   re   gq=
×£p@)	g7‰A`åÐ5Àg!°rh‘ÍA@gV-²Õ¿gö(\�ÂõÀgÍÌÌÌÌÌ1Àre   re   re   g�Âõ(\�@)	g+‡NÀgyé&1ŒX@gTã¥›Ä ÀgÃõ(\�ÂÕ?g/Ý$�JÀre   re   re   gffffff4@)	r   r   r   r   ç     €W@çffffffbÀre   gš™™™™™J@re   )	r   r   r   r   r   rh   ri   r   r   )	r   r   r   r   r   çš™™™™™)@re   çš™™™™™?Àr   )	r   r   r   r   rj   re   re   gÍÌÌÌÌÌ2@rk   )ç{®Gáz„?gºI+‡†¿g‡ÙÎ÷SÃ¿)gú~j¼t“h?g/Ý$�•¿re   )g;ßO�—n‚?gh‘í|?5®¿re   )gú~j¼t“˜?g#Ûù~j¼Ä¿re   )gœÄ °rh±?g{®GázÜ¿re   )re   re   re   ÚAÚBÚQÚRç       Àç�íµ ÷Æ°>©r    r    zBad residual accuracygš™™™™™¹¿g{®Gáz”¿rg   re   rl   éd   iè  i'  ç    €„.Ag›ò×  ð?iõÿÿÿéûÿÿÿ)g    ð³ZAç    €„>Ag       €)rw   g    `ãVAç    €„>Á)re   rx   g    ÐSA)r.   rq   rq   )rq   r.   rq   )rq   rq   r.   )rr   r   ru   zBad Residual Accuracy)r   gš™™™™™Ù?r   r   )r   r   g®GázÖ?r   )r   g    €ûÁg     aÁg    €ûA)r   r   r   g    €„.Á)r   r   r   ru   )r   r   r   r   )ç�íµ ÷Æ°¾r   r   r   )r7   ry   r   r   )r   r   rr   r   )r   r   r7   rr   )r"   r   )r"   r"   é@   ©Úk)é>   r}   )é   é   )é   r&   é   r€   r%   r3   Nr1   r4   r€   r€   Nr#   r€   r�   r€   Nr&   NNc           
      S   sŒ   | \}}}}}|rt j|d� t||||ƒ}| |¡| ¡ j |¡ | }| |¡}	||	 tt |¡|	 ¡ jƒ¡8 }t	|t 
|¡|d� dS )z3Checks if 0 = XA + A'X - XB(R)^{-1} B'X + Q is true©Úreason©ÚdecimalN)ÚpytestÚxfailr   rB   rC   rU   r
   r   Ú
atleast_2dr   Ú
zeros_like)
rO   ÚdecrE   ÚbrF   ÚrÚknownfailurerG   ÚresÚout_factr   r   r   Ú_test_factory&  s    
 z0test_solve_continuous_are.<locals>._test_factory)r   r   ÚdiagrT   r	   r:   rU   r9   rB   Zrot90ÚzerosÚflipudÚ	enumerate)
Zmat6Zmat15Zmat18Zmat19Zmat20rM   Úmin_decimalr�   ÚindrO   r   r   r   Útest_solve_continuous_areq   sl   üü
ý 
ýö
ù
ÿþ
ùìøÿ

ø	ëüüüüü
þþÿþþø

ýù	
ýù	"ÿÿûüÿÿ€ ß -r—   c            	      C   s  t  ddgddgg¡t  dgdgg¡t  ddgddgg¡t  dgg¡d ft  ddgddgg¡t  dgdgg¡t  ddgddgg¡t  dgg¡d ft  d	dgddgg¡t  ddgdd	gg¡t  dd
gddgg¡t  ddgdd	gg¡d ft  g d¢g d¢g d¢g¡t  dgdgdgg¡t  d	¡t  d¡d ft  dd	gddgg¡t  dgdgg¡t  ddgddgg¡t  dgg¡d ft  ddgddgg¡t  ddgddgg¡t  ddgddgg¡t  ddgdd	gg¡d ft  ddgddgg¡t  dgdgg¡t  ddgddgg¡t  dgg¡d ft  ddgddgg¡t  ddgddgg¡t  d d gd d!gg¡d" t  dd	gd	dgg¡d ft  ddgddgg¡t  dgdgg¡t  ddgddgg¡t  dgg¡d ft  g d#¢g d$¢g d%¢g d&¢g¡t  d'dgd(d)gd*d+gd,d(gg¡t  g d-¢g d.¢g d/¢g d0¢g¡t  d¡d ft  g d1¢g d2¢g d3¢g d4¢g¡t  d5d6gd7d8gd9d:gd;d<gg¡t  d¡d= t  d¡d ft  g d>¢g d?¢g d@¢g dA¢g¡t  g dB¢g dC¢g dD¢g dE¢g¡t  g dF¢g dG¢g dH¢g dI¢g¡t  d¡d ft  g dJ¢g dK¢g dL¢g dM¢g dN¢g¡d= t  dOdPgdQdRgdSdTgdUdVgdWdXgg¡d= t  dY¡t  d¡d ft  t  d¡t jddgddZ�¡t  t  d¡t  dgdgdgg¡¡t  g d[¢g d[¢g d\¢g d]¢g d^¢g d\¢g¡t  d	dgddgg¡d fd_t  g d`¢g da¢g db¢g dc¢g dd¢g de¢g df¢g dg¢g dh¢g	¡ t  g di¢g dj¢g dk¢g dl¢g dm¢g dn¢g do¢g dp¢g dq¢g	¡d_ t  g dr¢¡t  d	¡d ft  ddsgddgg¡t  dgdgg¡t  d¡t  dgg¡d ft  g dt¢g du¢g dv¢g¡dw t  d	¡dst  d	¡ dst  d	¡ dxft  g dy¢g dz¢g d{¢g d|¢g¡t  d}gdgdgdgg¡t  g d~¢¡t  dgg¡d ft jd€ddZ�t  t  d€d¡¡t  d€¡t  dgg¡d fg} d�}d‚dƒ„ }t| ƒD ]\}}|||| ƒ �q€t  t  d„¡¡}d|d…< t  g d†¢g d‡¢g¡j	}t  
|dˆ¡t  g d‰¢¡ }t  dŠd(g¡}ttt||||ƒ d S )‹Nr    y      ð?       Àr   y       €      Àr   r7   y       €       Àù              ð?r!   r'   y      ð?      ð¿ù               @)gÑX=X­Iä?gPÂŽ÷‘á?g¿'9Ô­fè?)gú»Ò�Ká?gõèhÚ2á?g¸N¯Ö�Z¶?)gSÒŠ�Ñ?gè½s Ò,ë?g^LŽ–^öÝ?g•=Sùèþî?gÃþ>%ßS¬?gˆåòFBé?r"   rV   rW   r#   r3   g ‘~û:pî?g2w-!ôì?g5^ºI‚@gÕxé&1ó¿gZd;ßO�@g{®Gázt?g{®Gáz”?gUUUUUUÕ?éüÿÿÿr4   gF]tÑE·?)çV-²�ïï?gôýÔxé&±?r   r   )gôýÔxé&±¿r›   r   r   )r   r   r›   g/Ý$�•Ã?)r   r   g/Ý$�•Ã¿r›   gF%ušk?rg   gÇº¸�ðF¿g{®Gáz¤?gŸ<,Ôšæ}?gÇº¸�ðf¿)gìQ¸…ëý?r   r   ç¬Zd;Ï¿)r   g+‡ÙÎç?ç=
×£p=Ê?r   )r   r�   g+‡Ùâ?r   )rœ   r   r   gøSã¥›Äð?)gP�—nƒï?gŒ/Úã…t´¿gúéä±«M?g[AÓ+£Q¿)g†åÏ·K¥?gHþ`à¹÷ï?g$ÑË(–[¢¿g°¯u©ú‰?)gYÝê9é}á¿g¦_"Þ:ÿ¦?g!å'Õ>Õ¿gCâKºÈ?)g”ö_˜L@geâX·¹¿g ‰°áé•í¿g+‡ÙÐ¿gÅ Tófn?g`[š¶ÚH?gQ‡nùH¶¿g	v÷–ã>gé}ãkÏ,ó¿gÒUW‘;¿g{ƒ/L¦Š	ÀgOšaþeRN?rl   )g333333ã¿gš™™™™™ÀgÍÌÌÌÌÌÀgÍ>�Qž™À)r.   g333333ã?gš™™™™™é?gÍèGÃ)3@)re   r.   gÍÌÌÌÌÌü?g {ö\f@)re   re   re   ggÖR@Úÿï¿)r.   r0   r0   r0   )re   r.   r0   r0   )re   re   r.   r0   )re   re   re   r.   )r    r   r!   r3   )r   r    r    r1   )r!   r    r3   r%   )r3   r1   r%   é   )g5^ºIÚW@gY†8ÖÅmÿ?g¾Á&S×?g&S£’:±?gÛù~j¼t“?)gé&1¬lD@gj¼t“¨D@g/Ý$�0@g�1w-!ß@geª`TR'ó?)gÉv¾Ÿo(@gú~j¼tS:@gP�—nB@g\�Âõ(Ü/@gj¼t“Ä(@)gmÅþ²{r@gžï§ÆK·)@g/Ý$�5;@gþÔxé&q5@g°rh‘í|D@)gNbX9´À?g ‰°áé•â?g      þ?g’\þCúí@gR¸…ë‘W@gñôJY†8¦?gðHPüˆ¿g›æ§èH@g$(~Œ¹ð¿g /Ý$@g
×£p=
Àg•eˆc]Ü@gffffffÀgx$(~ŒÝ?gƒ/L¦
Fí¿r1   r{   )r   r   r   r   r   r   )r   r   r   r   r   r   )r   r   r   r   r7   r   )r   r   r   r7   r   r   rd   )	gÍÌÌÌÌ0‹@g     à`@g®Gáz.'@g]ÜFxà?g\�Âõ(œBÀg#J{ƒ/LÖ?r   g+‡ÙÎ÷@gåÐ"Ûùþ@)	g33333#S@g33333Œ@gq=
×£p)@g"ýöuàœá?g®GázDÀg£#¹ü‡ô×?r   g…ëQ¸@gåÐ"Ûùþ@)	gÍÌÌÌÌÌ_Àg     Xv@i1  gHáz®G÷?g33333³YÀg/Ý$�•ï?r   g33333³'@g¸…ëQ¸2@)	g     ¸vÀg33333Ïƒ@g
×£p=ºR@gÍÌÌÌÌäˆ@g     qÀgÓMbX9@r   g¸…ëQ¸?@g)\�ÂõhH@)	i@üÿÿgš™™™™·™@gÍÌÌÌÌ`ÀgÙÎ÷ScÀg{®GáÚQ@g;ßO�—n@r   gáz®G!U@gš™™™™y_@)	g33333Ã„Àg=
×£p=\@g)\�Âõ8VÀg¢E¶óýÔÀg®GázU@g333333+@r   gš™™™™	b@gffffffY@)	g33333£yÀiµ  g{®GáZKÀg+‡ÙÎ÷Àg�Âõ(\ŸP@g{®Gáú(@g¼–�z6»?g®GázþX@g{®GájQ@)	gÍÌÌÌÌ|fÀg33333Ûr@g®Gázî7Àg�Âõ(\�ð¿gìQ¸…KN@g)\�Âõ(6@r   gÍÌÌÌÌ¼j@g…ëQ¸ÅA@)	gš™™™™‘uÀg33333#‚@g{®GáúFÀgmçû©ñÒÿ¿gffffffZ@g\�Âõ(Ü3@r   g33333ck@gfffffæj@)g
×£p=
@g cîZB>â¿gìQ¸…ëTÀ)gTã¥›Ä ì?gd;ßO�Àg×£p=
×À)gƒÀÊ¡E¶÷?g=
×£p=*Àg�—nƒÀ!@)g‰A`åÐ"@gq=
×£�AÀgÍÌÌÌÌÌ8@)g®Gáz®$@g     0WÀg33333³P@)gZd;ßÏ@gìQ¸…ËNÀgìQ¸…+C@)g7‰A`åÐ@g
×£p=jBÀg
×£p=J4@)gð§ÆK7‰ÿ?g®Gáz/Àgsh‘í|¿@)gÉv¾Ÿ/@gHáz®G>Àgáz®Ga-@)	é2   r   r   r   rŸ   r   r   r   r   ru   )é   r$   éþÿÿÿ)r$   r�   éøÿÿÿ)r¡   r¢   r4   gÇqÇq¼?z!Issue with OpenBLAS, see gh-16926)gGœ¡úÿÿï?r   r   r   )r   r   r   r   rY   )r   r   r   r   g:Œ0âŽyE>)r   r   r   r   g      Ð?rt   )r&   r€   r�   r€   r�   r    é   r€   r€   r�   r€   r�   r�   r€   r&   r    r1   r3   r$   c           	   
   S   s°   | \}}}}}|rt j|d� t||||ƒ}| ¡ j | |¡¡| | }|| ¡ j | |¡¡ t|| ¡ j | |¡¡ | ¡ jƒ | |¡¡¡8 }t|t 	|¡|d� dS ©ú5Checks if X = A'XA-(A'XB)(R+B'XB)^-1(B'XA)+Q) is truer‚   r„   N)
r†   r‡   r   rC   rU   rB   r
   r   r   r‰   )	rO   rŠ   rE   r‹   rF   rŒ   r�   rG   rŽ   r   r   r   r�     s    0ÿz.test_solve_discrete_are.<locals>._test_factory©r!   r!   )r   r   )r   r   r   )r   r   r   r¡   )r2   r7   gffffffþ¿iöÿÿÿ)r   rT   r:   Zkronr‘   r“   r”   Ztriur9   rU   Z	full_liker;   r   r   )	rM   r•   r�   r–   rO   rm   rn   ro   rp   r   r   r   Útest_solve_discrete_are6  sª   üüü
þúüüüüü
ý
ý
ýó
ý
ýö
ý
ý
ýó
üü
üüô"
û÷øÿ

øø	ëü
þþú
ýù	ü€ È Hr§   c                  C   s  t  g d¢g d¢g d¢g¡t  ddgddgdd	gg¡t  d
¡t  d¡t  g d¢g d¢g d¢g¡t  d¡d ft  g d¢g d¢g d¢g¡t  ddgddgdd	gg¡t  d
¡t  d¡t  g d¢g d¢g d¢g¡t  d¡d fg} d}dd„ }t| ƒD ]\}}|||| ƒ qìd S )N©g?§ ?¹Ñ?g[,ÄYê?g¾÷7hî?©g;)ÄÆ£§?g7j*0	<æ?gÉš&¦ê¢¡?©g�”€Ú Ý¸?g*ý„³[KÔ?g¯fSdcÜ?ç6±ÀWtkØ?çÞ]ÂüpëÇ?çý;‘è?ç¯/ÈLXß?çÿ	‰Gré?çm!#û{„Ü?r!   r    ©gGY¿™˜®ä?g X.eªÑ?g6¹ÎuÐÄ?©gåßÏ³æ?gÀpàÀå?g¡™Ì¢v¾?©g»<ç¸d&è?gª™µ�öä?gÂÀ‰2åß?r8   )r$   r$   c                 S   s¶   | \}}}}}}}|r"t j|d� t||||||ƒ}	| ¡ j |	 |¡¡| ¡ j |	 |¡¡ | }
| ¡ j |	¡ |¡| }|
| tt |¡| ¡ jƒ¡8 }
t	|
t 
|
¡|d� dS r¤   )r†   r‡   r   rC   rU   rB   r
   r   rˆ   r   r‰   )rO   rŠ   rE   r‹   rF   rŒ   ÚeÚsr�   rG   rŽ   r�   r   r   r   r�   =  s    0 z<test_solve_generalized_continuous_are.<locals>._test_factory)r   rT   r:   r’   r9   r”   )rM   r•   r�   r–   rO   r   r   r   Ú%test_solve_generalized_continuous_are  sN    
þ
þ
þô
þ
þ
þôðr¶   c                  C   s6  t dƒ} t g d¢g d¢g d¢g¡t ddgddgd	d
gg¡t d¡t d¡t g d¢g d¢g d¢g¡t d¡d ft g d¢g d¢g d¢g¡t ddgddgd	d
gg¡t d¡t d¡t g d¢g d¢g d¢g¡t d¡d f| d | d | d | d d | d d fg}d}dd„ }t|ƒD ]\}}|||| ƒ �qd S )Nzgendare_20170120_data.npzr¨   r©   rª   r«   r¬   r­   r®   r¯   r°   r!   r    r±   r²   r³   r8   rm   rn   ro   rp   ÚS)r%   r%   r    c              
   S   s  | \}}}}}}}|r"t j|d� t||||||ƒ}	|du rLt |jd ¡}|du r^t |¡}| ¡ j 	|	 	|¡¡| ¡ j 	|	 	|¡¡ | }
|
| ¡ j 	|	 	|¡¡|  	t
|| ¡ j 	|	 	|¡¡ | ¡ j 	|	 	|¡¡| ¡ j ƒ¡8 }
t|
t |
¡|d� dS )r¥   r‚   Nr   r„   )r†   r‡   r   r   r:   Úshaper‰   rC   rU   rB   r
   r   )rO   rŠ   rE   r‹   rF   rŒ   r´   rµ   r�   rG   rŽ   r   r   r   r�   z  s    
0ÿÿz:test_solve_generalized_discrete_are.<locals>._test_factory)r   r   rT   r:   r’   r9   r”   )Zmat20170120rM   r•   r�   r–   rO   r   r   r   Ú#test_solve_generalized_discrete_areM  s`    
þ
þ
þô
þ
þ
þôúá(r¹   c                  C   s,   dd„ } dd„ }dd„ }dd„ }d	d
„ }d S )Nc               	   S   sp   t  d¡} t  d¡}ttfD ]N}tt|| dddƒ tt|||| dƒ tt||||| ƒ tt|||||| ƒ qd S )Nr8   r!   r   ©r   r9   r:   r   r   r;   r<   ©r>   r?   rG   r   r   r   Útest_square_shape“  s    

z1test_are_validate_args.<locals>.test_square_shapec                  S   s˜   t  d¡} t  d¡}ttfD ]v}tt||| ddƒ tt||||||| ƒ tt|||t  d¡|ƒ tt||||t  d¡ƒ tt|||||t  d¡ƒ qd S )Nr8   r"   r   r!   rº   r»   r   r   r   Útest_compatible_sizesœ  s    

z5test_are_validate_args.<locals>.test_compatible_sizesc                  S   sR   t  d¡ dd¡} t  d¡}ttfD ](}tt|||| |ƒ tt||||| ƒ q$d S )Nr#   r!   )r   ZarangeÚreshaper:   r   r   r;   r<   )ZnsymÚsymrG   r   r   r   Útest_symmetry¦  s
    
z-test_are_validate_args.<locals>.test_symmetryc               	   S   s^   t  dd¡} | d  d8  < t  d¡}ttfD ]}tt|||||| ƒ q.ttt|||| ƒ d S )Nr¦   g   ¢”mBrs   r   r!   )r   Úfullr:   r   r   r;   r<   )Zsingr?   rG   r   r   r   Útest_singularity­  s    
z0test_are_validate_args.<locals>.test_singularityc               
   S   sœ   t  dt j¡} t  d¡}ttfD ]v}tt|| |||ƒ tt||| ||ƒ tt|||| |ƒ tt||||| ƒ tt|||||| ƒ tt||||||| ƒ q d S )Nrs   r    )r   rÁ   Únanr:   r   r   r;   r<   )Únmr?   rG   r   r   r   Útest_finiteness¶  s    
z/test_are_validate_args.<locals>.test_finitenessr   )r¼   r½   rÀ   rÂ   rÅ   r   r   r   Útest_are_validate_args‘  s
    	
	rÆ   c                   @   sT  e Zd Ze ddgddgg¡e ddgddgg¡e dd	gd
dgg¡fe g d¢g d¢g d¢g d¢g¡e g d¢g d¢g d¢g d¢g¡e g d¢g d¢g d¢g d¢g¡fe ddgddgg¡e ddgddgg¡e dd gd!dgg¡fe d"dgddgg¡e ddgddgg¡e dd gd!dgg¡fe ddgddgg¡e ddgddgg¡e dd gd!dgg¡fe ddgddgg¡e ddgddgg¡e ddgddgg¡fe g d#¢g d$¢g d%¢g¡e dd&gddgg¡e ddgd&dgddgg¡fe g d'¢g d$¢g d%¢g¡e dd&gdd(gg¡e ddgd&d)gd*d+gg¡fgZd,d-„ Zd.d/„ Zd0d1„ Zd2S )3ÚTestSolveSylvesterr   r    r   r"   r1   r3   r2   r#   r$   r%   r&   )r.   r   r   r   )r   r.   r(   re   )r   r   r/   rš   )r   r   r    r1   )r(   r   r   r.   )r   r.   re   re   )r   r   r.   r7   )r   r   r   r   )r   r.   r   r   )r   r   r.   r   )r   r   r   r.   r'   r(   r)   r*   r0   r™   r/   rX   r+   r,   r-   r.   )r2   r   r3   )r!   r1   r4   )r"   r#   r    r!   )r2   r˜   y      @       @y      @      ð¿y              @y              @y      @      @c                 C   s.   t |||ƒ}tt ||¡t ||¡ |ƒ d S rA   )r   r   r   rB   ©r=   rE   r‹   ÚcrG   r   r   r   Ú
check_caseñ  s    zTestSolveSylvester.check_casec                 C   s*   | j D ]}|  |d |d |d ¡ qd S )Nr   r   r    )rM   rÊ   rN   r   r   r   rP   õ  s    
zTestSolveSylvester.test_casesc                 C   sf   t  ddgddgg¡}t  dgg¡}t  ddg¡ dd¡}t|||ƒ}t|t  ddg¡ dd¡ƒ d S )Nr.   re   r(   r7   r   )r   rT   r¾   r   r   rÈ   r   r   r   Útest_trivialù  s
    zTestSolveSylvester.test_trivialN)	rQ   rR   rS   r   rT   rM   rÊ   rP   rË   r   r   r   r   rÇ   Â  s`   þ
ý
ý
ýøþþþþþþØ-rÇ   )r   Únumpyr   Znumpy.testingr   r†   r   r;   Zscipy.linalgr   r   r   r   r   r	   r
   r   Zscipy.sparse._sputilsr   r   r   r—   r§   r¶   r¹   rÆ   rÇ   r   r   r   r   Ú<module>   s&   W F f2D1