
    gr                     |   d dl mZ d dlmZ d dlmZmZmZ d dlm	Z	 d dl
mZ d dlmZ d dlmZ d dlmZmZ d d	lmZ d d
lmZ  ed          Z ed          \  ZZZZZe                    deej                  Z e                     dee j!                  Z"e"                    dee"j#                  Z$d Z%d Z&d Z'dS )    )Vector)
CoordSys3D)expressmatrix_to_vectororthogonalize)Rational)S)symbols)sqrt)cossin)ImmutableDenseMatrix)raisesNzq1 q2 q3 q4 q5ABCc                  S   t          t          j        t                    t          j        k    sJ t          t          j        t                    t          j        u sJ t          t          j        t                    t          t                    t          j        z  t          t                    t          j        z  z   k    sJ t          t          j        t                    t          t                    t          t                    z  t          j        z  t          t                    t          j        z  z   t          t                    t          t                    z  t          j        z  z
  k    sJ t          t          j        t                    t          t                     t          t                    z  t          j        z  t          t                    t          j        z  z   t          t                    t          t                    z  t          j        z  z   k    sJ t          t          j        t                    t          t                    t          j        z  t          t                    t          j        z  z   k    sJ t          t          j        t                    t          t                     t          j        z  t          t                    t          j        z  z   k    sJ t          t          j        t                    t          j        k    sJ t          t          j        t                    t          j        k    sJ t          t          j        t                    t          j        k    sJ t          t          j        t                    t          j        k    sJ t          t          j        t                     t           j        k    sJ t          t          j        t                     t          t                    t           j        z  t          t                    t           j        z  z
  k    sJ t          t          j        t                     t          t                    t           j        z  t          t                    t           j        z  z   k    sJ t          t          j        t                    t          t                    t          j        z  t          t                    t          j        z  z   k    sJ t          t          j        t                    t          t                    t          t                    z  t          j        z  t          t                    t          j        z  z   t          t                    t          t                    z  t          j        z  z
  k    sJ t          t          j        t                    t          t                     t          t                    z  t          j        z  t          t                    t          j        z  z   t          t                    t          t                    z  t          j        z  z   k    sJ t          t          j        t                    t          j        k    sJ t          t          j        t                    t          j        k    sJ t          t          j        t                    t          j        k    sJ t          t          j        t                    t          t                    t          j        z  t          t                    t          j        z  z
  k    sJ t          t          j        t                    t          t                    t          j        z  t          t                    t          j        z  z   k    sJ t          t          j        t                    t          j        k    sJ t          t          j        t                     t          t                    t           j        z  t          t                    t          t                    z  t           j        z  z
  t          t                    t          t                    z  t           j        z  z   k    sJ t          t          j        t                     t          t                    t           j        z  t          t                    t          t                    z  t           j        z  z   t          t                    t          t                    z  t           j        z  z
  k    sJ t          t          j        t                     t          t                    t           j        z  t          t                    t           j        z  z   k    sJ t          t          j        t                    t          t                    t          t                    z  t          t                    t          t                    z  t          t                    z  z
  t          j        z  t          t                    t          t                    z  t          j        z  z
  t          t                    t          t                    z  t          t                    t          t                    z  t          t                    z  z   t          j        z  z   k    sJ t          t          j        t                    t          t                    t          t                    z  t          t                    t          t                    z  t          t                    z  z   t          j        z  t          t                    t          t                    z  t          j        z  z   t          t                    t          t                    z  t          t                    t          t                    z  t          t                    z  z
  t          j        z  z   k    sJ t          t          j        t                    t          t                     t          t                    z  t          j        z  t          t                    t          j        z  z   t          t                    t          t                    z  t          j        z  z   k    sJ t          t          j        t                    t          t                    t          j        z  t          t                    t          j        z  z   k    sJ t          t          j        t                    t          t                     t          j        z  t          t                    t          j        z  z   k    sJ t          t          j        t                    t          j        k    sJ t          t          j        t                    t          j        k    sJ t          t          j        t                    t          j        k    sJ t          t          j        t                    t          j        k    sJ t          t          j        t                     t           j        k    sJ t          t          j        t                     t          t                    t           j        z  t          t                    t           j        z  z
  k    sJ t          t          j        t                     t          t                    t           j        z  t          t                    t           j        z  z   k    sJ t          t          j        t                    t          t                    t          j        z  t          t                    t          j        z  z   k    sJ t          t          j        t                    t          t                    t          t                    z  t          j        z  t          t                    t          j        z  z   t          t                    t          t                    z  t          j        z  z
  k    sJ t          t          j        t                    t          t                     t          t                    z  t          j        z  t          t                    t          j        z  z   t          t                    t          t                    z  t          j        z  z   k    sJ t          t           j        t                    t          t                    t          j        z  t          t                    t          j        z  z   k    sJ t          t           j        t                    t          t                     t          t                    z  t          j        z  t          t                    t          t                    z  t          j        z  z   t          t                    t          j        z  z   k    sJ t          t           j        t                    t          t                    t          t                    z  t          j        z  t          t                    t          t                    z  t          j        z  z
  t          t                    t          j        z  z   k    sJ t          t           j        t                    t          j        k    sJ t          t           j        t                    t          t                    t          j        z  t          t                    t          j        z  z   k    sJ t          t           j        t                    t          t                     t          j        z  t          t                    t          j        z  z   k    sJ t          t           j        t                     t           j        k    sJ t          t           j        t                     t           j        k    sJ t          t           j        t                     t           j        k    sJ t          t           j        t                    t          t                    t          j        z  t          t                    t          j        z  z   k    sJ t          t           j        t                    t          j        k    sJ t          t           j        t                    t          t                     t          j        z  t          t                    t          j        z  z   k    sJ t          t          j        t                    t          t                    t          t                    z  t          t                    t          t                    z  t          t                    z  z
  t          j        z  t          t                    t          t                    z  t          t                    t          t                    z  t          t                    z  z   t          j        z  z   t          t                    t          t                    z  t          j        z  z
  k    sJ t          t          j        t                    t          t                     t          t                    z  t          j        z  t          t                    t          t                    z  t          j        z  z   t          t                    t          j        z  z   k    sJ t          t          j        t                    t          t                    t          t                    z  t          t                    t          t                    z  t          t                    z  z   t          j        z  t          t                    t          t                    z  t          t                    t          t                    z  t          t                    z  z
  t          j        z  z   t          t                    t          t                    z  t          j        z  z   k    sJ t          t          j        t                    t          t                    t          j        z  t          t                    t          t                    z  t          j        z  z   t          t                    t          t                    z  t          j        z  z
  k    sJ t          t          j        t                    t          t                    t          j        z  t          t                    t          j        z  z   k    sJ t          t          j        t                    t          t                    t          j        z  t          t                    t          t                    z  t          j        z  z
  t          t                    t          t                    z  t          j        z  z   k    sJ t          t          j        t                     t          t                    t           j        z  t          t                    t           j        z  z
  k    sJ t          t          j        t                     t           j        k    sJ t          t          j        t                     t          t                    t           j        z  t          t                    t           j        z  z   k    sJ t          t          j        t                    t          j        k    sJ t          t          j        t                    t          j        k    sJ t          t          j        t                    t          j        cxk    rt          j        k    sn J t          j        t          t          t                    t          j        z  t          t                    t          j        z  z
  t                                                    k    sJ t          j        t          t          t                    t          j        z  t          t                    t          j        z  z   t                                                    k    sJ t          j        t          t          t                    t           j        z  t          t                    t          t                    z  t           j        z  z
  t          t                    t          t                    z  t           j        z  z   t                                                    k    sJ t          j        t          t          t                    t           j        z  t          t                    t          t                    z  t           j        z  z   t          t                    t          t                    z  t           j        z  z
  t                                                    k    sJ t          j        t          t          t                    t           j        z  t          t                    t           j        z  z   t                                                    k    sJ t          j        t          t          t                    t          j        z  t          t                    t          j        z  z   t                                                    k    sJ t          j        t          t          t                     t          j        z  t          t                    t          j        z  z   t                                                    k    sJ t          j        t          t          t                    t           j        z  t          t                    t           j        z  z
  t                                                    k    sJ t          j        t          t          t                    t           j        z  t          t                    t           j        z  z   t                                                    k    sJ t          j        t          t          t                    t          j        z  t          t                    t          j        z  z   t                                                    k    sJ t          j        t          t          t                    t          t                    z  t          j        z  t          t                    t          j        z  z   t          t                    t          t                    z  t          j        z  z
  t                                                    k    sJ t          j        t          t          t                     t          t                    z  t          j        z  t          t                    t          j        z  z   t          t                    t          t                    z  t          j        z  z   t                                                    k    sJ t           j        t          t          t                    t          j        z  t          t                    t          j        z  z   t                                                     k    sJ t           j        t          t          t                     t          t                    z  t          j        z  t          t                    t          t                    z  t          j        z  z   t          t                    t          j        z  z   t                                                     k    sJ t           j        t          t          t                    t          t                    z  t          j        z  t          t                    t          t                    z  t          j        z  z
  t          t                    t          j        z  z   t                                                     k    sJ t           j        t          t          t                    t          j        z  t          t                    t          j        z  z   t                                                     k    sJ t           j        t          t          t                     t          j        z  t          t                    t          j        z  z   t                                                     k    sJ t           j        t          t          t                    t          j        z  t          t                    t          j        z  z   t                                                     k    sJ t           j        t          t          t                     t          j        z  t          t                    t          j        z  z   t                                                     k    sJ t          j        t          t          t                    t          j        z  t          t                    t          t                    z  t          j        z  z   t          t                    t          t                    z  t          j        z  z
  t                                                    k    sJ t          j        t          t          t                    t          j        z  t          t                    t          j        z  z   t                                                    k    sJ t          j        t          t          t                    t          j        z  t          t                    t          t                    z  t          j        z  z
  t          t                    t          t                    z  t          j        z  z   t                                                    k    sJ t          j        t          t          t                    t           j        z  t          t                    t           j        z  z
  t                                                    k    sJ t          j        t          t          t                    t           j        z  t          t                    t           j        z  z   t                                                    k    sJ d S N)r   r   zeror   r	   Zeror   ir   r   q3r   kjq2q1r   simplify     ]/var/www/html/ai-engine/env/lib/python3.11/site-packages/sympy/vector/tests/test_functions.pytest_expressr"      s   6;""fk1111161''''13??c"ggackCGGACK7777713??c"ggc"ggoac1CGGACK?BB    13??s2wwhs2ww.qs2SWWQS[@BB    13??c"ggackCGGACK7777713??s2wwhqslSWWQS[8888813??ac!!!!13??ac!!!!13??ac!!!!13??ac!!!!13??ac!!!!13??c"ggackCGGACK7777713??c"ggackCGGACK7777713??c"ggackCGGACK7777713??c"ggc"ggoac1CGGACK?BB    13??s2wwhs2ww.qs2SWWQS[@BB     13??ac!!!!13??ac!!!!13??ac!!!!13??s2wwqs{SWWQS[8999913??s2wwqs{SWWQS[8999913??ac!!!!13??s2wwqs{SWWSWW_QS-@@GGCGGOAC   ! ! ! !13??s2wwqs{SWWSWW_QS-@@GGCGGOAC   ! ! ! !13??s2wwqs{SWWQS[8999913??	RR3r773r77?3r772	2AC7BB		RR3r773r77?3r772	2AC7	89 9 9 9 13??	RR3r773r77?3r772	2AC7BB		RR3r773r77?3r772	2AC7	89 9 9 9 13??BxB/3c"ggackAGGCGGOAC   ! ! ! ! 13??s2wwqs{SWWQS[8999913??Bx|c"ggack9::::13??ac!!!!13??ac!!!!13??ac!!!!13??ac!!!!13??ac!!!!13??s2wwqs{SWWQS[8999913??s2wwqs{SWWQS[8999913??s2wwqs{SWWQS[8999913??s2wws2wwqs2SWWQS[@GGCGGOAC   ! ! ! !13??BxB/3c"ggackAGGCGGOAC   ! ! ! ! 13??s2wwqs{SWWQS[8999913??BxB/3GGCGGOAC  "%b''!#+ . / / / /13??s2wws2wwqs2GGCGGOAC  "%b''!#+ . / / / /13??ac!!!!13??s2wwqs{SWWQS[8999913??Bx|c"ggack9::::13??ac!!!!13??ac!!!!13??ac!!!!13??s2wwqs{SWWQS[8999913??ac!!!!13??Bx|c"ggack9::::13??	RR3r773r77?3r772	2AC7	RR3r773r77?3r772	2AC7	8BB	    13??	RRs2wws2wwqs22SWWQS[@B B B B13??	RR3r773r77?3r772	2AC7	RR3r773r77?3r772	2AC7	8BB	    13??s2wwqs{SWWSWW_QS-@@GGCGGOAC   ! ! ! !13??s2wwqs{SWWQS[8999913??s2wwqs{SWWSWW_QS-@@GGCGGOAC   ! ! ! !13??s2wwqs{SWWQS[8999913??ac!!!!13??s2wwqs{SWWQS[8999913??ac!!!!13??ac!!!!13??ac****ac****** 3'3r7713;R4q99BBDDDDDD3'3r7713;R4q99BBDDDDDD3'3r7713;RR)<<GGCGGOAC "#% %%-XZZ0 0 0 03'3r7713;RR)<<BB! !!), , , ,3'3r7713;R4q99BBDDDDDD 3'3r7713;R4q99BBDDDDDD3'CGG8AC<#b''!#+5::CCEEEEEE3'3r7713;R4q99BBDDDDDD3'3r7713;R4q99BBDDDDDD3'3r7713;R4q99BBDDDDDD3'3r773r77?13.R<GGCGGOAC "#% %%-XZZ0 0 0 0 3'CGG8CGG+AC/#b''!#+=GGCGGOAC "#% %%-XZZ0 0 0 03'3r7713;R4q99BBDDDDDD3'CGG8CGG+AC/GGCGGOAC "%b''!#+.013 33;8::> > > > 3'3r773r77?13.GGCGGOAC "%b''!#+.013 33;8::> > > > 3'3r7713;R4q99BBDDDDDD3'CGG8AC<#b''!#+5::CCEEEEEE3'3r7713;R4q99BBDDDDDD3'CGG8AC<#b''!#+5::CCEEEEEE3'3r7713;RR)<<GGCGGOAC "#% %%-XZZ0 0 0 03'3r7713;R4q99BBDDDDDD3'3r7713;RR)<<GGCGGOAC "#% %%-XZZ0 0 0 03'3r7713;R4q99BBDDDDDD3'3r7713;R4q99BBDDDDDDDDr    c                  \   t          dgdgdgg          } t          | t                    t          j        dt          j        z  z   dt          j        z  z   k    sJ t          dgdgdgg          } t          | t                    t          | t                    cxk    rt          j        k    sn J t          t          gt          gt          gg          } t          | t                    t          t          j        z  t          t          j        z  z   t          t          j        z  z   k    sJ d S )N         r   )Matrixr   r   r   r   r   r   r   r   r   r   r   )ms    r!   test_matrix_to_vectorr)      s   aS1#AAq!!QS1QS5[1QS5%88888aS1#AAq!!%5a%;%;    ;     rdRD!""AAq!!RVbf_r!#v%=======r    c                  (  	
 t          d          } t          dd          \  }}|                                 \  }}}|d|z  z   d|z  d|z  z   	d|z  d|z  z   
d|z  |z   }d|z  d|z  z   }||z  ||z  z   d|z  |z  d|z  |z  z   t          	          | j        d| j        z  z   | j        t          dd          z  | j         dz  z   gk    sJ t          ||d	          dt          d
          z  | j        z  d
z  t          d
          | j        z  d
z  z   t          d
           | j        z  d
z  dt          d
          z  | j        z  d
z  z   gk    sJ t          t          	
fd           t          t          fd           d S )Nr   za bT)integerr%   r&         )orthonormal
   c                  &    t                     S r   r   )v1v2v3s   r!   <lambda>z$test_orthogonalize.<locals>.<lambda>   s    }RR88 r    c                  $    t                     S r   r1   )v6v7s   r!   r5   z$test_orthogonalize.<locals>.<lambda>   s    }R44 r    )
r   r
   base_vectorsr   r   r   r   r   r   
ValueError)r   abr   r   r   v4v5r2   r3   r4   r7   r8   s           @@@@@r!   test_orthogonalizer?      s   3A5$'''DAqnnGAq!	
QqSB	
1qsB	
1qsB	
1qB	
1qsB	
1qsB	
1Q1QBR  QS1QS5[!#hq!nn2DtAv2M$NNNNNRT222
DHH*ac	"	R!#~b0	0DHH9ac/"2D$r((
TUTWGWXZGZ2Z[\ \ \ \
:888888999
:4444455555r    N)(sympy.vector.vectorr   sympy.vector.coordsysrectr   sympy.vector.functionsr   r   r   sympy.core.numbersr   sympy.core.singletonr	   sympy.core.symbolr
   (sympy.functions.elementary.miscellaneousr   (sympy.functions.elementary.trigonometricr   r   sympy.matrices.immutabler   r'   sympy.testing.pytestr   r   r   r   r   q4q5orient_new_axisr   r   r   r   r   r   r"   r)   r?   r   r    r!   <module>rM      s|   & & & & & & 0 0 0 0 0 0 K K K K K K K K K K ' ' ' ' ' ' " " " " " " % % % % % % 9 9 9 9 9 9 ? ? ? ? ? ? ? ? C C C C C C ' ' ' ' ' 'JsOOW-.. BBc2qs##c2qs##c2qs##HE HE HEV> > >6 6 6 6 6r    