o
    iS                     @   s   d dl Zd dlmZ d dlmZ d dlmZm	Z	m
Z
mZ d dlmZmZmZmZmZmZmZmZmZmZmZmZ G dd dZG dd	 d	ZG d
d dZG dd dZG dd dZG dd dZG dd dZG dd dZ dS )    N)suppress_warnings)raises)assert_array_almost_equalassert_almost_equalxp_assert_closexp_assert_equal)dlsimdstepdimpulsetf2zpkltidlti
StateSpaceTransferFunctionZerosPolesGain	dfreqrespdbodeBadCoefficientsc                   @   D   e Zd Zdd Zdd Zdd Zdd Zd	d
 Zdd Zdd Z	dS )TestDLTIc                 C   s  t ddgddgg}t g dg dg}t ddgg}t g dg}d}t t jd	d
ddd d t jf t ddt ddf}t jd	ddd}t g dgj}t d	d	gddgddgddgddgg}	t|||||f||\}
}}t	|| t	|	| t	||
 tdd |d	dgd d f }t ddg}t|||||f||\}
}}t	|| t	|	| t
|
t
|ksJ t ddg}t g d}t g d gj}t||df|d d d	f |\}
}t	|| t	||
 t |d d d	f }|d!}t||df||\}
}t	|| t	||
 t dd"g}t d#t d$ d%t d$ g}d}t g d&gj}t|||df|d d d	f |\}
}t	|| t	||
 td'gd'd'g}ttt|| d S )(N?皙?皙ɿg?r   皙        皙?r   333333?r   r   r         ?r   g      @   )num)r!      g{Gz?gMb`       @)gMbPgc#GgD2?gъo?g#Y?ga2U0*S?gMb@?gTƿ?gkHcCG?g'h'?g56Ng9!@gbmӿ)r#            r         ?r   )r   r(   皙?)r   r   g
@gqqg^B{	7@)r!                       ?r%   y             )r   r(   r$   g      @g      @r#   )npasarrayZhstacklinspaceZnewaxisfullarrayTr   r   lenreshapesqrtr   assert_raisesAttributeError)selfabcddtuZt_inZ
yout_truthZ
xout_truthtoutyoutxoutZu_sparseZt_sparser"   denZuflatZzdpdksystem rE   Y/home/kim/smarthome/.venv/lib/python3.10/site-packages/scipy/signal/tests/test_dltisys.py
test_dlsim   sh    








"




"$

zTestDLTI.test_dlsimc                 C     t ddgddgg}t g dg dg}t ddgg}t g dg}d}t g d	t g d
t g df}t|||||fdd\}}t|dksQJ tdt|D ]}	||	 jd dkseJ t||	  ||	  qXdgddgdf}
t g d}t|
dd\}}t|dksJ t|d  | t|
d |
d d }t|dd\}}t|dksJ t|d  | t	dgddg}t
tt| d S )Nr   r   r   r   r   r   r   r    )
r   {Gz?g9v?gMO?gNz1?g0g >㷿gW	N3Ŀg+(ͿgGӿ)
r   g333333gV-g,Ԛga̦ۢgQo&g*~gIطgp,%Բg[W)
r   {Gzg9vgMOgNz1cg0?g >?gW	N3?g+(?gG?
   nr&   r   r(   )r   r(   r   r#   r    )r,   r-   r	   r2   rangeshaper   flattenr   r   r5   r6   )r7   r8   r9   r:   r;   r<   Zyout_step_truthr>   r?   itfinZyout_tfstepzpkinrD   rE   rE   rF   
test_dstepg   s2   zTestDLTI.test_dstepc                 C   rH   )Nr   r   r   r   r   r   r   r    )
r   rI   g~jt?ggr]g{ю~gB"LQ.gE_ngRPɺ1g1%)
r   g?g rh?g<,?gdm?gZՒr0[gS¸xg^TDgg#~g}T`)
r   rJ   g~jthgg?gr]?g{ю~?gB"LQ.?gE_n?gRPɺ1?g1%?rK   rL   r&   r   r(   )r   r(   g      r#   rN   )r,   r-   r
   r2   rO   rP   r   rQ   r   r   r5   r6   )r7   r8   r9   r:   r;   r<   Zyout_imp_truthr>   r?   rR   rS   Zyout_tfimpulserT   rD   rE   rE   rF   test_dimpulse   s2   
zTestDLTI.test_dimpulsec           
      C   s   t dgg}t dgg}t dgg}t dgg}d}t |dd}t||||df|\}}}	t|t t| t|t |df t|	t |df d S )Nr   r!   r#   r,   r0   zerosr3   r   r   arangefloat)
