
    sg              
       	   d dl mc mZ d dlZd dlZd dlZ	 ej                  d      Z ej                  d      Zd Z ej                  eddd      Z ej                   d      Z ej                   d      Z ej&                  d ej                   d       ej(                  d	            Z ej&                  d
 ej                   d       ej(                  d	            Z ej.                  d      \  ZZZ ej.                  dd      \  ZZZ ej                   d      Zej?                  ed         ej                  d      Z  ejB                  dee  ejD                  d	       ejF                  e jH                  e jH                        ef      Z%ejM                  ejN                  eejH                  z         dejQ                  ejN                        z  eejR                  z  z   Z*ejW                  eeejX                  z         dej[                  e      z  eejR                  z  z   Z*e jW                  eeejX                  z         de j[                  e      z  eejR                  z  z   Z*ej]                  eej[                  e      j_                  e             deja                  e      z  eejR                  z  z   Z*ejN                  j?                  eeejH                  z  eejR                  z  z          ejc                  eeejR                  z          ejd                  ejg                  e      ejN                  ji                  e            Z5e5Z6de6z  Z7e7dz  Z8dez  ez  ez  Z9e9dez  z  Z9dez  Z9 ej.                  d      \  Z:Z;Z<Z= ej.                  dd      \  Z>Z?Z@ZA ej.                  d      \  Z$Z) ej.                  dd      \  ZBZC ej.                  dd      \  ZDZE ej.                  d      ZFe$eBdz  z  dz   ZF ej                  d gg      Zde$z  ed <    ej                  ej                  d     ej                  d gg            Zde)z  eej                  d    dz
  <   ded    z  Z ej                  g d      j                  dd      Zded<   ed   dz  Ze:ejH                  z  ZKe;ejX                  z  ZLe:ejH                  z  e;ejR                  z  z   ZKeKdz  ZMy)    Nna   po1po2p1p1_ptmp2p2_ptzc1 c2 c3zc1_ c2_ c3_r_cmr_fr      zq1 q2 u1 u2zq1_ q2_ u1_ u2_zx yzx_ y_yy)	r   r   r                  	   r   )r   r   )Nsympy.physics.mechanicsphysics	mechanics_mesympy_smmathr
   numpy_npReferenceFrameframe_nframe_ar   inertiadPoint	point_po1	point_po2ParticleSymbolparticle_p1particle_p2dynamicsymbolsc1c2c3c1_dc2_dc3_d	body_r_cmset_velbody_r_f	RigidBodysymbolsouterxbody_rset_pospointpos_fromyvset_ang_velz
ang_vel_inset_ang_accdt
ang_acc_inset_acccrossaccvelv_ax_b_cx_b_d	a_b_c_d_ea_b_cq1q2u1u2q1_dq2_du1_du2_dx_dy_dx_ddy_ddr   Matrix
row_insertshapereshapeforce_rotorque_af     `/var/www/html/venv/lib/python3.12/site-packages/sympy/parsing/autolev/test-examples/ruletest9.py<module>rg      s   % %   
#

S
!
#

S
!CKKAq!CIIe	CIIe	cll47!3ZSZZ_Ecll47!3ZSZZ_ES
+
B%3%%mQ7 dDCIIf	 	  '1 3e$	sIxS1AICIIhjjYaYcYcDdenCo	p 	  +##R		\ 2i**++BwyyL8   GR		\ *g!!"WYY,.   Wbl +h'""2gii</   Gg009==gF Gg!!"WYY,.     '2gii<799#< = 	  '2gii< (cii	g&(9(9(=(=g(FG	%!G		"R
 2
B$###M2BB+++,=qA dD$s% 13gq)SS+
dSsAvXaZCJJus!ALLZSZZ!./A#!''!*Q,adFCJJ"#++Aq1	
#dGAIgii<gii<gii<"WYY,&QJre   