o
    *Î®cß  ã                   @   s6  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 
dd¡\ZZejddd\ZZZe d	¡Ze d
¡Ze ed ¡ e ee ¡Ze d¡Ze edeejg¡ e de d¡e d¡¡Z e j! "eeej# eej$  ¡ ee _%e j! ee &e j!¡ 'e¡¡ e (e j! )e¡ *e¡ej#¡Z+e j%eej#  Z,e -d gg¡Z.e+e.d < dd„ e.D ƒZ/e 
d¡Z0e 
d¡Z1ee0 ee1 gZ2e j!e j%eej#  fgZ3ej4eeege1ge0ge2e/dZ5e5 6e ge3¡\Z7Z8e7e8 Z9e &e j!¡ :¡ e Z;e -d gg¡Z<e;e<d < e9 =e9j>d  e -d gg¡¡Z9e<d  e9e9j>d  d < dS )é    Nzq1 q2zq1_ q2_é   é   zl m gT)ÚrealÚnÚpnÚaÚAxisÚpÚp_ptÚmc                 C   s   g | ]}|‘qS © r   )Ú.0Úir   r   úm/tmp/pip-target-vg8gfxp4/lib/python/sympy/parsing/autolev/test-examples/pydy-example-repo/non_min_pendulum.pyÚ
<listcomp>   s    r   Úu_q1_dÚu_q2_d)Úq_indÚu_indÚu_dependentÚkd_eqsÚvelocity_constraints)?Úsympy.physics.mechanicsÚphysicsÚ	mechanicsÚ_meÚsympyÚ_smÚmathr   ÚnumpyÚ_npÚdynamicsymbolsÚq1Úq2Úq1_dÚq2_dÚq1_ddÚq2_ddÚsymbolsÚlÚgÚReferenceFrameÚframe_nÚPointÚpoint_pnÚset_velÚatanÚtheta1Úframe_aÚorientÚzÚParticleÚSymbolÚ
particle_pÚpointÚset_posÚxÚyÚmassÚpos_fromÚdtÚdotÚvelÚexpressÚf_vÚforce_pÚMatrixÚ	dependentr   r   r   r   Ú	forceListÚKanesMethodÚkaneÚkanes_equationsÚfrÚfrstarÚzeroÚ	magnitudeÚf_cÚconfigÚ
row_insertÚshaper   r   r   r   Ú<module>   sF    