r7   r8   r9   r:   r;   rM   r=   r>   r?   r@   rE   rE   rF   test_dlsim_trivial   s   zTestDLTI.test_dlsim_trivialc                 C   s   t dgg}t dgg}t dgg}t dgg}d}t |dd}t||||df|dd\}}}	t|t t| dt t| dd}
t||
 t|	|
 d S )Nr    r   r(   r!   rW   r#   x0rX   )r7   r8   r9   r:   r;   rM   r=   r>   r?   r@   expectedrE   rE   rF   test_dlsim_simple1d   s   
zTestDLTI.test_dlsim_simple1dc                 C   s   d}d}t |dgd|gg}t dgdgg}t ddgddgg}t dgdgg}d}t |dd}t||||df|dd\}	}
}t|	t t| t ||gt t|dd }t|
| t|| d S )	Nr    g      ?r   r(   r!   rW   r#   r]   rX   )r7   lambda1lambda2r8   r9   r:   r;   rM   r=   r>   r?   r@   r_   rE   rE   rF   test_dlsim_simple2d   s.   


zTestDLTI.test_dlsim_simple2dc                 C   sN  d}d}t |dgd|gg}t ddgddgg}t ddgg}t ddgg}d}t||||df|d\}}	dd|  d|t |   }
dd|  d|t |   }t|	d d d df |
 t|	d d d df | t ddg}t||||df||d	\}}t ||gt d
|d d
d }d|dd d f< |d |df t |d|d d d f | }|d |df t |d|d d d f | }t|d d d df | t|d d d df | dgddgdf}t|dd\}\}t|g d t|j	g dg t|dd\}\}t|g d t|j	g dg d S )Nr    g      ?r   r(   rK   r#   rL   r   )rM   r^   rW   r*   r   r&   )r   r   r)   )r   r(   g      ?)r   r#   r    )
r,   r0   r	   rZ   r   r
   r3   dotr   r1   )r7   ra   rb   r8   r9   r:   r;   rM   tsZysZstp0Zstp1r^   tiyiimpZy0y1rD   tyrE   rE   rF   test_more_step_and_impulse   sB   

