a
    lº”hr  ã                   @   sê   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d„ Z%dd„ Z&d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                   C   sN  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 tt
ƒtj  ksXJ ‚t tjtƒttƒtt
ƒ tj t	tƒtj  ttƒt	t
ƒ tj  ks¢J ‚t tjtƒtt
ƒ t	tƒ tj ttƒtj  t	tƒt	t
ƒ tj  ksîJ ‚t tjtƒt	tƒtj ttƒtj  ksJ ‚t tjtƒttƒ tj t	tƒtj  ksLJ ‚t tjtƒtjksdJ ‚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 ttƒtj  ksòJ ‚t tjtƒttƒtj t	tƒtj  ks J ‚t tjtƒt	t
ƒtj tt
ƒtj  ksNJ ‚t tjtƒttƒtt
ƒ tj t	tƒtj  ttƒt	t
ƒ tj  ksšJ ‚t tjtƒtt
ƒ t	tƒ tj ttƒtj  t	tƒt	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s0J ‚t tjtƒt	tƒtj ttƒtj  ks^J ‚t tjtƒttƒtj t	tƒtj  ksŒJ ‚t tjtƒtjks¤J ‚t tjtƒt	tƒtj ttƒt	tƒ tj  ttƒttƒ tj  ksðJ ‚t tjtƒttƒtj t	tƒt	tƒ tj  ttƒt	tƒ tj  ks<J ‚t tjtƒttƒtj t	tƒtj  ksjJ ‚t tjtƒt	tƒt	t
ƒ ttƒttƒ tt
ƒ  tj ttƒt	tƒ tj  tt
ƒt	tƒ ttƒttƒ t	t
ƒ  tj  ksîJ ‚t tjtƒttƒt	t
ƒ ttƒtt
ƒ t	tƒ  tj t	tƒt	tƒ tj  ttƒtt
ƒ ttƒt	tƒ t	t
ƒ  tj  ksrJ ‚t tjtƒtt
ƒ t	tƒ tj ttƒtj  t	tƒt	t
ƒ tj  ksÀJ ‚t tjtƒt	tƒtj ttƒtj  ksîJ ‚t tjtƒttƒ tj t	tƒtj  ksJ ‚t tjtƒtjks6J ‚t tjtƒtjksNJ ‚t tjtƒtjksfJ ‚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 ttƒtj  ksÄJ ‚t tjtƒttƒtj t	tƒtj  ksòJ ‚t tjtƒt	t
ƒtj tt
ƒtj  ks J ‚t tjtƒttƒtt
ƒ tj t	tƒtj  ttƒt	t
ƒ tj  kslJ ‚t tjtƒtt
ƒ t	tƒ tj ttƒtj  t	tƒt	t
ƒ tj  ksºJ ‚t tjtƒt	tƒtj ttƒtj  ksèJ ‚t tjtƒttƒ t	tƒ tj t	tƒt	tƒ tj  ttƒtj  ks6J ‚t tjtƒttƒttƒ tj ttƒt	tƒ tj  t	tƒtj  ks‚J ‚t tjtƒtjksšJ ‚t tjtƒt	tƒtj ttƒtj  ksÈJ ‚t tjtƒttƒ tj t	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 tt
ƒtj  k	snJ ‚t tjtƒtjk	s†J ‚t tjtƒtt
ƒ tj t	t
ƒtj  k	s¶J ‚t tjtƒt	tƒt	t
ƒ ttƒttƒ tt
ƒ  tj ttƒt	t
ƒ ttƒtt
ƒ t	tƒ  tj  tt
ƒt	tƒ tj  k
s:J ‚t tjtƒttƒ t	tƒ tj t	tƒt	tƒ tj  ttƒtj  k
sˆJ ‚t tjtƒtt
ƒt	tƒ ttƒttƒ t	t
ƒ  tj ttƒtt
ƒ ttƒt	tƒ t	t
ƒ  tj  t	tƒt	t
ƒ tj  ksJ ‚t tjtƒt	t
ƒtj ttƒtt
ƒ tj  tt
ƒt	tƒ tj  ksXJ ‚t tjtƒt	tƒtj ttƒtj  ks†J ‚t tjtƒtt
ƒtj ttƒt	t
ƒ tj  t	tƒt	t
ƒ tj  ksÒJ ‚t tjtƒt	t
ƒtj tt
ƒtj  ks J ‚t tjtƒtjksJ ‚t tjtƒtt
ƒtj t	t
ƒtj  ksFJ ‚t tjtƒtjks^J ‚t tjtƒtjksvJ ‚t tjtƒtj  krštjks n J ‚tjt t	tƒtj ttƒtj  tƒ ¡ ksÒJ ‚tjt ttƒtj t	tƒtj  tƒ ¡ ksJ ‚tjt t	tƒtj ttƒt	tƒ tj  ttƒttƒ tj  tƒ ¡ ksTJ ‚tjt ttƒtj t	tƒt	tƒ tj  ttƒt	tƒ tj  tƒ ¡ ks¤J ‚tjt ttƒtj t	tƒtj  tƒ ¡ ksÖJ ‚tjt t	tƒtj ttƒtj  tƒ ¡ ksJ ‚tjt ttƒ tj t	tƒtj  tƒ ¡ ks<J ‚tjt t	tƒtj ttƒtj  tƒ ¡ ksnJ ‚tjt ttƒtj t	tƒtj  tƒ ¡ ks J ‚tjt t	t
ƒtj tt
ƒtj  tƒ ¡ ksÒJ ‚tjt ttƒtt
ƒ tj t	tƒtj  ttƒt	t
ƒ tj  tƒ ¡ ks"J ‚tjt tt
ƒ t	tƒ tj ttƒtj  t	tƒt	t
ƒ tj  tƒ ¡ kstJ ‚tjt t	tƒtj ttƒtj  tƒ ¡ ks¦J ‚tjt ttƒ t	tƒ tj t	tƒt	tƒ tj  ttƒtj  tƒ ¡ ksøJ ‚tjt ttƒttƒ tj ttƒt	tƒ tj  t	tƒtj  tƒ ¡ ksHJ ‚tjt t	tƒtj ttƒtj  tƒ ¡ kszJ ‚tjt ttƒ tj t	tƒtj  tƒ ¡ ks®J ‚tjt t	t
ƒtj tt
ƒtj  tƒ ¡ ksàJ ‚tjt tt
ƒ tj t	t
ƒtj  tƒ ¡ ksJ ‚tjt t	t
ƒtj ttƒtt
ƒ tj  tt
ƒt	tƒ tj  tƒ ¡ ksdJ ‚tjt t	tƒtj ttƒtj  tƒ ¡ ks–J ‚tjt tt
ƒtj ttƒt	t
ƒ tj  t	tƒt	t
ƒ tj  tƒ ¡ ksæJ ‚tjt t	t
ƒtj tt
ƒtj  tƒ ¡ ksJ ‚tjt tt
ƒtj t	t
ƒtj  tƒ ¡ ksJJ ‚d S ©N)r   r   Úzeror   r   ZZeror   Úir   r   Úq3r   ÚkÚjÚq2Úq1r   Zsimplify© r   r   úO/var/www/auris/lib/python3.9/site-packages/sympy/vector/tests/test_functions.pyÚtest_express   sj   ,,ÿ
.ÿ
.0...,ÿ.ÿ..,ÿ,ÿ.
,ÿ,þÿ

