o GZŽhrã@sêddlmZddlmZddlmZmZmZddlm Z ddl m Z ddl m Z ddlmZddlmZmZdd lmZdd lmZed ƒZe d ƒ\ZZZZZe d eej¡Z e  dee j!¡Z"e" dee"j#¡Z$dd„Z%dd„Z&dd„Z'dS)é)ÚVector)Ú CoordSys3D)ÚexpressÚmatrix_to_vectorÚ orthogonalize)ÚRational)ÚS)Úsymbols)Úsqrt)ÚcosÚsin)ÚImmutableDenseMatrix)ÚraisesÚNzq1 q2 q3 q4 q5ÚAÚBÚCcCs@ttjtƒtjks J‚ttjtƒtjusJ‚ttjtƒt t ƒtjt t ƒtj ks,J‚ttj tƒt tƒt t ƒtjt tƒtj t tƒt t ƒtj ksQJ‚ttj tƒt t ƒ t tƒtjt tƒtj t tƒt t ƒtj kswJ‚ttjtƒt tƒtjt tƒtj ksJ‚ttj tƒt tƒ tjt tƒtj ks¤J‚ttj tƒtj ks¯J‚ttjtƒtjksºJ‚ttj tƒtj ksÅJ‚ttj tƒtj ksÐJ‚ttjtƒtjksÛJ‚ttj tƒt tƒtj t tƒtj ksñJ‚ttj tƒt tƒtj t tƒtj ksJ‚ttjtƒt t ƒtjt t ƒtj ksJ‚ttj tƒt tƒt t ƒtjt tƒtj t tƒt t ƒtj ksEJ‚ttj tƒt t ƒ t tƒtjt tƒtj t tƒt t ƒtj kslJ‚ttjtƒtjksxJ‚ttj tƒtj ks„J‚ttj tƒtj ksJ‚ttjtƒt tƒtjt tƒtj ks§J‚ttj tƒt tƒtjt tƒtj ks¾J‚ttj tƒtj ksÊJ‚ttjtƒt tƒtjt tƒt tƒtj t tƒt tƒtj ksðJ‚ttj tƒt tƒtjt tƒt tƒtj t tƒt tƒtj ksJ‚ttj tƒt tƒtj t tƒtj ks-J‚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 ksoJ‚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 ks±J‚ttj tƒt t ƒ t tƒtjt tƒtj t tƒt t ƒtj ksØJ‚ttjtƒt tƒtjt tƒtj ksïJ‚ttj tƒt tƒ tjt tƒtj ksJ‚ttj tƒtj ksJ‚ttjtƒtjksJ‚ttj tƒtj ks+J‚ttj tƒtj ks7J‚ttjtƒtjksCJ‚ttj tƒt tƒtj t tƒtj ksZJ‚ttj tƒt tƒtj t tƒtj ksqJ‚ttjtƒt t ƒtjt t ƒtj ksˆJ‚ttj tƒt tƒt t ƒtjt tƒtj t tƒt t ƒtj ks®J‚ttj tƒt t ƒ t tƒtjt tƒtj t tƒt t ƒtj ksÕJ‚ttjtƒt tƒtjt tƒtj ksìJ‚ttj tƒt tƒ t tƒtjt tƒt tƒtj t tƒtj ksJ‚ttj tƒt tƒt tƒtjt tƒt tƒtj t tƒtj ks9J‚ttjtƒtjksEJ‚ttj tƒt tƒtj t tƒtj ks\J‚ttj tƒt tƒ tj t tƒtj kstJ‚ttjtƒtjks€J‚ttj tƒtj ksŒJ‚ttj tƒtj ks˜J‚ttjtƒt t ƒtjt t ƒtj ks¯J‚ttj tƒtj ks»J‚ttj tƒt t ƒ tjt t ƒtj ksÓJ‚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 ksJ‚ttj tƒt tƒ t tƒtjt tƒt tƒtj t tƒtj ks·s z$test_orthogonalize..cs tˆˆƒSrr)r)Úv6Úv7rrr-¸s ) rr Z base_vectorsrrrrr rÚ ValueError)rÚaÚbrrrZv4Zv5r)r*r+r,r.r/rÚtest_orthogonalize¨s   : Pÿr3N)(Zsympy.vector.vectorrZsympy.vector.coordsysrectrZsympy.vector.functionsrrrZsympy.core.numbersrZsympy.core.singletonrZsympy.core.symbolr Z(sympy.functions.elementary.miscellaneousr Z(sympy.functions.elementary.trigonometricr r Zsympy.matrices.immutabler r"Zsympy.testing.pytestrrrrrZq4Zq5Zorient_new_axisrrrrrrrr$r3rrrrÚs&