o
    à8VaÇ  ã                   @   sx  d dl m  mZ d dlZd dlZd dlZ	e 
d¡\ZZe 
dd¡\ZZee d ee d  Zee d Zed ed  de e  Ze eeg¡ dd¡Ze ee d ee d g¡ dd¡Zee eeg¡ dd¡ Ze dd„ eD ƒ¡ ejd  ejd ¡Ze d	d„ e ee d ee d g¡ dd¡D ƒ¡ e ee d ee d g¡ dd¡jd  e ee d ee d g¡ dd¡jd ¡Ze d
d„ ee eeg¡ dd¡ D ƒ¡ ee eeg¡ dd¡ jd  ee eeg¡ dd¡ jd ¡Ze ¡ Ze ¡ Ze ee¡Ze dd„ eD ƒ¡ ejd  ejd ¡Z e dd„ ee eeg¡ dd¡ D ƒ¡ ee eeg¡ dd¡ jd  ee eeg¡ dd¡ jd ¡Ze !e¡Ze !e¡Z"e dd„ eD ƒ¡ ejd  ejd ¡Ze dd„ ee eeg¡ dd¡ D ƒ¡ ee eeg¡ dd¡ jd  ee eeg¡ dd¡ jd ¡Z#e $d¡Z%e $d¡Z&e& 'e%de g d¢¡ dd¡¡ ee%j ee%j  ee e%j(  Z)e) !ee&¡Z*e dd„ eD ƒ¡ ejd  ejd ¡Z+e dd„ e ee d ee d g¡ dd¡D ƒ¡ e ee d ee d g¡ dd¡jd  e ee d ee d g¡ dd¡jd ¡Z,e) -e&¡Z.dS )é    Nzx yzx_ y_é   é   é   c                 C   ó   g | ]}|  ¡ ‘qS © ©Úexpand©Ú.0Úir   r   úO/usr/lib/python3/dist-packages/sympy/parsing/autolev/test-examples/ruletest5.pyÚ
<listcomp>   ó    r   c                 C   r   r   r   r	   r   r   r   r      r   c                 C   r   r   r   r	   r   r   r   r      r   c                 C   ó   g | ]}t  |t¡‘qS r   ©Ú_smÚfactorÚxr	   r   r   r   r      ó    c                 C   r   r   r   r	   r   r   r   r      r   c                 C   ó   g | ]}|  t¡‘qS r   ©Údiffr   r	   r   r   r   r      ó    c                 C   r   r   r   r	   r   r   r   r      r   ÚaÚbZDCM)	r   r   r   r   r   r   r   r   r   c                 C   ó   g | ]
}|  t d ¡¡‘qS ©Út©r   r   ZSymbolr	   r   r   r   r      ó    c                 C   r   r   r   r	   r   r   r   r       r   )/Zsympy.physics.mechanicsZphysicsZ	mechanicsZ_meZsympyr   ZmathÚmZnumpyZ_npZdynamicsymbolsr   ÚyZx_dZy_dZe1Ze2Ze3ZMatrixZreshapeZm1Zm2Zm3ÚshapeÚamÚcmZemr   ÚfÚgr   r   Zbmr   r   ZdmZReferenceFrameZframe_aZframe_bZorientÚzZv1ÚeZfmZgmZdtÚhr   r   r   r   Ú<module>   s@    &(Žj(j

(j

 "(Ž