o
    à8Va­  ã                
   @   s\  d dl m  mZ d dlZd dlZd dlZ	e 
d¡Ze 
d¡Zd Ze eddd¡Ze d¡Ze d¡Ze de d¡e d	¡¡Ze d
e d¡e d	¡¡Ze d¡\ZZZe dd¡\ZZZe d¡Ze ed ¡ e 
d¡Z e !dee e "d	¡e #e j$e j$¡ef¡Z%e &ej'eej$ ¡ de (ej'¡ eej)  Z*e +eeej, ¡ de -e¡ eej)  Z*e  +eeej, ¡ de  -e¡ eej)  Z*e .ee -e¡ /e¡¡ de 0e¡ eej)  Z*ej' eeej$ eej)  ¡ e 1eeej) ¡ e 2e 3e¡ej' 4e¡¡Z5e5Z6de6 Z7e7d Z8de e e Z9e9de 7 Z9de Z9e d¡\Z:Z;Z<Z=e dd¡\Z>Z?Z@ZAe d¡\Z$Z)e dd¡\ZBZCe dd¡\ZDZEe d¡ZFe$eBd  d ZFe Gd gg¡Zde$ ed < e HejId  e Gd gg¡¡Zde) eejId  d < ded   Ze Gg d¢¡ Jdd¡Zded< ed d Ze:ej$ ZKe;ej, ZLe:ej$ e;ej)  ZKeKd ZMdS )é    NÚnÚaé   Zpo1Zpo2Zp1Zp1_ptÚmZp2Zp2_ptzc1 c2 c3zc1_ c2_ c3_Zr_cmZr_fÚré   é   zq1 q2 u1 u2zq1_ q2_ u1_ u2_zx yzx_ y_Úyy)	r   r   r   é   é   é   é   é   é	   r   )r   r   )NZsympy.physics.mechanicsZphysicsZ	mechanicsZ_meZsympyZ_smZmathr   ZnumpyZ_npZReferenceFrameZframe_nZframe_ar   ZinertiaÚdZPointZ	point_po1Z	point_po2ZParticleZSymbolZparticle_p1Zparticle_p2ZdynamicsymbolsZc1Zc2Zc3Zc1_dZc2_dZc3_dZ	body_r_cmZset_velZbody_r_fZ	RigidBodyÚsymbolsZouterÚxZbody_rZset_posZpointZpos_fromÚyÚvZset_ang_velÚzZ
ang_vel_inZset_ang_accZdtZ
ang_acc_inZset_accZcrossZaccZvelZv_aZx_b_cZx_b_dZ	a_b_c_d_eZa_b_cZq1Zq2Zu1Zu2Zq1_dZq2_dZu1_dZu2_dZx_dZy_dZx_ddZy_ddr	   ZMatrixZ
row_insertÚshapeZreshapeZforce_roZtorque_aÚf© r   r   úO/usr/lib/python3/dist-packages/sympy/parsing/autolev/test-examples/ruletest9.pyÚ<module>   sl    





(