,ÿ,þÿ
.ÿ.0...,ÿ.ÿ. ÿÿÿÿ.0.0
,,ÿþÿ

:ÿ

,,ÿþÿ
,ÿ.,ÿ..*22(ÿÿ(ÿÿ224222(ÿÿ*ÿÿ2ÿÿÿÿÿÿ2424(ÿÿ2(ÿÿ2r   c                  C   s¼   t dgdgdggƒ} t| tƒtjdtj  dtj  ks<J ‚t dgdgdggƒ} t| tƒt| tƒ  krrtjksxn J ‚t t	gt
gtggƒ} t| tƒt	tj t
tj  ttj  ks¸J ‚d S )Né   é   é   r   )ÚMatrixr   r   r   r   r   r   r   r   r   r   r   )Úmr   r   r   Útest_matrix_to_vectorž   s    (ÿr#   c                     sd  t dƒ} tddd\}}|  ¡ \}}}|d|  ‰ d| d|  ‰d| d|  ‰d| | }d| d|  }|| ||  ‰d| | d| |  ‰tˆ ˆƒ| jd| j  | jtddƒ | j d  gksÐJ ‚t||dd	dtd
ƒ | j d
 td
ƒ| j d
  td
ƒ | j d
 dtd
ƒ | j d
  gks6J ‚tt	‡ ‡‡fdd„ƒ tt	‡‡fdd„ƒ d S )Nr   za bT)Úintegerr   r    é   é   )Zorthonormalé
   c                      s   t ˆ ˆˆƒS r   ©r   r   )Úv1Úv2Úv3r   r   Ú<lambda>·   ó    z$test_orthogonalize.<locals>.<lambda>c                      s
   t ˆ ˆƒS r   r(   r   )Úv6Úv7r   r   r,   ¸   r-   )
r   r	   Zbase_vectorsr   r   r   r   r
   r   Ú
ValueError)r   ÚaÚbr   r   r   Zv4Zv5r   )r)   r*   r+   r.   r/   r   Útest_orthogonalize¨   s     :Pÿ
r3   N)(Zsympy.vector.vectorr   Zsympy.vector.coordsysrectr   Zsympy.vector.functionsr   r   r   Zsympy.core.numbersr   Zsympy.core.singletonr   Zsympy.core.symbolr	   Z(sympy.functions.elementary.miscellaneousr
   Z(sympy.functions.elementary.trigonometricr   r   Zsympy.matrices.immutabler   r!   Zsympy.testing.pytestr   r   r   r   r   Zq4Zq5Zorient_new_axisr   r   r   r   r   r   r   r#   r3   r   r   r   r   Ú<module>   s$    
