U L?h‡Rã@sZddlmZddlmZddlmZddlmZddlm Z m Z ddl m Z ddl mZmZmZmZddlmZmZmZmZmZmZmZmZmZdd lmZdd lmZed ƒ\Z Z!Z"Z#Z$ed ƒZ%e% &d de e%j'g¡Z(e( &dde!e(j)g¡Z*e* &dde"e*j+g¡Z,dd„Z-dd„Z.dd„Z/dd„Z0dd„Z1dd„Z2dd„Z3dd „Z4d!d"„Z5d#d$„Z6d%d&„Z7d'S)(é)Úpi)ÚS)Úsymbols)Úsqrt)ÚcosÚsin)ÚIntegral)ÚDyadicÚPointÚReferenceFrameÚVector) ÚcrossÚdotÚexpressÚtime_derivativeÚkinematic_equationsÚouterÚpartial_velocityÚget_motion_paramsÚdynamicsymbols)Útrigsimp)Úraiseszq1 q2 q3 q4 q5ÚNÚAÚAxisÚBÚCcCsÊttjtjƒdkst‚ttjtjƒdks,t‚ttjtjƒdksBt‚ttjtjƒdksXt‚ttjtjƒdksnt‚ttjtjƒdks„t‚ttjtjƒdksšt‚ttjtjƒdks°t‚ttjtjƒdksÆt‚dS)Nér)rrÚxÚAssertionErrorÚyÚz©r"r"ú[/var/www/html/venv/lib/python3.8/site-packages/sympy/physics/vector/tests/test_functions.pyÚtest_dotsr$cCsdttjtjƒttƒkst‚ttjtjƒttƒ ks6t‚ttjtj ƒdksLt‚ttjtjƒttƒksft‚ttjtjƒttƒks€t‚ttjtj ƒdks–t‚ttj tjƒdks¬t‚ttj tjƒdksÂt‚ttj tj ƒdksØt‚t ttjtjtjƒƒt dƒttt dƒkst‚t ttjtjtjƒƒt ttjtjtjƒƒksDt‚ttjt jƒttƒks`t‚ttjt jƒdksxt‚ttjt j ƒttƒks”t‚ttjt jƒttƒttƒks¸t‚ttjt jƒttƒksÔt‚ttjt j ƒttƒ ttƒksút‚ttj t jƒttƒ ttƒks t‚ttj t jƒttƒkssr,cCsÚttjtjƒttƒtjks t‚ttjtjƒt tƒtjks@t‚ttjtjƒttƒ tjt tƒtjkspt‚ttjtjƒt tƒ tjks’t‚ttjtjƒttƒtjks²t‚ttjtjƒt tƒtjttƒtjksàt‚ttjtjƒtjksøt‚ttjtjƒtj kst‚ttjtjƒdks,t‚ttjtjƒttƒtjksNt‚ttjtjƒt tƒtjkspt‚ttjtjtjƒttƒtjt tƒtjks¦t‚ttjtjtjƒttƒ tjt tƒtjksÞt‚ttjt jƒtt ƒt jkst‚ttjt jƒtt ƒ t jt t ƒt jks2t‚ttjt jƒt t ƒ t jksVt‚tt jtjƒtt ƒ t jkszt‚tt jtjƒ  t ¡  ¡tt ƒt jt t ƒt jks´t‚tt jtjƒt t ƒt jksÖt‚dSr+)r rrrrr'r!rr rrr(rÚsimplifyr"r"r"r#Útest_cross_different_framesLs&  0" .""68"2$$:r.cs¢tdƒ}|j|j‰ˆˆB‰tdƒ‰tdƒ‰ˆˆ@tˆˆƒksBt‚ˆˆ@tˆˆƒksXt‚ˆˆ@tˆˆƒksnt‚ˆˆ@tˆˆƒks„t‚ˆˆ@tˆˆƒksšt‚ˆˆ@tˆˆƒks°t‚ˆˆ@tˆˆƒksÆt‚tt‡fdd„ƒtt‡fdd„ƒtt‡fdd„ƒtt‡fdd„ƒˆˆ@tˆˆƒks&t‚ˆˆ@tˆˆƒks>t‚ˆˆ@tˆˆƒksVt‚tt‡fdd„ƒtt‡fd d„ƒtt‡fd d„ƒtt‡fd d„ƒtt‡fd d„ƒtt‡‡fd d„ƒtt‡‡fdd„ƒˆˆAt ˆˆƒksðt‚ˆˆAt ˆˆƒkst‚ˆˆAt ˆˆƒks t‚ˆˆAt ˆˆƒks8t‚ˆˆAt ˆˆƒksPt‚tt‡fdd„ƒtt‡fdd„ƒtt‡fdd„ƒtt‡fdd„ƒˆˆAt ˆˆƒks°t‚ˆˆAt ˆˆƒksÈt‚ˆˆAt ˆˆƒksàt‚tt‡fdd„ƒtt‡fdd„ƒtt‡fdd„ƒtt‡fdd„ƒtt‡fdd„ƒtt‡‡fdd„ƒtt‡‡fdd„ƒtt‡‡fdd„ƒtt‡‡fdd„ƒtt‡‡fdd„ƒtt‡‡fdd„ƒtt‡‡fdd„ƒtt‡fdd„ƒtt‡fd d„ƒtt‡fd!d„ƒtt‡fd"d„ƒˆˆBt ˆˆƒks&t‚ˆˆBt ˆˆƒks>t‚ˆˆBt ˆˆƒksVt‚tt‡fd#d„ƒtt‡fd$d„ƒtt‡fd%d„ƒtt‡fd&d„ƒd'S)(zUTest that the output of dot, cross, outer functions match operator behavior. rrcs tˆtjƒS©N©rrÚZeror"©Údr"r#Úuóz%test_operator_match..cs ttjˆƒSr/r0r"r2r"r#r4vr5cs tˆdƒSr+©rr"r2r"r#r4wr5cs tdˆƒSr+r6r"r2r"r#r4xr5cs tˆtjƒSr/r0r"©Úvr"r#r4|r5cs ttjˆƒSr/r0r"r7r"r#r4}r5cs tˆdƒSr+r6r"r7r"r#r4~r5cs tdˆƒSr+r6r"r7r"r#r4r5cs tˆˆƒSr/©r r"r2r"r#r4‚r5cs tˆˆƒSr/r9r"©r3Úzerodr"r#r4ƒr5cs tˆˆƒSr/r9r"r:r"r#r4„r5cs tˆtjƒSr/©r rr1r"r2r"r#r4Šr5cs ttjˆƒSr/r<r"r2r"r#r4‹r5cs tˆdƒSr+r9r"r2r"r#r4Œr5cs tdˆƒSr+r9r"r2r"r#r4r5cs tˆtjƒSr/r<r"r7r"r#r4‘r5cs ttjˆƒSr/r<r"r7r"r#r4’r5cs tˆdƒSr+r9r"r7r"r#r4“r5cs tdˆƒSr+r9r"r7r"r#r4”r5cs tˆˆƒSr/©rr"r2r"r#r4—r5cs tˆˆƒSr/r=r"r:r"r#r4˜r5cs tˆˆƒSr/r=r"r:r"r#r4™r5cs tˆˆƒSr/r=r"©r3r8r"r#r4šr5cs tˆˆƒSr/r=r"r>r"r#r4›r5cs tˆˆƒSr/r=r"©r3Úzerovr"r#r4œr5cs tˆˆƒSr/r=r"r?r"r#r4r5cs tˆˆƒSr/r=r"r?r"r#r4žr5cs tˆtjƒSr/©rrr1r"r2r"r#r4Ÿr5cs ttjˆƒSr/rAr"r2r"r#r4 r5cs tˆdƒSr+r=r"r2r"r#r4¡r5cs tdˆƒSr+r=r"r2r"r#r4¢r5cs tˆtjƒSr/rAr"r7r"r#r4¦r5cs ttjˆƒSr/rAr"r7r"r#r4§r5cs tˆdƒSr+r=r"r7r"r#r4¨r5cs tdˆƒSr+r=r"r7r"r#r4©r5N) r rr r r rrrÚ TypeErrorr r)rr")r3r8r;r@r#Útest_operator_matchcsz rCcCsRttdƒtƒtdƒkst‚ttjtƒtjks0t‚ttjtƒt t ƒtjt t ƒtj ks\t‚ttj tƒt tƒt t ƒtjt tƒtj t tƒt t ƒtj ks¦t‚ttj tƒt t ƒ t tƒtjt tƒtj t tƒt t ƒtj ksòt‚ttjtƒt tƒtjt tƒtj ks t‚ttj tƒt tƒ tjt tƒtj ksPt‚ttj tƒtj ksht‚ttjtƒtjks€t‚ttj tƒtj ks˜t‚ttj tƒtj ks°t‚ttjtƒtjksÈt‚ttj tƒt tƒtj t tƒtj ksöt‚ttj tƒt tƒtj t tƒtj ks$t‚ttjtƒt t ƒtjt t ƒtj ksRt‚ttj tƒt tƒt t ƒtjt tƒtj t tƒt t ƒtj ksžt‚ttj tƒt t ƒ t tƒtjt tƒtj t tƒt t ƒtj ksìt‚ttjtƒtjkst‚ttj tƒtj kst‚ttj tƒtj ks4t‚ttjtƒt tƒtjt tƒtj ksbt‚ttj tƒt tƒtjt tƒtj kst‚ttj tƒtj ks¨t‚ttjtƒt tƒtjt tƒt tƒtj t tƒt tƒtj ksôt‚ttj tƒt tƒtjt tƒt tƒtj t tƒt tƒtj ks@t‚ttj tƒt tƒtj t tƒtj ksnt‚ttjtƒt tƒt t ƒt tƒt tƒt t ƒtjt tƒt tƒtj t t ƒt tƒt tƒt tƒt t ƒtj ksòt‚ttj tƒt tƒt t ƒt tƒt t ƒt tƒtjt tƒt tƒtj t tƒt t ƒt tƒt tƒt t ƒtj ksvt‚ttj tƒt t ƒ t tƒtjt tƒtj t tƒt t ƒtj ksÄt‚ttjtƒt tƒtjt tƒtj ksòt‚ttj tƒt tƒ tjt tƒtj ks"t‚ttj tƒtj ks:t‚ttjtƒtjksRt‚ttj tƒtj ksjt‚ttj tƒtj ks‚t‚ttjtƒtjksšt‚ttj tƒt tƒtj t tƒtj ksÈt‚ttj tƒt tƒtj t tƒtj ksöt‚ttjtƒt t ƒtjt t ƒtj ks$t‚ttj tƒt tƒt t ƒtjt tƒtj t tƒt t ƒtj kspt‚ttj tƒt t ƒ t tƒtjt tƒtj t tƒt t ƒtj ks¾t‚ttjtƒt tƒtjt tƒtj ksìt‚ttj tƒt tƒ t tƒtjt tƒt tƒtj t tƒtj ks:t‚ttj tƒt tƒt tƒtjt tƒt tƒtj t tƒtj ks†t‚ttjtƒtjksžt‚ttj tƒt tƒtj t tƒtj ksÌt‚ttj tƒt tƒ tj t tƒtj ksüt‚ttjtƒtjk st‚ttj tƒtj k s,t‚ttj tƒtj k sDt‚ttjtƒt t ƒtjt t ƒtj k srt‚ttj tƒtj k sŠt‚ttj tƒt t ƒ tjt t ƒtj k sºt‚ttjtƒt tƒt t ƒt tƒt tƒt t ƒtjt tƒt t ƒt tƒt t ƒt tƒtj t t ƒt tƒtj k s>t‚ttj tƒt tƒ t tƒtjt tƒt tƒtj t tƒtj k sŒt‚ttj tƒt t ƒt tƒt tƒt tƒt t ƒtjt tƒt t ƒt tƒt tƒt t ƒtj t tƒt t ƒtj k st‚ttjtƒt t ƒtjt tƒt t ƒtj t t ƒt tƒtj k s\t‚ttj tƒt tƒtj t tƒtj k sŠt‚ttj tƒt t ƒtjt tƒt t ƒtj t tƒt t ƒtj k sÖt‚ttjtƒt t ƒtjt t ƒtj k st‚ttj tƒtj k st‚ttj tƒt t ƒtjt t ƒtj k sJt‚ttjtƒtjk sbt‚ttj tƒtj k szt‚ttj tƒtj k ržtj k s¤nt‚tjtt tƒtjt tƒtj tƒ ¡k sÖt‚tj tt tƒtjt tƒtj tƒ ¡k st‚tjtt tƒtjt tƒt tƒtj t tƒt tƒtj tƒ ¡k sXt‚tj tt tƒtjt tƒt tƒtj t tƒt tƒtj tƒ ¡k s¨t‚tj tt tƒtj t tƒtj tƒ ¡k sÚt‚tjtt tƒtjt tƒtj tƒ ¡ks t‚tj tt tƒ tjt tƒtj tƒ ¡ks@t‚tj tt tƒtj t tƒtj tƒ ¡ksrt‚tj tt tƒtj t tƒtj tƒ ¡ks¤t‚tjtt t ƒtjt t ƒtj tƒ ¡ksÖt‚tj tt tƒt t ƒtjt tƒtj t tƒt t ƒtj tƒ ¡ks&t‚tj tt t ƒ t tƒtjt tƒtj t tƒt t ƒtj tƒ ¡ksxt‚tjtt tƒtjt tƒtj tƒ ¡ksªt‚tj tt tƒ t tƒtjt tƒt tƒtj t tƒtj tƒ ¡ksüt‚tj tt tƒt tƒtjt tƒt tƒtj t tƒtj tƒ ¡ksLt‚tj tt tƒtj t tƒtj tƒ ¡ks~t‚tj tt tƒ tj t tƒtj tƒ ¡ks²t‚tjtt t ƒtjt t ƒtj tƒ ¡ksät‚tj tt t ƒ tjt t ƒtj tƒ ¡kst‚tjtt t ƒtjt tƒt t ƒtj t t ƒt tƒtj tƒ ¡ksht‚tj tt tƒtj t tƒtj tƒ ¡ksšt‚tj tt t ƒtjt tƒt t ƒtj t tƒt t ƒtj tƒ ¡ksêt‚tjtt t ƒtjt t ƒtj tƒ ¡kst‚tj tt t ƒtjt t ƒtj tƒ ¡ksNt‚dSr+)rr rrrr1rrrrr(rr!r r)r'rr-r"r"r"r#Ú test_express¬sj,,ÿ .ÿ .0...,ÿ .ÿ ..,ÿ ,ÿ . ,ÿ,þÿ  ,ÿ,þÿ .ÿ .0...,ÿ .ÿ . ÿ ÿ ÿ ÿ .0.0 ,,ÿþÿ  :ÿ  ,,ÿþÿ ,ÿ .,ÿ ..*22(ÿÿ(ÿÿ224222(ÿÿ*ÿÿ2ÿ ÿÿÿ ÿÿ2424(ÿÿ2(ÿÿ2rDcsÒtdƒ}tdƒ}tddƒ}| dd||jg¡‰|j|jB}t|ˆƒ| |j|jB| |j|jBkslt‚|jˆjB}t||ƒ| |jˆjBks˜t‚t|ˆƒ| |jˆjBks¸t‚|jˆjB}t||ƒ||jˆjBksât‚t|ˆƒ| |jˆjBkst‚|jˆjB}t||ƒdks$t‚t|ˆƒ| |jˆjBksFt‚tdƒ\}}} } tddƒ\} } } }tddƒ\}}}}ˆ d d| ˆjg¡‰||j}||j| ˆj}||j||j| |j}tˆjˆƒdksàt‚tˆjˆƒ| ˆjksþt‚tˆjˆƒ|ˆjkst‚t|ˆƒ| |jks4t‚t|ˆƒ| t|ƒ||j|t |ƒ||j| |jks|t‚t||ƒ| |j| |ˆj| ˆjks®t‚t|ˆƒ| |j|||j|t|ƒ||j| ˆj| |ˆjkst‚t|ˆƒ||| |j| || |j| |jksDt‚t|ˆƒ| |j|jBt|ƒ||j|jB||j|jBt|ƒ||j|jBks¦t‚t t ‡‡fd d „ƒt t ‡‡fd d „ƒdS) NrÚqrrrrz q1 q2 q3 q4r%rcstˆjˆddS)Nçà?©Úorder©rrr"©rrr"r#r4}r5z&test_time_derivative..cstˆjˆddS)NéÿÿÿÿrGrIr"rJr"r#r4~r5) r rÚ orientnewr!rrr rrrrÚ ValueError)rrEZqdr3Zd1Zd2Zd3r'r)r(Úq4Úq1dÚq2dÚq3dZq4dZq1ddZq2ddZq3ddZq4ddÚv1Úv2Zv3r"rJr#Útest_time_derivativeVsn  ÿ     " " ÿÿ 2ÿÿ ÿ ÿÿ ÿÿÿ rTcCstj}tdƒ\}}}tdƒ\}}}tdƒ\}}} tdƒ\} } tdƒ\} } }tddƒ\}}}tddƒ\}}}|tj|tj|tj}|tj|tj| tj}|tj|tj|tj}| tj| tj|tj}|tj|tj|tj}|tj|tj|tj}ttdd ks2t‚tt|d d d |fksNt‚tt|d |||fksjt‚tt|d d |||fksŠt‚tt||| d d ||||| fks¶t‚tt||| d }d ||||| |  || ¡f}||ksöt‚tt||| d }t | || |fƒtjt | || |fƒtjt ||| |fƒtj}||||f}||ksdt‚tt|d|||||ddfkst‚tt|||| | d|||||| | | ||dd|| | || dd|||| |  || ¡fkst‚tt|||| | d|||||| | | |||dd|| | || dd|||| fksŒt‚tt| tj|tj|tj| | d}t | || |fƒ}| tj||tj|t |||| |fƒtjf}||kst‚dS)Nzs1 s2 s3zS1 S2 S3zS4 S5 S6zt1 t2za b crr%)Úframe)rrr)Úpositionr)Úvelocity)rWrVÚ timevalue1)Ú acceleration)rYrWrVrXZ timevalue2) rZ_trrrr r!rrÚsubsr)ÚtÚs1Ús2Zs3ZS1ZS2ZS3ZS4ZS5ZS6Út1Út2ÚaÚbÚcÚadZbdÚcdZa2dZb2dZc2dZv0Zv01rRrSZv2dZv2ddZanswerZanswer_expectedZintegral_vectorÚi1r"r"r#Útest_get_motion_methodss’  ÿ "*ÿ ÿ ÿ$ÿÿ þÿþ ÿ ÿÿþÿþ ÿÿrfc sZtdƒ\‰‰‰‰tddƒ\}}}}tdƒ\‰‰‰tˆˆˆgˆˆˆgddƒ}|tˆˆˆgˆˆˆgddƒkslt‚tˆˆˆgˆˆˆˆgdƒ}|dˆˆd ˆˆd ˆˆ|dˆˆd ˆˆd ˆˆ|dˆˆd ˆˆd ˆˆ|d ˆˆd ˆˆd ˆˆ|gks,t‚tt‡‡‡‡‡‡fd d „ƒtt‡‡‡‡‡‡‡fd d „ƒtt‡‡‡‡‡‡‡fd d „ƒtt‡‡‡‡‡fdd „ƒtt‡‡‡‡‡fdd „ƒtt‡‡‡‡fdd „ƒtt‡‡‡‡‡‡‡fdd „ƒtt‡‡‡‡‡‡‡fdd „ƒtt‡‡‡‡‡‡fdd „ƒtdddgˆˆˆgdƒtjtjtjgksVt‚dS)Nz q0 q1 q2 q3rzu1 u2 u3Úbodyi9Z313Ú quaterniongà¿rFcstˆˆˆgˆˆˆgdƒS©Nrh©rr"©Úq0r'r)Úu1Úu2Úu3r"r#r4År5ztest_kin_eqs..cstˆˆˆgˆˆˆˆgddƒS)NrhZ123rjr"©rlr'r)r(rmrnror"r#r4Ær5cstˆˆˆgˆˆˆˆgdƒS)NZfoorjr"rpr"r#r4Çr5cstˆˆˆˆˆgdƒSrirjr"©rlr'r)r(rmr"r#r4Èr5cstˆgˆˆˆˆgdƒSrirjr"rqr"r#r4Ér5cstˆˆˆgˆdƒSrirjr")rlrmrnror"r#r4Êr5cstˆˆˆgˆˆˆˆgdƒS)Nrgrjr"rpr"r#r4Ër5cstˆˆˆgˆˆˆˆgdƒS)NÚspacerjr"rpr"r#r4Ìr5cstˆˆˆgˆˆˆgddƒS)NrgZ222rjr"rkr"r#r4Ír5rrr)rrrrrMrBrr1)Zq0drOrPrQZkeZkdsr"rpr#Ú test_kin_eqsºs*"(&&&ý rsc stdƒ\}}}‰}}tdƒ\}}tdƒ}tdƒ‰ˆ dd|ˆjg¡}| dd||jg¡} |  dd|| jg¡} |  ˆˆ| j|| j|| j¡td ƒ} |   ˆ|| j||j| jA¡|   d || j¡‰ˆ  | ˆ| ¡ˆ  ˆ¡|   ˆ¡|   ˆ¡g‰ˆ||||g‰tˆˆˆƒ| | j|| jd | jt|ƒ| jt|ƒ| jgd d d | jt|ƒ| jt|ƒ| jg| j| j| jd d ggksˆt‚td ƒ} td ƒ} || j|| j}t|f||f| ƒ| j| jggksÒt‚tt‡‡‡fdd„ƒtt‡‡‡fdd„ƒdS)Nzq1 q2 q3 u1 u2 u3zu4, u5ÚrrÚYrÚLÚRrÚDmcrrrcstˆ ˆ¡ˆˆƒSr/)rÚvelr")rxrÚu_listr"r#r4ïr5z'test_partial_velocity..cs tˆˆˆƒSr/)rr")rrmÚvel_listr"r#r4ðr5)rrr rLr!rr Z set_ang_velr Zset_velZ locatenewZ v2pt_theoryryZ ang_vel_inrrrrrrB)r'r)r(rnroZu4Zu5rtrurvrwrrrr8r")rxrrmrzr{r#Útest_partial_velocityÑs4 &" 4&þÿ &r|cCs€tdƒ}tddd}tddd}tddd \}}td dd }|jdksJt‚|jsTt‚|js^t‚||||ksrt‚|js|t‚dS) NÚf1Úf2T)ÚrealÚf3)Zpositivezf4,f5F)Z commutativeÚf6)Úinteger)rZis_realrZ is_positiveÚ is_integer)r}r~r€Zf4Zf5rr"r"r#Útest_dynamicsymbolsòs     r„N)8Zsympy.core.numbersrZsympy.core.singletonrZsympy.core.symbolrZ(sympy.functions.elementary.miscellaneousrZ(sympy.functions.elementary.trigonometricrrZsympy.integrals.integralsrZsympy.physics.vectorr r r r Zsympy.physics.vector.functionsr rrrrrrrrZsympy.simplifyrZsympy.testing.pytestrr'r)r(rNZq5rrLr!rrrr rr$r*r,r.rCrDrTrfrsr|r„r"r"r"r#Ús4     ,  I++9!