o
    æðh/  ã                   @   sR  d dl m  mZ d dlZd dlZd dlZ	e 
d¡\ZZZZe 
dd¡\ZZZZejddd\ZZZe d¡Ze d	¡Ze d
¡Ze edeejg¡ e edeejg¡ e eeej ¡ e eeej ¡ e d¡Ze de d¡e  d¡¡Z!e de d¡e  d¡¡Z"e!j# $eeej% ¡ e"j# $e!j#eej% ¡ e &ed ¡ e!j# 'eee¡ e"j# 'e!j#ee¡ ee!_(ee"_(e!j(eej%  Z)e"j(eej%  Z*ee ee gZ+e!j#e!j(eej%  fe"j#e"j(eej%  fgZ,ej-eeegeege+dZ.e. /e!e"ge,¡\Z0Z1e0e1 Z2d dl3m4Z4 e4e.edededii ededed ed ie	 5ddd¡dZ6e6 7¡ Z8dS )é    Nzq1 q2 u1 u2zq1_ q2_ u1_ u2_é   zl m gT)ÚrealÚnÚaÚbÚAxisÚoÚpÚp_ptÚmÚrÚr_pt)Úq_indÚu_indÚkd_eqs)ÚSystemg…ëQ¸ž#@gš™™™™™¹?gš™™™™™É?g        é
   g     @@)Ú	constantsÚ
specifiedsÚinitial_conditionsÚtimes)9Úsympy.physics.mechanicsÚphysicsÚ	mechanicsÚ_meÚsympyÚ_smÚmathr   ÚnumpyÚ_npÚdynamicsymbolsÚq1Úq2Úu1Úu2Úq1_dÚq2_dÚu1_dÚu2_dÚsymbolsÚlÚgÚReferenceFrameÚframe_nÚframe_aÚframe_bÚorientÚzÚset_ang_velÚPointÚpoint_oÚParticleÚSymbolÚ
particle_pÚ
particle_rÚpointÚset_posÚxÚset_velÚv2pt_theoryÚmassÚforce_pÚforce_rr   Ú	forceListÚKanesMethodÚkaneÚkanes_equationsÚfrÚfrstarÚzeroÚpydy.systemr   ÚlinspaceÚsysÚ	integrateÚy© rM   rM   úy/var/www/vscode/kcb/lib/python3.10/site-packages/sympy/parsing/autolev/test-examples/pydy-example-repo/double_pendulum.pyÚ<module>   sL    



,ý