U
    L?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ÚbZAxisÚoÚpZp_ptÚmÚrZr_pt)Zq_indZu_indÚkd_eqs)ÚSystemg…ëQ¸ž#@gš™™™™™¹?gš™™™™™É?g        é
   g     @@)Ú	constantsZ
specifiedsZinitial_conditionsÚtimes)9Zsympy.physics.mechanicsZphysicsZ	mechanicsZ_meZsympyZ_smÚmathr	   ÚnumpyZ_npZdynamicsymbolsÚq1Úq2Úu1Úu2Zq1_dZq2_dZu1_dZu2_dÚsymbolsÚlÚgZReferenceFrameZframe_nZframe_aZframe_bZorientÚzZset_ang_velZPointZpoint_oZParticleÚSymbolZ
particle_pZ
particle_rÚpointZset_posÚxZset_velZv2pt_theoryZmassZforce_pZforce_rr   Z	forceListZKanesMethodZkaneZkanes_equationsÚfrZfrstarÚzeroZpydy.systemr   ZlinspaceÚsysZ	integrateÚy© r!   r!   úw/var/www/html/venv/lib/python3.8/site-packages/sympy/parsing/autolev/test-examples/pydy-example-repo/double_pendulum.pyÚ<module>   sJ   



,ý