00z#TestDLTI.test_more_step_and_impulseN)
__name__
__module____qualname__rG   rU   rV   r\   r`   rc   rl   rE   rE   rE   rF   r      s    U-,r   c                   @   s   e Zd Zdd ZdS )TestDltic                 C   s  d}t dgdg|d}t|tsJ t|t sJ t|tr J |j|ks'J t tg tdgd|d}t|ts=J t|t sDJ t|trKJ |j|ksRJ t dgdgdd|d}t|tsdJ t|t skJ t|trrJ |j|ksyJ t	t
t d t	t
t ddddd d S )Nr   r#   rW   r<   r&   )r   
isinstancer   r   r<   r,   r0   r   r   r5   
ValueError)r7   r<   srE   rE   rF   test_dlti_instantiation  s$   z TestDlti.test_dlti_instantiationN)rm   rn   ro   ru   rE   rE   rE   rF   rp     s    rp   c                   @   $   e Zd Zdd Zdd Zdd ZdS )TestStateSpaceDiscc                 C   s   d}t dddd|d t dgdgdgdg|d t tddgddggtdgdggtddggtdgg|d t dddddd d S )	Nr   r#   rq   r%   r&   r'   r   T)r   r,   r0   r7   r<   rE   rE   rF   test_initialization=  s   &z&TestStateSpaceDisc.test_initializationc                 C   sl   t dddddd}t| t sJ t| tsJ t| ts$J t ||us,J | |us4J d S )Nr#   r%   r&   r'   r   rq   )r   rr   to_ssto_tfr   to_zpkr   r7   rt   rE   rE   rF   test_conversionF  s   z"TestStateSpaceDisc.test_conversionc                 C   s2   t dddddd}t|jdg t|jdg d S )Nr#   r   rq   r(   r   )r   r   polesrY   r}   rE   rE   rF   test_propertiesQ  s   z"TestStateSpaceDisc.test_propertiesNrm   rn   ro   ry   r~   r   rE   rE   rE   rF   rw   <  s    	rw   c                   @   rv   )TestTransferFunctionc                 C   sT   d}t dd|d t dgdg|d t tdgtdg|d t dddd d S Nr   r#   rq   r%   T)r   r,   r0   rx   rE   rE   rF   ry   \  s
   z(TestTransferFunction.test_initializationc                 C   sp   t ddgddgdd}t| tsJ t| t sJ t| ts&J t ||us.J | |us6J d S )Nr#   r   rW   r   rq   )r   rr   rz   r   r{   r|   r   r}   rE   rE   rF   r~   d  s   z$TestTransferFunction.test_conversionc                 C   s6   t ddgddgdd}t|jdg t|jdg d S )Nr#   r   rW   r   rq   r(   r   )r   r   r   rY   r}   rE   rE   rF   r   o  s   z$TestTransferFunction.test_propertiesNr   rE   rE   rE   rF   r   [  s    r   c                   @   s   e Zd Zdd Zdd ZdS )TestZerosPolesGainc                 C   s\   d}t ddd|d t dgdgd|d t tdgtdgd|d t ddddd d S r   )r   r,   r0   rx   rE   rE   rF   ry   z  s
    z&TestZerosPolesGain.test_initializationc                 C   sj   t ddddd}t| tsJ t| tsJ t| t s#J t ||us+J | |us3J d S )Nr#   r%   r&   r   rq   )r   rr   rz   r   r{   r   r|   r}   rE   rE   rF   r~     s   z"TestZerosPolesGain.test_conversionN)rm   rn   ro   ry   r~   rE   rE   rE   rF   r   y  s    r   c                   @   r   )Test_dfreqrespc                 C   s^   t dddgdd}g d}t||d\}}g d}t|j|dd	 g d
}t|j|dd	 d S )Nr#   r   r   rq   )r   r#   rK   w)gU0*?g;On?gfj+r'   decimal)gClÿg&WgZd;O?)r   r   r   realimag)r7   rD   r   Hexpected_reexpected_imrE   rE   rF   test_manual  s   zTest_dfreqresp.test_manualc                 C   s|   t dddgdd}g d}t||d\}}t|d }t|j|t|j| }|j}t|j| |j	}t|j	| d S )Nr#   r   r   rq   r   r#   rK   d   r   r+   )
r   r   r,   exppolyvalr"   rA   r   r   r   )r7   rD   r   r   jwrk   r   r   rE   rE   rF   	test_auto  s   zTest_dfreqresp.test_autoc                 C   sH   t dddgdd}d}tjdtjddd}t||d	\}}t|| d S )
Nr#   r   r   rq   rK   r   FZendpointrL   )r   r,   r.   pir   r   )r7   rD   rM   
expected_wr   r   rE   rE   rF   test_freq_range  s
   zTest_dfreqresp.test_freq_rangec                 C   sz   t dgddgdd}t }|jtdd |jtdd t|dd	\}}W d    n1 s.w   Y  |d
 dks;J d S Nr#   rW   r   rq   zdivide by zero)messagezinvalid value encounteredr%   rL   r   r   )r   r   filterRuntimeWarningr   )r7   rD   supr   r   rE   rE   rF   test_pole_one  s   zTest_dfreqresp.test_pole_onec                 C       t dgddg}ttt| d S Nr#   )r   r5   r6   r   r7   rD   rE   rE   rF   
test_error     zTest_dfreqresp.test_errorc                 C   s   t dgg d}tg dg dg dg}tg dgj}tg dg}d}t ||||}dtd	dd
 }t }|t t||d\}	}
t||d\}}W d    n1 s\w   Y  t	|
| d S )Nr%   )r#   r*   r   r   )r    r   r   )r#   r   r   )r   r#   r   )r   r   r%   r   g      $@r    r   )
r   r,   r0   r1   rZ   r   r   r   r   r   )r7   	system_TFABCDZ	system_SSr   r   w1H1w2H2rE   rE   rF   test_from_state_space  s    

z$Test_dfreqresp.test_from_state_spacec                 C   sR   t g dgd}t dddg}g d}t||d\}}t||d\}}t|| d S )Nr)   r   r#   r   r   r   )r   r   r   )r7   Z
system_ZPKr   r   r   r   r   r   rE   rE   rF   test_from_zpk  s   zTest_dfreqresp.test_from_zpkN)
rm   rn   ro   r   r   r   r   r   r   r   rE   rE   rE   rF   r     s    
r   c                   @   s<   e Zd Zdd Zdd Zdd Zdd Zd	d
 Zdd ZdS )	Test_bodec           	      C   sz   d}t dddg|d}dddtjg}t||d\}}}g d}t||d	d
 g d}t||d	d
 tt|| | d S )Nr   r   r#   r   rq   r    r   )gD!gvq!g$~;#g0*(r'   r   )gzGgJAg_)Pg     f)r   r,   r   r   r   r   r0   )	r7   r<   rD   r   r   magphaseexpected_magexpected_phaserE   rE   rF   r     s   zTest_bode.test_manualc           
      C   s   t dddgdd}tdddtjg}t||d\}}}t|d }t|j|t|j| }d	t	t
| }t|| tt|}	t||	 d S )
Nr   r#   r   r   rq   r    r   r+   g      4@)r   r,   r0   r   r   r   r   r"   rA   log10absr   Zrad2degZangle)
r7   rD   r   r   r   r   r   rk   r   r   rE   rE   rF   r     s   
zTest_bode.test_autoc                 C   sR   d}t dddgdd}d}tjdtj|dd	| }t||d
\}}}t|| d S )Nr   r   r#   r   rq   rK   r   Fr   rL   )r   r,   r.   r   r   r   )r7   r<   rD   rM   r   r   r   r   rE   rE   rF   
test_range  s   zTest_bode.test_rangec                 C   s|   t dgddgdd}t }|jtdd |jtdd t|dd	\}}}W d    n1 s/w   Y  |d
 dks<J d S r   )r   r   r   r   r   )r7   rD   r   r   r   r   rE   rE   rF   r     s   zTest_bode.test_pole_onec                 C   s$   t dgg ddd}t|dd d S )Nr#   )r#   r   r   r   rq   r%   rL   )r   r   r   rE   rE   rF   test_imaginary%  s   zTest_bode.test_imaginaryc                 C   r   r   )r   r5   r6   r   r   rE   rE   rF   r   +  r   zTest_bode.test_errorN)	rm   rn   ro   r   r   r   r   r   r   rE   rE   rE   rF   r     s    r   c                   @   s(   e Zd ZdZdd Zdd Zdd ZdS )	TestTransferFunctionZConversionz=Test private conversions between 'z' and 'z**-1' polynomials.c                 C   sh   t g d}t g d}t||\}}t|| t|| t||\}}t|| t|| d S )Nr$   r&   r'   )      @      r,   r-   r   Z
_z_to_zinvr   Z
_zinv_to_zr7   r"   rA   Znum2Zden2rE   rE   rF   	test_full4  s   


z)TestTransferFunctionZConversion.test_fullc                 C   sp   t ddg}t g d}t||\}}tg d| t|| t||\}}tg d| t|| d S )Nr$   r&   )2   r   r   )r   r%   r&   )r$   r&   r   r   r   rE   rE   rF   test_numerator@  s   
z.TestTransferFunctionZConversion.test_numeratorc                 C   sp   t g d}t ddg}t||\}}t|| tg d| t||\}}t|| tg d| d S )Nr   r   r   )r   r!   r   )r   r   r   r   r   rE   rE   rF   test_denominatorL  s   

z0TestTransferFunctionZConversion.test_denominatorN)rm   rn   ro   __doc__r   r   r   rE   rE   rE   rF   r   1  s
    r   )!numpyr,   Znumpy.testingr   Zpytestr   r5   Zscipy._lib._array_apir   r   r   r   Zscipy.signalr   r	   r
   r   r   r   r   r   r   r   r   r   r   rp   rw   r   r   r   r   r   rE   rE   rE   rF   <module>   s   8  [H