o
    à8Va¦
  ã                
   @   sæ  d dl m  mZ d dlZd dlZd dlZ	e 
d¡\ZZejddd\ZZeee e d  Ze eeg¡ dd¡Ze ¡ Ze dd	„ eD ƒ¡ ejd  ejd ¡Ze ee¡Ze d
d	„ eD ƒ¡ ejd  ejd ¡Ze d gg¡Zee ee  ed < e ejd  e d gg¡¡Zde e de e  eejd  d < ee eee¡ƒ e eee¡e Zee d ded   Ze e¡ ejddd\ZZZe eeed g¡ dd¡Ze dd	„ eD ƒ¡ ejd  ejd ¡Ze dd	„ e ¡  ¡ D ƒ¡Z e dd	„ e !¡ D ƒ¡ ejd  ejd ¡Z"e #d¡Z$e #d¡Z%e% &e$dee$jg¡ e% &e$dej'd e$jg¡ ejddd\Z(Z)Z*e(e%j e)e%j  e*e%j+  Z,e -d¡Z.e -d¡Z/e. 0e/e(e%j ¡ e, 1e$¡Z,e. 0e/e. 2e/¡ 1e$¡¡ e% 3e$e*e%j+ ¡ ee$ 4e%¡ƒ e/ 5e.e$e%¡ e 6de -d¡e 7d¡¡Z8e 6de -d¡e 7d¡¡Z9e9j: 5e8j:e$e%¡ e/ ;e8j:e$e%¡ e -d¡Z<e< =e$d ¡ e #d¡Z>e ?de<e>e d¡e @e>je>j¡e<f¡ZAe -d¡ZBeB =e$d ¡ e #d¡ZCe ?d eBeCe d¡e @eCjeCj¡eBf¡ZDejd!ddZEe8jFeEe$j  ZGe9jFeEe$j  ZHeAjFeEe$j  ZIeDjFeEe$j  ZJe 
d"¡Z+ee%j ee%j+  Z,e. 0e/ee%j ee%j  ¡ e, Kede+ ee+i¡Z,e. 0e/e. 2e/¡ Kede+ ee+i¡¡ d#ee e%j  ZLe8jFeEe$j  ee e%j  ZGdS )$é    Nzx yza bT)Úrealé   é   c                 C   ó   g | ]}|  ¡ ‘qS © )Úexpand©Ú.0Úir   r   úP/usr/lib/python3/dist-packages/sympy/parsing/autolev/test-examples/ruletest10.pyÚ
<listcomp>   ó    r   c                 C   s   g | ]}t  |t¡‘qS r   )Ú_smÚfactorÚxr   r   r   r   r      s    é   za b cc              
   C   s"   g | ]}|  td tdtdi¡‘qS )r   r   r   )ÚsubsÚaÚbÚcr   r   r   r   r      s   " c                 C   r   r   ©Zevalfr   r   r   r   r      r   c                 C   s   g | ]
}|d  d   ¡ ‘qS )r   r   r   r   r   r   r   r      s    Únr   ZAxiszc1 c2 c3ÚoÚpZp1Zp1_ptÚmZp2Zp2_ptZb1_cmZb1_fZb1Zb2_cmZb2_fZb2ÚgÚzéÿÿÿÿ)MZsympy.physics.mechanicsZphysicsZ	mechanicsZ_meZsympyr   Zmathr   ZnumpyZ_npZdynamicsymbolsr   ÚyÚsymbolsr   r   ÚeZMatrixZreshaper   Úshaper   ZeqnZ
row_insertÚprintZsolveZrhs_yZcollectr   Zm2Z	eigenvalsÚkeysZeigvalueZ
eigenvectsZeigvecZReferenceFrameZframe_nZframe_aZorientZpiZc1Zc2Zc3r   ÚvZPointZpoint_oZpoint_pZset_posZexpressZpos_fromZset_ang_velZ
ang_vel_inZv2pt_theoryZParticleZSymbolZparticle_p1Zparticle_p2ZpointZa2pt_theoryZ
body_b1_cmZset_velZ	body_b1_fZ	RigidBodyZouterZbody_b1Z
body_b2_cmZ	body_b2_fZbody_b2r   ZmassZforce_p1Zforce_p2Zforce_b1Zforce_b2r   Zforce_or   r   r   r   Ú<module>   s~    ((&
(,






(

(
$"