§
    m¬¸j[ ã                   óL  — d dl Z d dlZd dlmZmZ d dlmZ d dlmZm	Z	 d dl
mZ d dlmZ d dlZd dlZd„ Zd„ Zd	„ Zd
„ Zd„ Zd„ Zd„ Zd„ Zd„ Zd„ Zd„ Zd„ Zd„ Zd„ Zd„ Zd„ Zd„ Z d„ Z!d„ Z"d„ Z#d„ Z$d„ Z%d„ Z&d„ Z'd„ Z(d „ Z)d!„ Z*d"„ Z+d#„ Z,d$„ Z-d%„ Z.d&„ Z/d'„ Z0d(„ Z1d)„ Z2d*„ Z3d+„ Z4d,„ Z5d-„ Z6d.„ Z7d/„ Z8d0„ Z9d1„ Z:d2„ Z;d3„ Z<d4„ Z=d5„ Z>d6„ Z?d7„ Z@d8„ ZAd9„ ZBd:„ ZCe jD         E                    d; ed<¦  «        ¦  «        e jD         E                    d=d>¦  «        d?„ ¦   «         ¦   «         ZFe jD         E                    d; ed<¦  «        ¦  «        e jD         E                    d=d>¦  «        d@„ ¦   «         ¦   «         ZGe jD        jH        e jD         E                    d; ed<¦  «        ¦  «        e jD         E                    d=d>¦  «        dA„ ¦   «         ¦   «         ¦   «         ZIe jD        jH        e jD         E                    d; ed<¦  «        ¦  «        e jD         E                    d=d>¦  «        dB„ ¦   «         ¦   «         ¦   «         ZJe jD        jH        e jD         E                    d; ed<¦  «        ¦  «        e jD         E                    d=d>¦  «        dC„ ¦   «         ¦   «         ¦   «         ZKdD„ ZLdE„ ZMdF„ ZNdG„ ZOdH„ ZPdI„ ZQdJ„ ZRdK„ ZSdL„ ZTe jD        jH        dM„ ¦   «         ZUdN„ ZVdO„ ZWdP„ ZXdQ„ ZYdR„ ZZdS„ Z[dT„ Z\dU„ Z]dV„ Z^dW„ Z_dX„ Z`dY„ ZadZ„ Zbd[„ Zcd\„ Zdd]„ Zed^„ Zfd_„ Zgd`„ Zhda„ Zidb„ Zjdc„ Zkdd„ Zlde„ Zmdf„ Zndg„ Zodh„ Zpdi„ Zqdj„ Zrdk„ Zsdl„ Ztdm„ ZudnZvdo„ Zwdp„ Zxdq„ Zydr„ Zzds„ Z{dt„ Z|du„ Z}dv„ Z~dw„ Zdx„ Z€dy„ Z�dz„ Z‚d{„ Zƒd|„ Z„d}„ Z…d~„ Z†d„ Z‡d€„ Zˆd�„ Z‰d‚„ ZŠdƒ„ Z‹d„„ ZŒd…„ Z�d†„ ZŽe jD        jH        d‡„ ¦   «         Z�dˆ„ Z�d‰„ Z‘dŠ„ Z’d‹„ Z“dŒ„ Z”d�„ Z•dŽ„ Z–d�„ Z—d�„ Z˜d‘„ Z™d’„ Zšd“„ Z›d”„ Zœd•„ Z�dS )–é    N)Úassert_equalÚassert_array_almost_equal)Úassert_allclose)ÚRotationÚSlerp)Úspecial_ortho_group)Úpermutationsc                 óB   — | dk    rg d¢S | dk    rg d¢S | dk    rg d¢S d S )NÚx©é   r   r   Úy©r   r   r   Úz©r   r   r   © ©Úaxiss    ú{/root/private/project/pallet_detection_v2/.venv/lib/python3.11/site-packages/scipy/spatial/transform/tests/test_rotation.pyÚ	basis_vecr      sB   € Øˆs‚{€{ØˆyˆyÐØ	�ŠˆØˆyˆyÐØ	�ŠˆØˆyˆyÐð 
ˆó    c                  óÜ   — t          j        g d¢g d¢g¦  «        } t          j        | ¦  «        }| t          j        dgdgg¦  «        z  }t	          |                     ¦   «         |¦  «         d S )N©é   é   r   r   )é   é   r   r   r   é   ©ÚnpÚarrayr   Ú	from_quatr   Úas_quat©r   ÚrÚexpected_quats      r   Útest_generic_quat_matrixr'      sh   € Ý
Œ�,�,�,   Ð.Ñ/Ô/€AÝÔ˜1ÑÔ€AØ�œ 1 #¨ t Ñ-Ô-Ñ-€MÝ˜aŸiši™kœk¨=Ñ9Ô9Ð9Ð9Ð9r   c                  ó¨   — t          j        g d¢¦  «        } t          j        | ¦  «        }| dz  }t	          |                     ¦   «         |¦  «         d S ©Nr   r   r   r$   s      r   Útest_from_single_1d_quaternionr*      sL   € Ý
Œ���ÑÔ€AÝÔ˜1ÑÔ€AØ˜‘E€MÝ˜aŸiši™kœk¨=Ñ9Ô9Ð9Ð9Ð9r   c                  óª   — t          j        g d¢g¦  «        } t          j        | ¦  «        }| dz  }t	          |                     ¦   «         |¦  «         d S r)   r   r$   s      r   Útest_from_single_2d_quaternionr,   #   sN   € Ý
Œ�,�,�,�Ñ Ô €AÝÔ˜1ÑÔ€AØ˜‘E€MÝ˜aŸiši™kœk¨=Ñ9Ô9Ð9Ð9Ð9r   c                  ó–  — t           j                             d¦  «        } t          j        g d¢d¬¦  «        }t          |                     ¦   «         t          j        d¦  «        dd¬¦  «         t          j        t          j        g d¢d	¦  «        d¬¦  «        }t          |                     ¦   «         t          j        t          j        d¦  «        d
¦  «        dd¬¦  «         |  	                    dd¦  «        }|t           j
                             |d¬¦  «        d d …d f         z  }|D ]O}t          j        |d¬¦  «        }t          t          j        |                     ¦   «         d¦  «        |d¬¦  «         ŒPt          j        |d¬¦  «        }t          t          j        |                     ¦   «         dd¬¦  «        |d¬¦  «         d S )Nr   ©r   r   r   r   T©Úscalar_firstr   çVçž¯Ò<ç¼‰Ø—²Òœ<©ÚrtolÚatol©é
   r   )r7   r   r   éd   r   r   r   ©r4   )r    ÚrandomÚRandomStater   r"   r   Ú	as_matrixÚeyeÚtileÚrandnÚlinalgÚnormÚrollr#   ©Úrngr%   ÚqÚqis       r   Útest_from_quat_scalar_firstrG   *   s‘  € Ý
Œ)×
Ò
 Ñ
"Ô
"€CåÔ˜<˜<˜<°dÐ;Ñ;Ô;€AÝ�A—K’K‘M”M¥2¤6¨!¡9¤9°5¸uÐEÑEÔEÐEåÔ�2œ7 < < <°Ñ9Ô9ÈÐMÑMÔM€AÝ�A—K’K‘M”M¥2¤7­2¬6°!©9¬9°jÑ#AÔ#AØ Uð,ñ ,ô ,ð ,ð 	�	Š	�#�qÑÔ€AØ�Œ�Š˜ ˆÑ	"Ô	" 1 1 1 d 7Ô	+Ñ+€AØð Að AˆÝÔ˜r°Ð5Ñ5Ô5ˆÝ�œ §	¢	¡¤¨QÑ/Ô/°¸%Ð@Ñ@Ô@Ð@Ð@åÔ˜1¨4Ð0Ñ0Ô0€AÝ•B”G˜AŸIšI™KœK¨°Ð3Ñ3Ô3°Q¸UÐCÑCÔCÐCÐCÐCr   c            	      ó°  — t           j                             d¦  «        } t          j        dt          j        d¦  «        ¦  «        }t          |                     d¬¦  «        g d¢dd¬	¦  «         t          j        dt          j        d
¦  «        ¦  «        }t          |                     d¬¦  «        t          j        g d¢d¦  «        dd¬	¦  «         |  	                    dd¦  «        }|t           j
                             |d¬¦  «        d d …d f         z  }|D ]�}t          j        |¦  «        }t          |                     d¬¦  «        t          j        |d¦  «        d¬¦  «         t          |                     dd¬¦  «        t          j        |                     d¬¦  «        d¦  «        d¬¦  «         Œžt          j        |¦  «        }t          |                     d¬¦  «        t          j        |dd¬¦  «        d¬¦  «         t          |                     dd¬¦  «        t          j        |                     d¬¦  «        dd¬¦  «        d¬¦  «         d S )Nr   Úxyzr   Tr/   r.   r1   r2   r3   )r7   r   r6   r8   r   r   r   r9   )Ú	canonicalr0   ©rJ   )r    r:   r;   r   Ú
from_eulerÚzerosr   r#   r>   r?   r@   rA   r"   rB   rC   s       r   Útest_as_quat_scalar_firstrN   >   sT  € Ý
Œ)×
Ò
 Ñ
"Ô
"€CåÔ˜E¥2¤8¨A¡;¤;Ñ/Ô/€AÝ�A—I’I¨4�IÑ0Ô0°,°,°,Ø Uð,ñ ,ô ,ð ,õ 	Ô˜E¥2¤8¨GÑ#4Ô#4Ñ5Ô5€AÝ�A—I’I¨4�IÑ0Ô0Ý”G˜L˜L˜L¨'Ñ2Ô2¸ÀUðLñ Lô Lð Lð 	�	Š	�#�qÑÔ€AØ�Œ�Š˜ ˆÑ	"Ô	" 1 1 1 d 7Ô	+Ñ+€AØð $ð $ˆÝÔ˜rÑ"Ô"ˆÝ˜Ÿ	š	¨t˜	Ñ4Ô4µb´g¸bÀ!±n´nØ"ð	$ñ 	$ô 	$ð 	$õ 	˜Ÿ	š	¨D¸t˜	ÑDÔDÝœ §	¢	°D 	Ñ 9Ô 9¸1Ñ=Ô=Ø"ð	$ñ 	$ô 	$ð 	$ð 	$õ 	Ô˜1ÑÔ€AÝ�A—I’I¨4�IÑ0Ô0µ"´'¸!¸QÀQÐ2GÑ2GÔ2GØð ñ  ô  ð  õ �A—I’I¨¸4�IÑ@Ô@Ý”G˜AŸIšI°˜IÑ5Ô5°q¸qÐAÑAÔAÈðOñ Oô Oð Oð Oð Or   c            	      ó  — t          j        g d¢g d¢g d¢g d¢g d¢g d¢g¦  «        } t          j        | ¦  «        }| t          j        dgdgd	gd
gd	gd
gg¦  «        z  }t	          |                     ¦   «         |¦  «         d S )N)r   r   r   r   ©r   r   r   r   ©r   r   r   r   )éÿÿÿÿrR   rR   r   ©r   r   r   rR   ©rR   rR   rR   rR   r   r   r   é   r   r$   s      r   Útest_from_square_quat_matrixrV   \   s¡   € å
ŒØˆˆØˆˆØˆˆØˆˆØˆˆØÐÐð
ñ 	ô 	€Aõ 	Ô˜1ÑÔ€AØ�œ 1 #¨ t¨a¨S°1°#¸°s¸Q¸CÐ!@ÑAÔAÑA€MÝ˜aŸiši™kœk¨=Ñ9Ô9Ð9Ð9Ð9r   c                  ó<  — t          j        g d¢g d¢g d¢g d¢g d¢g¦  «        } t          j        | ¦  «        }t          j        | ¦  «        t           j                             | d¬¦  «        d d …d f         z  }t          |                     d¬	¦  «        |¦  «         d S )
N)rR   r   r   r   )r   rR   r   r   )r   r   rR   r   rS   rT   r   r   TrK   )	r    r!   r   r"   Úabsr@   rA   r   r#   r$   s      r   Ú*test_quat_double_to_canonical_single_coverrY   k   s¤   € Ý
ŒØˆˆØˆˆØˆˆØˆˆØÐÐð
ñ 	ô 	€Aõ 	Ô˜1ÑÔ€AÝ”F˜1‘I”I¥¤	§¢¨q°q Ñ 9Ô 9¸!¸!¸!¸T¸'Ô BÑB€MÝ�A—I’I¨�IÑ-Ô-¨}Ñ=Ô=Ð=Ð=Ð=r   c                  ó8  — t          j        g d¢¦  «        } t          j        | ¦  «        }t	          | |                     d¬¦  «        ¦  «         t          j        g d¢¦  «        t          j        d¦  «        z  } t          j        | ¦  «        }||z  |z  }t          |                     d¬¦  «        t          j        d¦  «        z  g d¢¦  «         t          |                     ¦   «                              d¬¦  «        t          j        d¦  «        z  g d¢¦  «         t          |                     d¬¦  «        t          j        d¦  «        z  g d¢¦  «         t          |                     ¦   «                              d¬¦  «        t          j        d¦  «        z  g d¢¦  «         t          ||                     ¦   «         z                       d¬¦  «        g d	¢d
¬¦  «         t          ||                     ¦   «         z                       d¬¦  «        g d	¢d
¬¦  «         t          ||z                       d¬¦  «        g d¢d
¬¦  «         t          |                     ¦   «         |                     ¦   «         z                       d¬¦  «        g d¢d
¬¦  «         d S )NrS   FrK   )r   r   r   r   rU   )rR   r   r   r   )r   r   r   rR   )rR   r   r   rR   rQ   g¼‰Ø—²Ò¬<©r5   )	r    r!   r   r"   r   r#   Úsqrtr   Úinv)rE   r%   Úr3s      r   Útest_quat_double_coverr_   x   su  € õ 	Œ���ÑÔ€AÝÔ˜1ÑÔ€AÝ��A—I’I¨�IÑ.Ô.Ñ/Ô/Ð/õ 	Œ���ÑÔ�rœw q™zœzÑ)€AÝÔ˜1ÑÔ€AØ	
ˆ1‰ˆQ‰€BÝ�A—I’I¨�IÑ.Ô.­r¬w°q©z¬zÑ9Ø �L�Lñ"ô "ð "å�A—E’E‘G”G—O’O¨e�OÑ4Ô4µR´W¸Q±Z´ZÑ?Ø!�M�Mñ#ô #ð #å�B—J’J¨�JÑ/Ô/µ´¸±
´
Ñ:Ø!�M�Mñ#ô #ð #å�B—F’F‘H”H×$Ò$¨uÐ$Ñ5Ô5µb´g¸a±j´jÑ@Ø"�N�Nñ$ô $ð $õ �Q�q—u’u‘w”w‘Y×'Ò'°%Ð'Ñ8Ô8Ø �L�L uð.ñ .ô .ð .å�R˜Ÿš™œ‘[×)Ò)°EÐ)Ñ:Ô:Ø �L�L uð.ñ .ô .ð .å�Q�r‘T—N’N¨U�NÑ3Ô3Ø!�M�M¨ð/ñ /ô /ð /å�Q—U’U‘W”W˜RŸVšV™XœXÑ%×.Ò.¸Ð.Ñ?Ô?Ø!�M�M¨ð/ñ /ô /ð /ð /ð /r   c                  ó>  — t          j        t          d¬¦  «        5  t          j        t          j        g d¢¦  «        ¦  «         d d d ¦  «         n# 1 swxY w Y   t          j        t          d¬¦  «        5  t          j        t          j        g d¢g d¢g¦  «        ¦  «         d d d ¦  «         n# 1 swxY w Y   t          j        t          d¬¦  «        5  t          j        t          j        g d¢gg d¢gg¦  «        ¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )NzExpected `quat` to have shape©Úmatch©r   rU   r   )r   rU   r   r   r   )r   r   é   é   é   ©r   rU   r   r   )r   r   rd   re   )ÚpytestÚraisesÚ
ValueErrorr   r"   r    r!   r   r   r   Útest_from_quat_wrong_shaperk   ˜   så  € å	Œ•zÐ)HÐ	IÑ	IÔ	Ið 0ð 0ÝÔ�2œ8 I I IÑ.Ô.Ñ/Ô/Ð/ð0ð 0ð 0ñ 0ô 0ð 0ð 0ð 0ð 0ð 0ð 0øøøð 0ð 0ð 0ð 0õ 
Œ•zÐ)HÐ	IÑ	IÔ	Ið ð ÝÔ�2œ8ØˆOˆOØˆOˆOð%ñ ô ñ 	ô 	ð 	ðð ð ñ ô ð ð ð ð ð ð øøøð ð ð ð õ 
Œ•zÐ)HÐ	IÑ	IÔ	Ið ð ÝÔ�2œ8Øˆ\ˆ\ˆNØˆ\ˆ\ˆNð%ñ ô ñ 	ô 	ð 	ðð ð ñ ô ð ð ð ð ð ð ð øøøð ð ð ð ð ð s5   œ)AÁAÁAÁ7-B0Â0B4Â7B4Ã/DÄDÄDc                  óÌ   — t          j        g d¢g d¢g d¢g¦  «        } t          j        t          ¦  «        5  t          j        | ¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )Nr   )r   r   r   r   rP   )r    r!   rh   ri   rj   r   r"   )r   s    r   Útest_zero_norms_from_quatrm   ¬   s´   € Ý
ŒØˆLˆLØˆLˆLØˆMˆMðñ 	ô 	€Aõ
 
Œ•zÑ	"Ô	"ð ð ÝÔ˜1ÑÔÐðð ð ñ ô ð ð ð ð ð ð ð øøøð ð ð ð ð ð s   ·AÁAÁ Ac                  óž   — g d¢} t          j        | ¦  «                             ¦   «         }t          |t	          j        d¦  «        ¦  «         d S )NrQ   r   )r   r"   r<   r   r    r=   )ÚquatÚmats     r   Ú#test_as_matrix_single_1d_quaternionrq   ¶   sE   € Øˆ<ˆ<€DÝ
Ô
˜TÑ
"Ô
"×
,Ò
,Ñ
.Ô
.€Cå˜c¥2¤6¨!¡9¤9Ñ-Ô-Ð-Ð-Ð-r   c                  óì   — g d¢g} t          j        | ¦  «                             ¦   «         }t          |j        d¦  «         t          j        g d¢g d¢g d¢g¦  «        }t          |d         |¦  «         d S )N©r   r   r   r   ©r   r   r   ©r   rR   r   r   r   r   ©r   r"   r<   r   Úshaper    r!   r   )ro   rp   Úexpected_mats      r   Ú#test_as_matrix_single_2d_quaternionry   ½   s‚   € ØˆLˆLˆ>€DÝ
Ô
˜TÑ
"Ô
"×
,Ò
,Ñ
.Ô
.€CÝ�”˜IÑ&Ô&Ð&Ý”8Øˆ
ˆ
Øˆ	ˆ	Øˆ	ˆ	ð
ñ ô €Lõ
 ˜c !œf lÑ3Ô3Ð3Ð3Ð3r   c                  ó  — g d¢g d¢g d¢g d¢g} t          j        | ¦  «                             ¦   «         }t          |j        d¦  «         t          j        g d¢g d¢g d¢g¦  «        }t          |d	         |¦  «         t          j        g d¢g d
¢g d¢g¦  «        }t          |d         |¦  «         t          |d         t          j        d¦  «        ¦  «         t          |d         t          j        d¦  «        ¦  «         d S )Nrs   ©r   r   r   r   rQ   rS   )r   r   r   ru   r   r   r   r   ©rR   r   r   r   rU   r   )	r   r"   r<   r   rw   r    r!   r   r=   )Úquatsrp   Ú	expected0Ú	expected1s       r   Ú test_as_matrix_from_square_inputr€   É   s  € àˆLˆLØˆLˆLØˆLˆLØˆMˆMð	€Eõ Ô
˜UÑ
#Ô
#×
-Ò
-Ñ
/Ô
/€CÝ�”˜IÑ&Ô&Ð&å”Øˆ
ˆ
Øˆ	ˆ	Øˆ	ˆ	ð
ñ ô €Iõ
 ˜c !œf iÑ0Ô0Ð0å”Øˆ	ˆ	Øˆ	ˆ	Øˆ
ˆ
ð
ñ ô €Iõ
 ˜c !œf iÑ0Ô0Ð0å˜c !œf¥b¤f¨Q¡i¤iÑ0Ô0Ð0Ý˜c !œf¥b¤f¨Q¡i¤iÑ0Ô0Ð0Ð0Ð0r   c                  óÊ  — g d¢g d¢g d¢g} t          j        | ¦  «                             ¦   «         }t          |j        d¦  «         t          j        g d¢g d¢g d¢g¦  «        }t          |d         |¦  «         t          j        g d¢g d	¢g d
¢g¦  «        }t          |d         |¦  «         t          j        g d¢g d¢g d¢g¦  «        dz  }t          |d         |¦  «         d S )Nrs   r{   rg   )r   r   r   ru   r   r   r   r   r|   r   )çš™™™™™Ù?éþÿÿÿgš™™™™™@)gffffff@r   r‚   )rR   rU   rU   r   rU   rv   )r}   rp   r~   r   Ú	expected2s        r   Ú!test_as_matrix_from_generic_inputr…   å   s!  € àˆLˆLØˆLˆLØˆLˆLð€Eõ
 Ô
˜UÑ
#Ô
#×
-Ò
-Ñ
/Ô
/€CÝ�”˜IÑ&Ô&Ð&å”Øˆ
ˆ
Øˆ	ˆ	Øˆ	ˆ	ð
ñ ô €Iõ
 ˜c !œf iÑ0Ô0Ð0å”Øˆ	ˆ	Øˆ	ˆ	Øˆ
ˆ
ð
ñ ô €Iõ
 ˜c !œf iÑ0Ô0Ð0å”ØˆˆØˆˆØˆ
ˆ
ð
ñ ô ð ñ	€Iõ
 ˜c !œf iÑ0Ô0Ð0Ð0Ð0r   c                  óŒ   — g d¢g d¢g d¢g} g d¢}t          t          j        | ¦  «                             ¦   «         |¦  «         d S )Nr   r   r   ©ç      à?rˆ   rˆ   rˆ   )r   r   Úfrom_matrixr#   ©rp   r&   s     r   Útest_from_single_2d_matrixr‹     sd   € àˆIˆIØˆIˆIØˆIˆIð€Cð
 )Ð(Ð(€MÝÝÔ  Ñ%Ô%×-Ò-Ñ/Ô/Øñô ð ð ð r   c                  ó   — t          j        g d¢g d¢g d¢g¦  «                             d¦  «        } t          j        g d¢¦  «                             d¦  «        }t          t	          j        | ¦  «                             ¦   «         |¦  «         d S )Nr   r   r   rt   r‡   ©r   r   )r    r!   Úreshaper   r   r‰   r#   rŠ   s     r   Útest_from_single_3d_matrixr�     sž   € Ý
Œ(Øˆ	ˆ	Øˆ	ˆ	Øˆ	ˆ	ð
ñ ô ÷ Š7�9ÑÔð	 õ
 ”HÐ1Ð1Ð1Ñ2Ô2×:Ò:¸6ÑBÔB€MÝÝÔ  Ñ%Ô%×-Ò-Ñ/Ô/Øñô ð ð ð r   c                  ó²  — t          j        g d¢¦  «        t          j        d¦  «        z  } t          j        g d¢g d¢g d¢g¦  «        }t          t	          j        |¦  «                             ¦   «         | ¦  «         t          t	          j        |                     d¦  «        ¦  «                             ¦   «         |                      d¦  «        ¦  «         d S )N)r   r   rd   r   é'   )çÓ3~Ë·ì¿gâ6¿iÐ¿çnzÃoùÖ?)r“   r’   çâ6¿iÐ?)r”   r“   gÓ3~Ë·ì?rt   r�   )r    r!   r\   r   r   r‰   r#   rŽ   )r&   rp   s     r   Útest_from_matrix_calculationr•     sÙ   € Ý”H˜\˜\˜\Ñ*Ô*­R¬W°R©[¬[Ñ8€MÝ
Œ(Ø/Ð/Ð/Ø.Ð.Ð.Ø-Ð-Ð-ðñ ô €Cõ
 ÝÔ  Ñ%Ô%×-Ò-Ñ/Ô/Øñô ð õ ÝÔ  §¢¨YÑ!7Ô!7Ñ8Ô8×@Ò@ÑBÔBØ×!Ò! &Ñ)Ô)ñ+ô +ð +ð +ð +r   c                  óœ   — t          j        ddd¬¦  «        } t          t          j        | ¦  «                             ¦   «         | ¦  «         d S )Nr   r7   r   )ÚsizeÚrandom_state)r   Úrvsr   r   r‰   r<   ©rp   s    r   Ú test_matrix_calculation_pipeliner›   +  sF   € Ý
Ô
! !¨"¸1Ð
=Ñ
=Ô
=€CÝ�hÔ2°3Ñ7Ô7×AÒAÑCÔCÀSÑIÔIÐIÐIÐIr   c                  ó8  — t           j                             d¦  «        } |                      d¦  «        }t           j                             |¦  «        }t          t          |¦  «        ¦  «        D ]}||         dk     r||          ||<   Œt          j	        |¦  «         
                    ¦   «         }t          j        d||                     d¦  «        ¦  «        }t          j        d¦  «        }t          d¦  «        D ]}d|d d …||f<   Œt          ||¦  «         d S )Nr   )r8   r   r   ú...ij,...jk->...ik)r   rU   r   r   ç      ð?)r    r:   r;   Úrandom_sampler@   ÚdetÚrangeÚlenr   r‰   r<   ÚeinsumÚ	transposerM   r   )Úrndrp   ÚdetsÚiÚ	ortho_matÚmult_resultÚeye3ds          r   Útest_from_matrix_ortho_outputr«   0  s  € Ý
Œ)×
Ò
 Ñ
"Ô
"€CØ
×
Ò
˜KÑ
(Ô
(€CÝŒ9�=Š=˜ÑÔ€DÝ•3�t‘9”9ÑÔð ð ˆà�Œ7�QŠ;ˆ;Ø˜!”f�WˆC�‰FøÝÔ$ SÑ)Ô)×3Ò3Ñ5Ô5€Iå”)Ð0°)Ø%×/Ò/°	Ñ:Ô:ñ<ô <€Kõ ŒH�[Ñ!Ô!€EÝ�1‰XŒXð ð ˆØˆˆaˆaˆa��Aˆg‰ˆå˜k¨5Ñ1Ô1Ð1Ð1Ð1r   c                  óÆ  — t          j        g d¢g d¢g d¢g¦  «        } t          j        g d¢g d¢g d¢g¦  «        }t          t          j        | ¦  «                             ¦   «         |d¬¦  «         t          j        g d	¢g d
¢g d¢g¦  «        } t          j        g d¢g d¢g d¢g¦  «        }t          t          j        | ¦  «                             ¦   «         |d¬¦  «         d S )N©r   r   r   r   r   )ç½5_%Ÿì?gÔx'ŸÜ?ç        )gÔx'ŸÜ¿r®   r¯   )r¯   r¯   rž   ç�íµ ÷Æ°>r[   )r   ç      à¿r   )rˆ   r   r   )r   r   rˆ   ru   r   )r    r!   r   r   r‰   r<   )rp   Úexpecteds     r   Útest_from_matrix_normalizer³   D  s  € Ý
Œ(Øˆ	ˆ	Øˆ	ˆ	Øˆ	ˆ	ðñ ô €Cõ ŒxÐ3Ð3Ð3Ø3Ð3Ð3Ø3Ð3Ð3ð5ñ 6ô 6€Hõ •HÔ(¨Ñ-Ô-×7Ò7Ñ9Ô9¸8È$ÐOÑOÔOÐOå
Œ(ØˆˆØˆˆØˆˆðñ ô €Cõ Œx˜˜˜Ø$˜˜Ø$˜˜ð&ñ 'ô '€Hõ •HÔ(¨Ñ-Ô-×7Ò7Ñ9Ô9¸8È$ÐOÑOÔOÐOÐOÐOr   c                  ó`  — t          j        d¦  «        } d| d<   t          j        t          d¬¦  «        5  t          j        | ¦  «         d d d ¦  «         n# 1 swxY w Y   d| d<   t          j        t          d¬¦  «        5  t          j        | ¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )Nr   r   ©r   r   zNon-positive determinantra   rR   )r    r=   rh   ri   rj   r   r‰   rš   s    r   Ú)test_from_matrix_non_positive_determinantr¶   X  s*  € Ý
Œ&�‰)Œ)€CØ€Cˆ�IÝ	Œ•zÐ)CÐ	DÑ	DÔ	Dð "ð "ÝÔ˜SÑ!Ô!Ð!ð"ð "ð "ñ "ô "ð "ð "ð "ð "ð "ð "øøøð "ð "ð "ð "ð €Cˆ�IÝ	Œ•zÐ)CÐ	DÑ	DÔ	Dð "ð "ÝÔ˜SÑ!Ô!Ð!ð"ð "ð "ñ "ô "ð "ð "ð "ð "ð "ð "ð "øøøð "ð "ð "ð "ð "ð "s#   µAÁAÁAÂB#Â#B'Â*B'c                  ó¦   — g d¢} t          j        g d¢¦  «        }t          j        | ¦  «        }t	          |                     ¦   «         |¦  «         d S ©Nr   )g§”×Jè®Þ?r   r   gž<Ñ(ì?©r    r!   r   Úfrom_rotvecr   r#   ©Úrotvecr&   Úresults      r   Útest_from_1d_single_rotvecr¾   c  sQ   € ØˆYˆY€FÝ”HÐ9Ð9Ð9Ñ:Ô:€MÝÔ! &Ñ)Ô)€FÝ˜fŸnšnÑ.Ô.°Ñ>Ô>Ð>Ð>Ð>r   c                  óª   — g d¢g} t          j        g d¢g¦  «        }t          j        | ¦  «        }t	          |                     ¦   «         |¦  «         d S r¸   r¹   r»   s      r   Útest_from_2d_single_rotvecrÀ   j  sV   € Øˆiˆiˆ[€FÝ”HÐ:Ð:Ð:Ð;Ñ<Ô<€MÝÔ! &Ñ)Ô)€FÝ˜fŸnšnÑ.Ô.°Ñ>Ô>Ð>Ð>Ð>r   c                  ó¾   — g d¢g d¢g d¢g} t          j        g d¢g d¢g d¢g¦  «        }t          t          j        | ¦  «                             ¦   «         |¦  «         d S )N©r   rU   rU   ©r   rR   rˆ   ©r   r   r   )g.pó¦GÕ?çcUÎ(§Gå?rÅ   gQœHÕ²?)gNZ]óOÝ?gNZ]óOÝ¿gNZ]óOÍ?g0×þiç?rQ   )r    r!   r   r   rº   r#   )r¼   r&   s     r   Útest_from_generic_rotvecrÆ   q  sŠ   € àˆIˆIØˆLˆLØˆIˆIð€Fõ
 ”HØ4Ð4Ð4Ø5Ð5Ð5Øˆˆð
ñ ô €Mõ
 ÝÔ  Ñ(Ô(×0Ò0Ñ2Ô2Øñô ð ð ð r   c                  óZ  — t          j        dt          j        d¦  «        z  dt          j        d¦  «        z  dt          j        d¦  «        z  gg d¢g d¢g¦  «        } t          j        | ¦  «                             ¦   «         }t          |d         d¦  «         t          |dd d…f         | d         d	z  ¦  «         t          |d
         d¦  «         t          |dd d…f         t          j        g d¢¦  «        ¦  «         t          |d         t          j        g d¢¦  «        ¦  «         d S )Ngü©ñÒMb@?r   gü©ñÒMb@¿)çš™™™™™É?g333333Ó?r‚   rÄ   ©r   r   r   r   rˆ   ©r   r   g@ù»wÔØî?)g>Ü}²J¹?g„.eÞøÂ?g>Ü}²JÉ?rU   rQ   )r    r!   r\   r   rº   r#   r   r   )r¼   ro   s     r   Útest_from_rotvec_small_anglerË   �  s*  € ÝŒXØ	•”˜‘
”
Ñ	˜E¥B¤G¨A¡J¤JÑ.°µr´w¸q±z´zÑ0AÐBØˆˆØˆ	ˆ	ð
ñ ô €Fõ Ô Ñ'Ô'×/Ò/Ñ1Ô1€Då�D˜”J Ñ"Ô"Ð"å�D˜˜B˜Q˜B˜”K ¨¤¨S¡Ñ1Ô1Ð1å�D˜”J 	Ñ*Ô*Ð*ÝØ��B�Q�B�ŒKÝŒHð ð ð ñ ô ñô ð õ ��a”�"œ( < < <Ñ0Ô0Ñ1Ô1Ð1Ð1Ð1r   c                  óz  — dt          j        d¦  «        z  dt          j        d¦  «        z  dt          j        d¦  «        z  g} t          j        | d¬¦  «        }|                     ¦   «         }t          j        | ¦  «        }t          j        |¦  «        }|                     ¦   «         }t          ||¦  «         d S )Nrž   r   T©Údegrees)r    Úcbrtr   rº   r#   Údeg2radr   )Úrotvec1Úrot1Úquat1Úrotvec2Úrot2Úquat2s         r   Útest_degrees_from_rotvecr×   š  s™   € Ø•R”W˜Q‘Z”ZÑ ¥r¤w¨q¡z¤zÑ!1°3½¼À¹¼Ñ3CÐD€GÝÔ °Ð6Ñ6Ô6€DØ�LŠL‰NŒN€EåŒj˜Ñ!Ô!€GÝÔ Ñ(Ô(€DØ�LŠL‰NŒN€Eå�E˜5Ñ!Ô!Ð!Ð!Ð!r   c                  óš   — t          j        t          d¬¦  «        5  t          j        ddg¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )Nú Expected `rot_vec` to have shapera   r   rU   ©rh   ri   rj   r   rº   r   r   r   Útest_malformed_1d_from_rotvecrÛ   ¦  s‘   € Ý	Œ•zÐ)KÐ	LÑ	LÔ	Lð %ð %ÝÔ˜a ˜VÑ$Ô$Ð$ð%ð %ð %ñ %ô %ð %ð %ð %ð %ð %ð %ð %øøøð %ð %ð %ð %ð %ð %ó   œA Á AÁAc                  ó¢   — t          j        t          d¬¦  «        5  t          j        g d¢g d¢g¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )NrÙ   ra   rg   ©r   rd   re   rf   rÚ   r   r   r   Útest_malformed_2d_from_rotvecrß   «  s¤   € Ý	Œ•zÐ)KÐ	LÑ	LÔ	Lð ð ÝÔØˆLˆLØˆLˆLðñ 	ô 	ð 	ðð ð ñ ô ð ð ð ð ð ð ð øøøð ð ð ð ð ð ó   œAÁAÁAc            	      ó
  — t          j        g d¢g d¢g d¢g¦  «        } | t           j                             | d¬¦  «        d d …d f         z  } t	          j        | ¦  «                             ¦   «         }t           j                             |d¬¦  «        }t          | d d …df         t          j        |dz  ¦  «        ¦  «         t          t          j	        || d d …d d…f         ¦  «        t          j
        d¦  «        ¦  «         d S )	N©r   rU   rR   rˆ   ©r   rR   r   ga2U0*©3?rQ   r   r   r   rU   )r   r   )r    r!   r@   rA   r   r"   Ú	as_rotvecr   ÚcosÚcrossrM   )ro   r¼   Úangles      r   Útest_as_generic_rotvecrè   ³  sñ   € ÝŒ8ØˆOˆOØÐÐØˆLˆLðñ ô €Dð
 	�BŒI�NŠN˜4 aˆNÑ(Ô(¨¨¨¨D¨Ô1Ñ1€DåÔ Ñ%Ô%×/Ò/Ñ1Ô1€FÝŒI�NŠN˜6¨ˆNÑ*Ô*€Eå�D˜˜˜˜A˜”J¥¤ u¨Q¡w¡¤Ñ0Ô0Ð0Ý•B”H˜V T¨!¨!¨!¨R¨a¨R¨%¤[Ñ1Ô1µ2´8¸FÑ3CÔ3CÑDÔDÐDÐDÐDr   c                  óô   — t          j        g d¢¦  «        } t          j        g d¢¦  «        }t          j        | ¦  «                             ¦   «         }t          |j        d¦  «         t          ||¦  «         d S )N©r   rU   éýÿÿÿrU   ©gj*0	¼xâ?g$¼xò?g:2 (µû¿©r   ©r    r!   r   r"   rä   r   rw   r   ©ro   Úexpected_rotvecÚactual_rotvecs      r   Útest_as_rotvec_single_1d_inputrò   Â  sp   € ÝŒ8�M�M�MÑ"Ô"€DÝ”hÐAÐAÐAÑBÔB€OåÔ& tÑ,Ô,×6Ò6Ñ8Ô8€Må�Ô$ dÑ+Ô+Ð+Ý�M ?Ñ3Ô3Ð3Ð3Ð3r   c                  óø   — t          j        g d¢g¦  «        } t          j        g d¢g¦  «        }t          j        | ¦  «                             ¦   «         }t          |j        d¦  «         t          ||¦  «         d S )Nrê   rì   rÊ   rî   rï   s      r   Útest_as_rotvec_single_2d_inputrô   Ì  su   € ÝŒ8�]�]�]�OÑ$Ô$€DÝ”hÐ BÐ BÐ BÐCÑDÔD€OåÔ& tÑ,Ô,×6Ò6Ñ8Ô8€Må�Ô$ fÑ-Ô-Ð-Ý�M ?Ñ3Ô3Ð3Ð3Ð3r   c                  ó>  — g d¢g d¢g d¢g} t          j        | ¦  «        }|                     d¬¦  «        }t          j                             |¦  «        }t          |d¦  «         t          |d         |d         ¦  «         t          |d         |d	         ¦  «         d S )
Nr   r   r   TrÍ   g      ^@r   r   rU   )r   r‰   rä   r    r@   rA   r   )rp   Úrotr¼   rç   s       r   Útest_as_rotvec_degreesr÷   Ö  s–   € àˆ9ˆ9�i�i�i   Ð
+€CÝ
Ô
˜sÑ
#Ô
#€CØ�]Š] 4ˆ]Ñ(Ô(€FÝŒI�NŠN˜6Ñ"Ô"€EÝ�E˜5Ñ!Ô!Ð!Ý�F˜1”I˜v aœyÑ)Ô)Ð)Ý�F˜1”I˜v aœyÑ)Ô)Ð)Ð)Ð)r   c                  ó  — t          j        g d¢g d¢g d¢g¦  «        } t          t          j        | ¦  «                             ¦   «         | ¦  «         t          t          j        | d¬¦  «                             d¬¦  «        | ¦  «         d S )NrÄ   ©r   rR   rU   )ga2U0*©3¿gÇº¸�ð6?ga2U0*©?TrÍ   )r    r!   r   r   rº   rä   )r¼   s    r   Útest_rotvec_calc_pipelinerú   á  s›   € åŒXØˆ	ˆ	Øˆ
ˆ
ØÐÐð
ñ ô €Fõ
 •HÔ(¨Ñ0Ô0×:Ò:Ñ<Ô<¸fÑEÔEÐEÝ•HÔ(¨¸Ð>Ñ>Ô>×HÒHÐQUÐHÑVÔVØñô ð ð ð r   c                  ó¦   — g d¢} t          j        g d¢¦  «        }t          j        | ¦  «        }t	          |                     ¦   «         |¦  «         d S ©N)r   r   rž   )r   r   r   r   ©r    r!   r   Úfrom_mrpr   r#   ©Úmrpr&   r½   s      r   Útest_from_1d_single_mrpr  í  sN   € Ø
ˆ+ˆ+€CÝ”H˜\˜\˜\Ñ*Ô*€MÝÔ˜sÑ#Ô#€FÝ˜fŸnšnÑ.Ô.°Ñ>Ô>Ð>Ð>Ð>r   c                  óª   — g d¢g} t          j        g d¢g¦  «        }t          j        | ¦  «        }t	          |                     ¦   «         |¦  «         d S rü   rý   rÿ   s      r   Útest_from_2d_single_mrpr  ô  sR   € Øˆ;ˆ;ˆ-€CÝ”H˜l˜l˜l˜^Ñ,Ô,€MÝÔ˜sÑ#Ô#€FÝ˜fŸnšnÑ.Ô.°Ñ>Ô>Ð>Ð>Ð>r   c                  óâ   — t          j        g d¢g d¢g d¢g¦  «        } t          j        g d¢g d¢g d¢g¦  «        }t          t          j        | ¦  «                             ¦   «         |¦  «         d S )NrÂ   rÃ   rÄ   )rÈ   r‚   r‚   gš™™™™™é¿)g}�+;±ã?g}�+;±ã¿g}�+;±Ó?gß¨Ó‰�Ø¿rQ   )r    r!   r   r   rþ   r#   )r   r&   s     r   Útest_from_generic_mrpr  û  s�   € Ý
Œ(Øˆ	ˆ	ØˆˆØˆ	ˆ	ðñ ô €Cõ ”HØÐÐØ:Ð:Ð:Øˆˆðñ ô €Mõ �hÔ/°Ñ4Ô4×<Ò<Ñ>Ô>ÀÑNÔNÐNÐNÐNr   c                  óš   — t          j        t          d¬¦  «        5  t          j        ddg¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )NúExpected `mrp` to have shapera   r   rU   ©rh   ri   rj   r   rþ   r   r   r   Útest_malformed_1d_from_mrpr	    s‘   € Ý	Œ•zÐ)GÐ	HÑ	HÔ	Hð "ð "ÝÔ˜1˜a˜&Ñ!Ô!Ð!ð"ð "ð "ñ "ô "ð "ð "ð "ð "ð "ð "ð "øøøð "ð "ð "ð "ð "ð "rÜ   c                  ó¢   — t          j        t          d¬¦  «        5  t          j        g d¢g d¢g¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )Nr  ra   rg   rÞ   r  r   r   r   Útest_malformed_2d_from_mrpr    s¤   € Ý	Œ•zÐ)GÐ	HÑ	HÔ	Hð ð ÝÔØˆLˆLØˆLˆLðñ 	ô 	ð 	ðð ð ñ ô ð ð ð ð ð ð ð øøøð ð ð ð ð ð rà   c                  ó>  — t          j        g d¢g d¢g d¢g¦  «        } | t           j                             | d¬¦  «        d d …d f         z  } t          j        g d¢g d¢g d¢g¦  «        }t	          t          j        | ¦  «                             ¦   «         |¦  «         d S )	Nrâ   rã   rQ   r   r   )gÚÁQUUÕ?g“vWUUå?çÚÁQUUÕ¿)çužF”Õxâ?gužF”Õxâ¿r  rÄ   )r    r!   r@   rA   r   r   r"   Úas_mrp)ro   Úexpected_mrps     r   Útest_as_generic_mrpr    s¸   € ÝŒ8ØˆˆØÐÐØˆˆðñ ô €Dð 	�BŒI�NŠN˜4 aˆNÑ(Ô(¨¨¨¨D¨Ô1Ñ1€Då”8Ø-Ð-Ð-Ø-Ð-Ð-Øˆ	ˆ	ðñ ô €Lõ �hÔ0°Ñ6Ô6×=Ò=Ñ?Ô?ÀÑNÔNÐNÐNÐNr   c                  óì   — t          j        t          j        t           j        dz  dz  ¦  «         ddg¦  «        } t	          t          j        dg d¢d¬¦  «                             ¦   «         | ¦  «         d S )	NrU   r   r¯   r   rI   )i  r   r   TrÍ   )r    r!   ÚtanÚpir   r   rL   r  )r  s    r   Útest_past_180_degree_rotationr  !  su   € õ ”8�bœf¥R¤U¨1¡W¨Q¡YÑ/Ô/Ð/°°aÐ8Ñ9Ô9€LÝÝÔ˜E ; ; ;¸Ð=Ñ=Ô=×DÒDÑFÔFØñô ð ð ð r   c                  óô   — t          j        g d¢¦  «        } t          j        g d¢¦  «        }t          j        | ¦  «                             ¦   «         }t          |j        d¦  «         t          ||¦  «         d S )Nrê   ©g²Š�Ä?g²Š�Ô?g‹O—ÁÞ¿rí   ©r    r!   r   r"   r  r   rw   r   ©ro   r  Ú
actual_mrps      r   Útest_as_mrp_single_1d_inputr  +  sp   € ÝŒ8�M�M�MÑ"Ô"€DÝ”8ÐAÐAÐAÑBÔB€LåÔ# DÑ)Ô)×0Ò0Ñ2Ô2€Jå�Ô! 4Ñ(Ô(Ð(Ý�J Ñ-Ô-Ð-Ð-Ð-r   c                  óø   — t          j        g d¢g¦  «        } t          j        g d¢g¦  «        }t          j        | ¦  «                             ¦   «         }t          |j        d¦  «         t          ||¦  «         d S )Nrê   r  rÊ   r  r  s      r   Útest_as_mrp_single_2d_inputr  5  su   € ÝŒ8�]�]�]�OÑ$Ô$€DÝ”8ÐBÐBÐBÐCÑDÔD€LåÔ# DÑ)Ô)×0Ò0Ñ2Ô2€Jå�Ô! 6Ñ*Ô*Ð*Ý�J Ñ-Ô-Ð-Ð-Ð-r   c                  óî   — t          j        g d¢g d¢g d¢g d¢g¦  «        } t          j        g d¢g d¢g d¢g d¢g¦  «        }t          t          j        | ¦  «                             ¦   «         |¦  «         d S )NrÄ   rù   )gzŸp—y‚Ú?r   r   )çš™™™™™¹?rÈ   r  )gKÚ}\UUÅ¿gKÚ}\UUÅ?r  )r    r!   r   r   rþ   r  )r  r  s     r   Útest_mrp_calc_pipeliner   ?  s�   € Ý”Øˆ	ˆ	Øˆ
ˆ
ØÐÐØˆˆð	ñ ô €Jõ
 ”8Øˆ	ˆ	Ø.Ð.Ð.ØÐÐØˆˆð	ñ ô €Lõ
 •HÔ% jÑ1Ô1×8Ò8Ñ:Ô:¸LÑIÔIÐIÐIÐIr   c                  óÎ   — t          j        ddd¬¦  «                             ¦   «         } t          j        g d¢¦  «        t          j        d¦  «        z  }t          | |¦  «         d S )Nr   éZ   TrÍ   rs   rU   )r   rL   r#   r    r!   r\   r   )ro   r&   s     r   Útest_from_euler_single_rotationr#  M  s[   € ÝÔ˜s B°Ð5Ñ5Ô5×=Ò=Ñ?Ô?€DÝ”H˜\˜\˜\Ñ*Ô*­R¬W°Q©Z¬ZÑ7€MÝ�D˜-Ñ(Ô(Ð(Ð(Ð(r   c                  óÊ   — t          j        ddd¬¦  «                             ¦   «         } t          j        ddd¬¦  «                             ¦   «         }t          | |¦  «         d S )Nr   r"  TrÍ   ÚZ)r   rL   r<   r   ©Ú	extrinsicÚ	intrinsics     r   Ú(test_single_intrinsic_extrinsic_rotationr)  S  s^   € ÝÔ# C¨°TÐ:Ñ:Ô:×DÒDÑFÔF€IÝÔ# C¨°TÐ:Ñ:Ô:×DÒDÑFÔF€IÝ�I˜yÑ)Ô)Ð)Ð)Ð)r   c                  óV  — t           j                             d¦  «        } |                      ddd¬¦  «        }|d d …d d d…f         }t	          j        d|d¬¦  «                             ¦   «         }t	          j        d	|d¬¦  «                             ¦   «         }t          ||¦  «         d S )
Nr   é´   )rd   r   ©ÚlowÚhighr—   rR   rI   TrÍ   ÚZYX)r    r:   r;   Úrandintr   rL   r#   r   )r¥   ÚaÚbr   r   s        r   Útest_from_euler_rotation_orderr3  Y  s¡   € å
Œ)×
Ò
 Ñ
"Ô
"€CØ�Š˜ ¨&ˆÑ1Ô1€AØ	ˆ!ˆ!ˆ!ˆTˆTˆrˆTˆ'Œ
€AÝÔ˜E 1¨dÐ3Ñ3Ô3×;Ò;Ñ=Ô=€AÝÔ˜E 1¨dÐ3Ñ3Ô3×;Ò;Ñ=Ô=€AÝ�A�qÑÔÐÐÐr   c                  ó¶   — t          j        dddgd¬¦  «                             ¦   «         } t          j        g d¢g d¢g d¢g¦  «        }t          | |¦  «         d S )NÚzxr"  TrÍ   ru   ©r   r   rR   r   )r   rL   r<   r    r!   r   )rp   rx   s     r   Ú-test_from_euler_elementary_extrinsic_rotationr7  c  sl   € å
Ô
˜d R¨ H°dÐ
;Ñ
;Ô
;×
EÒ
EÑ
GÔ
G€CÝ”8Øˆ
ˆ
Øˆ
ˆ
Øˆ	ˆ	ðñ ô €Lõ
 ˜c <Ñ0Ô0Ð0Ð0Ð0r   c            	      ó”  — g d¢g d¢g d¢g} t          j        d| d¬¦  «                             ¦   «         }t          |d         t	          j        g d¢g d	¢g d
¢g¦  «        ¦  «         t          |d         t	          j        g d¢g d¢g d¢g¦  «        ¦  «         t          |d         t	          j        g d¢g d¢g d¢g¦  «        ¦  «         d S )N©é   é<   é-   ©r:  r;  r:  ©r<  r:  r;  ÚZXYTrÍ   r   )g#ß Ž˜Ó?ç      Ð¿gÎ™þ6Õdí?)g$+¿ÆHì?ç‘+Pæz¶Û?çPï˜pž Æ¿)gPï˜pž Ö¿ç‘+Pæz¶ë?gPï˜pž Ö?r   )g�”+aá?r@  çÉ(s=Ûé?)rD  rA  g�&(�¸‘Ù¿)r@  rC  rA  rU   )gøaÎ}ƒ@¨?gF�6Ž˜ã¿gå^�µ@é?)g0	¼8–å?gF�6Ž˜ã?gä˜Ñ4ÍàÛ?)ç      è¿rˆ   rA  ©r   rL   r<   r   r    r!   ©Úanglesrp   s     r   Ú&test_from_euler_intrinsic_rotation_312rI  n  s#  € àˆˆØˆˆØˆˆð
€Fõ
 Ô
˜e V°TÐ
:Ñ
:Ô
:×
DÒ
DÑ
FÔ
F€Cå˜c !œf¥b¤hØ*Ð*Ð*Ø*Ð*Ð*Ø*Ð*Ð*ð0ñ 'ô 'ñ ô ð õ ˜c !œf¥b¤hØ*Ð*Ð*Ø*Ð*Ð*Ø*Ð*Ð*ð0ñ 'ô 'ñ ô ð õ ˜c !œf¥b¤hØ*Ð*Ð*Ø)Ð)Ð)Ø*Ð*Ð*ð0ñ 'ô 'ñ ô ð ð ð r   c            	      ó”  — g d¢g d¢g d¢g} t          j        d| d¬¦  «                             ¦   «         }t          |d         t	          j        g d¢g d	¢g d
¢g¦  «        ¦  «         t          |d         t	          j        g d¢g d¢g d¢g¦  «        ¦  «         t          |d         t	          j        g d¢g d¢g d¢g¦  «        ¦  «         d S )Nr9  r=  r>  ÚZXZTrÍ   r   )ç>ìdôÌàÛ?gŠ ­µ@é¿rA  )çél>–å?ç^¯|‚@¨¿rE  )çó±XŽ˜ã?rO  rˆ   r   ©g      ä?g­ ¼,ÜÈä¿rA  ©g­ ¼,ÜÈä?g      À?rE  ©rA  ç      è?rˆ   rU   )rB  g4§&Õdí¿çß'Üež Ö?)ç³cÆHì?çó±XŽ˜Ó¿gß'Üež Ö¿)rA  ç      Ð?rC  rF  rG  s     r   Ú&test_from_euler_intrinsic_rotation_313rX  ‰  s#  € àˆˆØˆˆØˆˆð
€Fõ
 Ô
˜e V°TÐ
:Ñ
:Ô
:×
DÒ
DÑ
FÔ
F€Cå˜c !œf¥b¤hØ,Ð,Ð,Ø,Ð,Ð,Ø*Ð*Ð*ð0ñ 'ô 'ñ ô ð õ ˜c !œf¥b¤hØ+Ð+Ð+Ø*Ð*Ð*Ø'Ð'Ð'ð0ñ 'ô 'ñ ô ð õ ˜c !œf¥b¤hØ-Ð-Ð-Ø.Ð.Ð.Ø*Ð*Ð*ð0ñ 'ô 'ñ ô ð ð ð r   c            	      ó”  — g d¢g d¢g d¢g} t          j        d| d¬¦  «                             ¦   «         }t          |d         t	          j        g d¢g d	¢g d
¢g¦  «        ¦  «         t          |d         t	          j        g d¢g d	¢g d¢g¦  «        ¦  «         t          |d         t	          j        g d¢g d¢g d¢g¦  «        ¦  «         d S )Nr9  r=  r>  ÚzxyTrÍ   r   )ç4§&Õdí?gPï˜pž Æ?rT  )rW  rA  g‘+Pæz¶ë¿)rV  rU  rT  r   )gä
”¹žíî?çŒ\�2×³­¿rW  )r\  g­ ¼,ÜÈì?rA  rU   )rM  rN  rS  )rO  rO  r±   )g>ìdôÌàÛ¿çŠ ­µ@é?rA  rF  rG  s     r   Ú&test_from_euler_extrinsic_rotation_312r^  ¤  s#  € àˆˆØˆˆØˆˆð
€Fõ
 Ô
˜e V°TÐ
:Ñ
:Ô
:×
DÒ
DÑ
FÔ
F€Cå˜c !œf¥b¤hØ+Ð+Ð+Ø+Ð+Ð+Ø-Ð-Ð-ð0ñ 'ô 'ñ ô ð õ ˜c !œf¥b¤hØ+Ð+Ð+Ø+Ð+Ð+Ø+Ð+Ð+ð0ñ 'ô 'ñ ô ð õ ˜c !œf¥b¤hØ,Ð,Ð,Ø,Ð,Ð,Ø,Ð,Ð,ð0ñ 'ô 'ñ ô ð ð ð r   c            	      ó”  — g d¢g d¢g d¢g} t          j        d| d¬¦  «                             ¦   «         }t          |d         t	          j        g d¢g d	¢g d
¢g¦  «        ¦  «         t          |d         t	          j        g d¢g d¢g d
¢g¦  «        ¦  «         t          |d         t	          j        g d¢g d¢g d¢g¦  «        ¦  «         d S )Nr9  r=  r>  ÚzxzTrÍ   r   )rL  gél>–å¿rO  )r]  rN  gó±XŽ˜ã¿rR  r   rP  rQ  rU   )rB  g³cÆHì¿rA  )r[  rV  r@  )rT  rT  rC  rF  rG  s     r   Ú&test_from_euler_extrinsic_rotation_313ra  ¿  s#  € àˆˆØˆˆØˆˆð
€Fõ
 Ô
˜e V°TÐ
:Ñ
:Ô
:×
DÒ
DÑ
FÔ
F€Cå˜c !œf¥b¤hØ-Ð-Ð-Ø.Ð.Ð.Ø)Ð)Ð)ð0ñ 'ô 'ñ ô ð õ ˜c !œf¥b¤hØ,Ð,Ð,Ø+Ð+Ð+Ø)Ð)Ð)ð0ñ 'ô 'ñ ô ð õ ˜c !œf¥b¤hØ,Ð,Ð,Ø,Ð,Ð,Ø+Ð+Ð+ð0ñ 'ô 'ñ ô ð ð ð r   Ú	seq_tuplerI   r(  )FTc                 ó$  — d„ }t           j                             d¦  «        }d}t          j        |df¦  «        }|                     t           j         t           j        |f¬¦  «        |d d …df<   |                     t           j         dz  t           j        dz  |f¬¦  «        |d d …df<   |                     t           j         t           j        |f¬¦  «        |d d …df<   d                     | ¦  «        }|r|                     ¦   «         }t          j	        ||¦  «        }| 
                    |¦  «        }|                     |¦  «        }	t          ||dd	¬
¦  «         t          ||	dd	¬
¦  «          |||z
  dd¦  «          ||	|z
  dd¦  «         d S )Nc                 ó  — t          j        | d¬¦  «        }t          j        | d¬¦  «        }t          j        ||¦  «        }t          j        t          j        |¦  «        |k     ¦  «        sJ ‚t          j        ||k     ¦  «        sJ ‚d S ©Nr   r   ©r    ÚmeanÚstdÚhypotÚallrX   ©ÚerrorÚmean_maxÚrms_maxrg  rh  Úrmss         r   Ú
test_statsz1test_as_euler_asymmetric_axes.<locals>.test_statsÞ  ó~   € ÝŒw�u 1Ð%Ñ%Ô%ˆÝŒf�U Ð#Ñ#Ô#ˆÝŒh�t˜SÑ!Ô!ˆÝŒv•b”f˜T‘l”l XÒ-Ñ.Ô.Ð.Ð.Ð.ÝŒv�c˜G’mÑ$Ô$Ð$Ð$Ð$Ð$Ð$r   r   éè  r   r,  rU   r   Ú çê-�™—q=©r5   r4   r1   ç›+¡†›„=©r    r:   r;   ÚemptyÚuniformr  ÚjoinÚupperr   rL   Úas_eulerÚ_as_euler_from_matrixr   ©
rb  r(  rp  r¥   ÚnrH  ÚseqÚrotationÚangles_quatÚ
angles_mats
             r   Útest_as_euler_asymmetric_axesr„  Ú  s�  € ð%ð %ð %õ Œ)×
Ò
 Ñ
"Ô
"€CØ€AÝŒX�q˜!�fÑÔ€FØ—;’;¥B¤E 6µ´¸Q¸D�;ÑAÔA€Fˆ1ˆ1ˆ1ˆaˆ4�LØ—;’;¥B¤E 6¨A¡:µB´E¸A±IÀQÀD�;ÑIÔI€Fˆ1ˆ1ˆ1ˆaˆ4�LØ—;’;¥B¤E 6µ´¸Q¸D�;ÑAÔA€Fˆ1ˆ1ˆ1ˆaˆ4�Là
�'Š'�)Ñ
Ô
€CØð ð �iŠi‰kŒkˆÝÔ" 3¨Ñ/Ô/€HØ×#Ò# CÑ(Ô(€KØ×/Ò/°Ñ4Ô4€JÝ�F˜K¨a°eÐ<Ñ<Ô<Ð<Ý�F˜J¨Q°UÐ;Ñ;Ô;Ð;Ø€Jˆ{˜VÑ# U¨EÑ2Ô2Ð2Ø€Jˆz˜FÑ" E¨5Ñ1Ô1Ð1Ð1Ð1r   c                 ó,  — d„ }t           j                             d¦  «        }d}t          j        |df¦  «        }|                     t           j         t           j        |f¬¦  «        |d d …df<   |                     dt           j        |f¬¦  «        |d d …df<   |                     t           j         t           j        |f¬¦  «        |d d …df<   d                     | d         | d         | d         g¦  «        }|r|                     ¦   «         }t          j	        ||¦  «        }| 
                    |¦  «        }|                     |¦  «        }	t          ||dd	¬
¦  «         t          ||	dd¬
¦  «          |||z
  dd¦  «          ||	|z
  dd	¦  «         d S )Nc                 ó  — t          j        | d¬¦  «        }t          j        | d¬¦  «        }t          j        ||¦  «        }t          j        t          j        |¦  «        |k     ¦  «        sJ ‚t          j        ||k     ¦  «        sJ ‚d S re  rf  rk  s         r   rp  z0test_as_euler_symmetric_axes.<locals>.test_statsÿ  rq  r   r   rr  r   r,  r   rU   rs  g‚vIhÂ%<=ru  ç•Ö&è.>r2   rv  r1   rw  r~  s
             r   Útest_as_euler_symmetric_axesrˆ  û  s–  € ð%ð %ð %õ Œ)×
Ò
 Ñ
"Ô
"€CØ€AÝŒX�q˜!�fÑÔ€FØ—;’;¥B¤E 6µ´¸Q¸D�;ÑAÔA€Fˆ1ˆ1ˆ1ˆaˆ4�LØ—;’; 1­2¬5¸°t�;Ñ<Ô<€Fˆ1ˆ1ˆ1ˆaˆ4�LØ—;’;¥B¤E 6µ´¸Q¸D�;ÑAÔA€Fˆ1ˆ1ˆ1ˆaˆ4�Lð �'Š'�9˜Q”< ¨1¤¨y¸¬|Ð<Ñ
=Ô
=€CØð Ø�iŠi‰kŒkˆÝÔ" 3¨Ñ/Ô/€HØ×#Ò# CÑ(Ô(€KØ×/Ò/°Ñ4Ô4€JÝ�F˜K¨a°eÐ<Ñ<Ô<Ð<Ý�F˜J¨Q°TÐ:Ñ:Ô:Ð:Ø€Jˆ{˜VÑ# U¨EÑ2Ô2Ð2Ø€Jˆz˜FÑ" E¨5Ñ1Ô1Ð1Ð1Ð1r   c                 óø  — t          j        g d¢g d¢g d¢g d¢g¦  «        }d                     | ¦  «        }|r|                     ¦   «         }t	          j        ||d¬¦  «        }|                     ¦   «         }t          j        t          d¬	¦  «        5  | 
                    |d¬¦  «        }d d d ¦  «         n# 1 swxY w Y   t	          j        ||d¬¦  «                             ¦   «         }t          ||¦  «         d S )
N©r<  r"  é#   ©r‹  é¦ÿÿÿé   ©r‹  r"  é   ©r�  r�  é   rs  TrÍ   úGimbal lockra   ©r    r!   rz  r{  r   rL   r<   rh   ÚwarnsÚUserWarningr|  r   ©rb  r(  rH  r€  r�  Úmat_expectedÚangle_estimatesÚmat_estimateds           r   Ú(test_as_euler_degenerate_asymmetric_axesr›    sC  € õ ŒXØˆˆØˆˆØˆˆØˆˆð	ñ ô €Fð �'Š'�)Ñ
Ô
€CØð ð �iŠi‰kŒkˆÝÔ" 3¨¸Ð=Ñ=Ô=€HØ×%Ò%Ñ'Ô'€Lå	Œ•k¨Ð	7Ñ	7Ô	7ð ?ð ?Ø"×+Ò+¨C¸Ð+Ñ>Ô>ˆð?ð ?ð ?ñ ?ô ?ð ?ð ?ð ?ð ?ð ?ð ?øøøð ?ð ?ð ?ð ?åÔ'¨¨_ÀdÐKÑKÔK×UÒUÑWÔW€Må˜l¨MÑ:Ô:Ð:Ð:Ð:s   ÂB6Â6B:Â=B:c                 ó"  — t          j        g d¢g d¢g d¢g d¢g¦  «        }d                     | d         | d         | d         g¦  «        }|r|                     ¦   «         }t	          j        ||d¬	¦  «        }|                     ¦   «         }t          j        t          d
¬¦  «        5  | 
                    |d¬	¦  «        }d d d ¦  «         n# 1 swxY w Y   t	          j        ||d¬	¦  «                             ¦   «         }t          ||¦  «         d S )N©r’  r   r;  ©r‹  r   éK   ©r;  r+  r‹  ©r’  iLÿÿÿr�  rs  r   r   TrÍ   r“  ra   r”  r—  s           r   Ú'test_as_euler_degenerate_symmetric_axesr¢  5  sV  € õ ŒXØˆˆØˆˆØˆˆØˆˆð	ñ ô €Fð �'Š'�9˜Q”< ¨1¤¨y¸¬|Ð<Ñ
=Ô
=€CØð ð �iŠi‰kŒkˆÝÔ" 3¨¸Ð=Ñ=Ô=€HØ×%Ò%Ñ'Ô'€Lå	Œ•k¨Ð	7Ñ	7Ô	7ð ?ð ?Ø"×+Ò+¨C¸Ð+Ñ>Ô>ˆð?ð ?ð ?ñ ?ô ?ð ?ð ?ð ?ð ?ð ?ð ?øøøð ?ð ?ð ?ð ?åÔ'¨¨_ÀdÐKÑKÔK×UÒUÑWÔW€Må˜l¨MÑ:Ô:Ð:Ð:Ð:s   Â'CÃCÃCc                 ó°  — t          j        g d¢g d¢g d¢g d¢g¦  «        }d                     | ¦  «        }|r|                     ¦   «         }t	          j        ||d¬¦  «        }t          j        t          d¬	¦  «        5  | 	                    |d¬¦  «        }d d d ¦  «         n# 1 swxY w Y   t          j        t          d¬	¦  «        5  | 
                    |d¬¦  «        }d d d ¦  «         n# 1 swxY w Y   t          |d d …d
dgf         |d d …d
dgf         d
d¬¦  «         t          |d d …df         |d d …df         d
d¬¦  «         t          j        g d¢g d¢g d¢g d¢g¦  «        }|d d …df         d
k    }d                     | d
         | d         | d
         g¦  «        }|r|                     ¦   «         }t	          j        ||d¬¦  «        }t          j        t          d¬	¦  «        5  | 	                    |d¬¦  «        }d d d ¦  «         n# 1 swxY w Y   t          j        t          d¬	¦  «        5  | 
                    |d¬¦  «        }d d d ¦  «         n# 1 swxY w Y   t          |d d …d
dgf         |d d …d
dgf         d
d¬¦  «         t          || df         || df         d
d¬¦  «         t          ||df         ||df         d¬¦  «         d S )NrŠ  rŒ  r�  r‘  rs  TrÍ   r“  ra   r   rU   rt  ru  r   çH¯¼šò×z>r�  rž  r   r¡  r°   r[   )r    r!   rz  r{  r   rL   rh   r•  r–  r}  r|  r   )rb  r(  rH  r€  rö   Úestimates_matrixÚestimates_quatÚidxs           r   Ú+test_as_euler_degenerate_compare_algorithmsr¨  Q  si  € õ ŒXØˆˆØˆˆØˆˆØˆˆð	ñ ô €Fð �'Š'�)Ñ
Ô
€CØð ð �iŠi‰kŒkˆå
Ô
˜c 6°4Ð
8Ñ
8Ô
8€CÝ	Œ•k¨Ð	7Ñ	7Ô	7ð Hð HØ×4Ò4°SÀ$Ð4ÑGÔGÐðHð Hð Hñ Hô Hð Hð Hð Hð Hð Hð Høøøð Hð Hð Hð Hå	Œ•k¨Ð	7Ñ	7Ô	7ð 9ð 9ØŸš c°4˜Ñ8Ô8ˆð9ð 9ð 9ñ 9ô 9ð 9ð 9ð 9ð 9ð 9ð 9øøøð 9ð 9ð 9ð 9åØ˜˜˜˜Q ˜F˜Ô# ^°A°A°A¸¸1°v°IÔ%>ÀQÈUðñ ô ð õ Ð$ Q Q Q¨ TÔ*¨N¸1¸1¸1¸a¸4Ô,@ÀqÈtÐTÑTÔTÐTõ ŒXØˆˆØˆˆØˆˆØˆˆð	ñ ô €Fð ����A�Œ,˜!Ò
€Cð �'Š'�9˜Q”< ¨1¤¨y¸¬|Ð<Ñ
=Ô
=€CØð ð �iŠi‰kŒkˆå
Ô
˜c 6°4Ð
8Ñ
8Ô
8€CÝ	Œ•k¨Ð	7Ñ	7Ô	7ð Hð HØ×4Ò4°SÀ$Ð4ÑGÔGÐðHð Hð Hñ Hô Hð Hð Hð Hð Hð Hð Høøøð Hð Hð Hð Hå	Œ•k¨Ð	7Ñ	7Ô	7ð 9ð 9ØŸš c°4˜Ñ8Ô8ˆð9ð 9ð 9ñ 9ô 9ð 9ð 9ð 9ð 9ð 9ð 9øøøð 9ð 9ð 9ð 9åØ˜˜˜˜Q ˜F˜Ô# ^°A°A°A¸¸1°v°IÔ%>ÀQÈUðñ ô ð õ Ø˜#˜˜q˜Ô! >°3°$¸°'Ô#:ÀÈðñ ô ð õ Ø˜˜a˜Ô  .°°a°Ô"8¸tðñ ô ð ð ð sH   Á>B"Â"B&Â)B&ÃC,Ã,C0Ã3C0Ç+HÈHÈHÈ5IÉIÉ Ic                  óä  — t           j                             d¦  «        } d}t          j        || ¬¦  «        }|                     ¦   «         }|                     ¦   «         }|                     ¦   «         }t          j        d||¦  «        }t          j        d||¦  «        }t          j        |ddf¦  «        }t          j        d¦  «        |d d …<   t          ||¦  «         t          ||¦  «         d S )Nr   r7   )Únumr˜   r�   r   )
r    r:   r;   r   r]   r<   r£   rx  r=   r   )	r¥   r  ÚprE   Úp_matÚq_matÚresult1Úresult2rª   s	            r   Útest_invr°  •  sÏ   € Ý
Œ)×
Ò
 Ñ
"Ô
"€CØ
€AåŒ˜A¨CÐ0Ñ0Ô0€AØ	�Š‰Œ€Aà�KŠK‰MŒM€EØ�KŠK‰MŒM€EÝŒiÐ,¨e°UÑ;Ô;€GÝŒiÐ,¨e°UÑ;Ô;€GåŒH�a˜˜A�YÑÔ€EÝŒv�a‰yŒy€Eˆ!ˆ!ˆ!�Hå˜g uÑ-Ô-Ð-Ý˜g uÑ-Ô-Ð-Ð-Ð-r   c                  ó8  — t           j                             d¦  «        } t          j        | ¬¦  «        }|                     ¦   «         }|                     ¦   «         }|                     ¦   «         }t          j        ||¦  «        }t          j        ||¦  «        }t          j        d¦  «        }t          ||¦  «         t          ||¦  «         t          j        d| ¬¦  «        }|                     ¦   «         }	|                     ¦   «         }
|	                     ¦   «         }t          j	        d|
|¦  «        }t          j	        d||
¦  «        }t          j
        d¦  «        }t          j        d¦  «        |d d …<   t          ||¦  «         t          ||¦  «         d S )Nì	   #Þ;h2ã9¾s+,g0øHn ©rD   r   r   )rª  rD   r�   rt   )r    r:   Údefault_rngr   r]   r<   Údotr=   r   r£   rx  )rD   r«  rE   r¬  r­  Úres1Úres2r=   r   r   Úx_matrixÚy_matrixr®  r¯  rª   s                  r   Útest_inv_single_rotationrº  ¨  sM  € Ý
Œ)×
Ò
Ð GÑ
HÔ
H€CÝŒ˜CÐ Ñ Ô €AØ	�Š‰Œ€Aà�KŠK‰MŒM€EØ�KŠK‰MŒM€EÝŒ6�%˜ÑÔ€DÝŒ6�%˜ÑÔ€Då
Œ&�‰)Œ)€Cå˜d CÑ(Ô(Ð(Ý˜d CÑ(Ô(Ð(åŒ˜A 3Ð'Ñ'Ô'€AØ	�Š‰Œ€Aà�{Š{‰}Œ}€HØ�{Š{‰}Œ}€HÝŒiÐ,¨h¸ÑAÔA€GÝŒiÐ,¨h¸ÑAÔA€GåŒH�YÑÔ€EÝŒv�a‰yŒy€Eˆ!ˆ!ˆ!�Hå˜g uÑ-Ô-Ð-Ý˜g uÑ-Ô-Ð-Ð-Ð-r   c                  óþ   — d} t          t          j        | ¦  «                             ¦   «         d¦  «         t          t          j        | ¦  «                             ¦   «                              ¦   «         d¦  «         d S )Nr7   r   )r   r   ÚidentityÚ	magnituder]   )r  s    r   Útest_identity_magnituder¾  Æ  sg   € Ø
€AÝ•HÔ% aÑ(Ô(×2Ò2Ñ4Ô4°aÑ8Ô8Ð8Ý•HÔ% aÑ(Ô(×,Ò,Ñ.Ô.×8Ò8Ñ:Ô:¸AÑ>Ô>Ð>Ð>Ð>r   c                  óÖ   — t          j        ¦   «                              ¦   «         dk    sJ ‚t          j        ¦   «                              ¦   «                              ¦   «         dk    sJ ‚d S )Nr   )r   r¼  r½  r]   r   r   r   Útest_single_identity_magnituderÀ  Ì  s`   € ÝÔÑÔ×(Ò(Ñ*Ô*¨aÒ/Ð/Ð/Ð/ÝÔÑÔ×"Ò"Ñ$Ô$×.Ò.Ñ0Ô0°AÒ5Ð5Ð5Ð5Ð5Ð5r   c                  ób  — d} t          j        | d¬¦  «        }|t          j        | ¦  «        z  }t          |                     ¦   «         |                     ¦   «         ¦  «         ||                     ¦   «         z  }t          |                     ¦   «         t          j        | ¦  «        ¦  «         d S ©Nr7   r   r³  ©	r   r:   r¼  r   r#   r]   r½  r    rM   ©r  r«  r½   s      r   Útest_identity_invariancerÅ  Ñ  sŽ   € Ø
€AÝŒ˜˜qÐ!Ñ!Ô!€Aà•Ô" 1Ñ%Ô%Ñ%€FÝ˜aŸiši™kœk¨6¯>ª>Ñ+;Ô+;Ñ<Ô<Ð<à�a—e’e‘g”gÑ€FÝ˜f×.Ò.Ñ0Ô0µ"´(¸1±+´+Ñ>Ô>Ð>Ð>Ð>r   c                  ó`  — d} t          j        | d¬¦  «        }|t          j        ¦   «         z  }t          |                     ¦   «         |                     ¦   «         ¦  «         ||                     ¦   «         z  }t          |                     ¦   «         t          j        | ¦  «        ¦  «         d S rÂ  rÃ  rÄ  s      r   Útest_single_identity_invariancerÇ  Ü  sŒ   € Ø
€AÝŒ˜˜qÐ!Ñ!Ô!€Aà•Ô"Ñ$Ô$Ñ$€FÝ˜aŸiši™kœk¨6¯>ª>Ñ+;Ô+;Ñ<Ô<Ð<à�a—e’e‘g”gÑ€FÝ˜f×.Ò.Ñ0Ô0µ"´(¸1±+´+Ñ>Ô>Ð>Ð>Ð>r   c                  ó¸  — t          j        t          j        d¦  «        ¦  «        } |                      ¦   «         }t          |t          j        t          j        t          j        dg¦  «         t          j        t          j        d¦  «         ¦  «        } |                      ¦   «         }t          |t          j        t          j        t          j        dg¦  «         d S )Nr   r   )r   r"   r    r=   r½  r   r  )r%   r½   s     r   Útest_magnituderÉ  ç  s’   € ÝÔ�2œ6 !™9œ9Ñ%Ô%€AØ�[Š[‰]Œ]€FÝ˜f¥r¤u­b¬eµR´U¸AÐ&>Ñ?Ô?Ð?åÔ�BœF 1™IœI˜:Ñ&Ô&€AØ�[Š[‰]Œ]€FÝ˜f¥r¤u­b¬eµR´U¸AÐ&>Ñ?Ô?Ð?Ð?Ð?r   c                  ó  — t          j        t          j        d¦  «        ¦  «        } | d                              ¦   «         }t          |t          j        ¦  «         | d                              ¦   «         }t          |d¦  «         d S )Nr   r   r   )r   r"   r    r=   r½  r   r  )r%   r®  r¯  s      r   Útest_magnitude_single_rotationrË  ñ  sh   € ÝÔ�2œ6 !™9œ9Ñ%Ô%€AØ�Œd�nŠnÑÔ€GÝ�G�RœUÑ#Ô#Ð#à�Œd�nŠnÑÔ€GÝ�G˜QÑÔÐÐÐr   c                  ój  — t           j                             d¦  «        } t          j        d| ¬¦  «        }t          j        d| ¬¦  «        }||                     ¦   «         z  }|                     ¦   «         }t          j        |¦  «        }t          |                     ||¦  «        ||k     ¦  «         d S )Nr²  r7   r³  )	r    r:   r´  r   r]   r½  Úmedianr   Úapprox_equal)rD   r«  rE   r%   Úr_magr5   s         r   Útest_approx_equalrÐ  ú  s•   € Ý
Œ)×
Ò
Ð GÑ
HÔ
H€CÝŒ˜ Ð$Ñ$Ô$€AÝŒ˜ Ð$Ñ$Ô$€AØ	ˆA�EŠE‰GŒG‰€AØ�KŠK‰MŒM€EÝŒ9�UÑÔ€DÝ�—’  4Ñ(Ô(¨5°4ª<Ñ9Ô9Ð9Ð9Ð9r   c                  ó  — t          j        g d¢¦  «        } t          j        t          j        d¦  «        ¦  «        }|                      |d         ¦  «        sJ ‚|                      |d         ¦  «        rJ ‚|                      |d         d¬¦  «        rJ ‚|                      |d         dd¬	¦  «        rJ ‚t          j        t          d
¬¦  «        5  |                      |d         d¬¦  «        sJ ‚	 d d d ¦  «         d S # 1 swxY w Y   d S )N)r   r   r‡  r   r   r   ç»½×Ùß|Û=r[   g:Œ0âŽyE>T)r5   rÎ   zatol must be setra   rÍ   )	r   rº   r"   r    r=   rÎ  rh   r•  r–  )r«  rE   s     r   Ú!test_approx_equal_single_rotationrÓ    sI  € õ 	Ô˜\˜\˜\Ñ*Ô*€AÝÔ�2œ6 !™9œ9Ñ%Ô%€AØ�>Š>˜!˜Aœ$ÑÔÐÐÐØ�~Š~˜a œdÑ#Ô#Ð#Ð#Ð#ð �~Š~˜a œd¨ˆ~Ñ/Ô/Ð/Ð/Ð/Ø�~Š~˜a œd¨°tˆ~Ñ<Ô<Ð<Ð<Ð<Ý	Œ•kÐ);Ð	<Ñ	<Ô	<ð 2ð 2Ø�~Š~˜a œd¨Dˆ~Ñ1Ô1Ð1Ð1Ð1Ð1ð2ð 2ð 2ñ 2ô 2ð 2ð 2ð 2ð 2ð 2ð 2ð 2øøøð 2ð 2ð 2ð 2ð 2ð 2s   Ã C?Ã?DÄDc                  óf  — t          j        t          j        d¦  «         t          j        d¦  «        f¦  «        } t          j        dt           j        dz  d¦  «        }|D ]O}t          j        || z  ¦  «        }t          |                     ¦   «          	                    ¦   «         dd¬¦  «         ŒPd S )Nr   r   rU   r8   rÒ  r[   )
r    Úconcatenater=   Úlinspacer  r   rº   r   rg  r½  )ÚaxesÚthetasÚtr%   s       r   Ú	test_meanrÚ    sš   € ÝŒ>�BœF 1™IœI˜:¥r¤v¨a¡y¤yÐ1Ñ2Ô2€DÝŒ[˜�BœE A™I sÑ+Ô+€FØð =ð =ˆÝÔ   T¡Ñ*Ô*ˆÝ˜Ÿš™œ×*Ò*Ñ,Ô,¨a°eÐ<Ñ<Ô<Ð<Ð<ð=ð =r   c                  óÆ  — t          j        g d¢g d¢g d¢g¦  «        } t          j        dt           j        dz  d¦  «        }|D ]�}t	          j        || d d…         z  ¦  «        }|                     ddg¬¦  «        }t	          j        || z  ¦  «        }|                     ¦   «         }t          ||                     ¦   «         z   	                    ¦   «         dd¬	¦  «         Œžd S )
NrÄ   r   r   rU   r8   r   ©ÚweightsrÒ  r[   )
r    r!   rÖ  r  r   rº   rg  r   r]   r½  )r×  rØ  rÙ  ÚrwÚmwr%   Úms          r   Útest_weighted_meanrá    sÞ   € åŒ8�Y�Y�Y 	 	 	¨9¨9¨9Ð5Ñ6Ô6€DÝŒ[˜�BœE A™I sÑ+Ô+€FØð Cð CˆÝÔ! ! d¨2¨A¨2¤h¡,Ñ/Ô/ˆØ�WŠW˜a ˜VˆWÑ$Ô$ˆåÔ   T¡Ñ*Ô*ˆØ�FŠF‰HŒHˆÝ˜˜RŸVšV™XœX™×0Ò0Ñ2Ô2°A¸EÐBÑBÔBÐBÐBðCð Cr   c                  ó  — t          j        t          d¬¦  «        5  t          j        t          j        d¦  «        ¦  «        } |                      t          j        d¦  «         ¬¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )Nznon-negativera   r   rÜ  )	rh   ri   rj   r   r"   r    r=   rg  Úones©r%   s    r   Útest_mean_invalid_weightsrå  (  s±   € Ý	Œ•z¨Ð	8Ñ	8Ô	8ð $ð $ÝÔ�rœv a™yœyÑ)Ô)ˆØ	�Š�œ ™
œ
�{ˆÑ#Ô#Ð#ð$ð $ð $ñ $ô $ð $ð $ð $ð $ð $ð $ð $øøøð $ð $ð $ð $ð $ð $s   œAA9Á9A=Â A=c                  ó‚   — t          j        ¦   «                              d¬¦  «        } t          | t           ¦  «        sJ ‚d S )NF©Úreturn_indices)r   r¼  ÚreduceÚ
isinstance)r½   s    r   Útest_reduction_no_indicesrë  .  s=   € ÝÔÑ Ô ×'Ò'°uÐ'Ñ=Ô=€FÝ�f�hÑ'Ô'Ð'Ð'Ð'Ð'Ð'r   c                  óÊ   — t          j        ¦   «                              d¬¦  «        } t          | ¦  «        t          u sJ ‚t          | ¦  «        dk    sJ ‚| \  }}}|�J ‚|�J ‚d S )NTrç  r   )r   r¼  ré  ÚtypeÚtupler¢   )r½   ÚreducedÚ	left_bestÚ
right_bests       r   Útest_reduction_none_indicesrò  3  sy   € ÝÔÑ Ô ×'Ò'°tÐ'Ñ<Ô<€FÝ�‰<Œ<�5Ð Ð Ð Ð Ýˆv‰;Œ;˜!ÒÐÐÐà%+Ñ"€GˆY˜
ØÐÐÐØÐÐÐÐÐr   c                  óÎ  — t           j                             d¦  «        } t          j        d| ¬¦  «        }t          j        d| ¬¦  «        }t          j        d| ¬¦  «        }|                     ||d¬¦  «        \  }}}t          j        t          |¦  «        t          |¦  «        t          |¦  «        f¦  «        }t          |¦  «        D ]g\  }}	t          |¦  «        D ]R\  }
}t          |¦  «        D ]=\  }}t          j        |	|z  |z   	                    ¦   «         d         ¦  «        |||
|f<   Œ>ŒSŒht          j
        t          j        |d	d
¦  «        |j        d	         df¦  «        }t          j        t          j
        |t          |¦  «        df¦  «        d	¬¦  «        }|t          |¦  «        z  }|t          |¦  «        z  }||k                         ¦   «         sJ ‚||k                         ¦   «         sJ ‚||         |z  ||         z  }|                     ¦   «         |z                       ¦   «         }t#          |t          j        t          |¦  «        ¦  «        ¦  «         d S )Nr²  r   r³  r7   re   Trç  r   r   r   rR   r   )r    r:   r´  r   ré  rM   r¢   Ú	enumeraterX   r#   rŽ   Úmoveaxisrw   Úargmaxrj  r]   r½  r   )rD   Úlr%   r«  rï  rð  rñ  Úscalarsr§   ÚliÚjÚpjÚkÚrkÚmax_indÚleft_best_checkÚright_best_checkÚreduced_checkÚmags                      r   Ú!test_reduction_scalar_calculationr  =  s@  € Ý
Œ)×
Ò
Ð GÑ
HÔ
H€CÝŒ˜˜sÐ#Ñ#Ô#€AÝŒ˜ Ð$Ñ$Ô$€AÝŒ˜˜sÐ#Ñ#Ô#€AØ%&§X¢X¨a°À4 XÑ%HÔ%HÑ"€GˆY˜
õ Œh�˜A™œ¥ A¡¤­¨A©¬Ð/Ñ0Ô0€GÝ˜1‘”ð Gð G‰ˆˆ2Ý˜q‘\”\ð 	Gð 	G‰EˆAˆrÝ" 1™œð Gð G‘��2Ý#%¤6¨2°©7°R©<×*@Ò*@Ñ*BÔ*BÀ1Ô*EÑ#FÔ#F�˜˜1˜a˜Ñ Ð ðGð	Gõ Œj�œ W¨a°Ñ3Ô3°g´mÀAÔ6FÈÐ5KÑLÔL€GåŒi�œ
 7­S°©V¬V°R¨LÑ9Ô9ÀÐBÑBÔB€GØ¥ Q¡¤Ñ'€OØ¥ Q¡¤Ñ'ÐØ˜Ò(×-Ò-Ñ/Ô/Ð/Ð/Ð/ØÐ*Ò*×/Ò/Ñ1Ô1Ð1Ð1Ð1à�oÔ&¨Ñ*¨QÐ/?Ô-@Ñ@€MØ�;Š;‰=Œ=˜=Ñ(×
3Ò
3Ñ
5Ô
5€CÝ˜c¥2¤8­C°©F¬FÑ#3Ô#3Ñ4Ô4Ð4Ð4Ð4r   c                  ó   — t          j        g d¢g d¢g d¢g¦  «        } t          j        | ¦  «        }t          j        t          j        | d¬¦  «        ¦  «        }t          j        g d¢¦  «        }t          j        |d¬¦  «        }t          j        g d¢¦  «        }t          j        |d¬¦  «        }t          |                     |¦  «        |¦  «         t          |                     |¦  «        |¦  «         t          |                     |¦  «        |¦  «         t          |                     |¦  «        |¦  «         t          j        g d¢¦  «        }t          j        |d¬¦  «        }t          |                     |d	¬
¦  «        |¦  «         t          |                     |d	¬
¦  «        |¦  «         t          |                     |d	¬
¦  «        |¦  «         t          |                     |d	¬
¦  «        |¦  «         d S )Nru   r   r   r   r   rc   ©rƒ   r   r   ©rU   rR   r   T©Úinverse©r    r!   r   r‰   Úexpand_dimsr   Úapply)	rp   Úr_1dÚr_2dÚv_1dÚv_2dÚv1d_rotatedÚv2d_rotatedÚv1d_inverseÚv2d_inverses	            r   Ú'test_apply_single_rotation_single_pointr  W  sÉ  € Ý
Œ(Øˆ
ˆ
Øˆ	ˆ	Øˆ	ˆ	ðñ ô €Cõ
 Ô Ñ$Ô$€DÝÔ¥¤¨s¸Ð ;Ñ ;Ô ;Ñ<Ô<€DåŒ8�I�I�IÑÔ€DÝŒ>˜$ QÐ'Ñ'Ô'€DÝ”(˜:˜:˜:Ñ&Ô&€KÝ”. °1Ð5Ñ5Ô5€Kå�D—J’J˜tÑ$Ô$ kÑ2Ô2Ð2Ý�D—J’J˜tÑ$Ô$ kÑ2Ô2Ð2Ý�D—J’J˜tÑ$Ô$ kÑ2Ô2Ð2Ý�D—J’J˜tÑ$Ô$ kÑ2Ô2Ð2å”(˜:˜:˜:Ñ&Ô&€KÝ”. °1Ð5Ñ5Ô5€Kå�D—J’J˜t¨T�JÑ2Ô2°KÑ@Ô@Ð@Ý�D—J’J˜t¨T�JÑ2Ô2°KÑ@Ô@Ð@Ý�D—J’J˜t¨T�JÑ2Ô2°KÑ@Ô@Ð@Ý�D—J’J˜t¨T�JÑ2Ô2°KÑ@Ô@Ð@Ð@Ð@r   c                  ót  — t          j        g d¢g d¢g d¢g¦  «        } t          j        | ¦  «        }t          j        t          j        | d¬¦  «        ¦  «        }t          j        g d¢g d¢g¦  «        }t          j        g d¢g d	¢g¦  «        }t          |                     |¦  «        |¦  «         t          |                     |¦  «        |¦  «         t          j        g d
¢g d¢g¦  «        }t          |                     |d¬¦  «        |¦  «         t          |                     |d¬¦  «        |¦  «         d S )Nru   r   r   r   r   rc   ©r   r   rd   r  )éûÿÿÿr   rd   r  )r   éüÿÿÿrd   Tr  r	  )rp   Úr1Úr2ÚvÚ	v_rotatedÚ	v_inverses         r   Ú*test_apply_single_rotation_multiple_pointsr  s  s,  € Ý
Œ(Øˆ
ˆ
Øˆ	ˆ	Øˆ	ˆ	ðñ ô €Cõ
 
Ô	˜cÑ	"Ô	"€BÝ	Ô	�bœn¨S°qÐ9Ñ9Ô9Ñ	:Ô	:€Bå
Œ�)�)�)˜Y˜Y˜YÐ'Ñ(Ô(€AÝ”˜*˜*˜* j j jÐ1Ñ2Ô2€Iå�B—H’H˜Q‘K”K Ñ+Ô+Ð+Ý�B—H’H˜Q‘K”K Ñ+Ô+Ð+å”˜*˜*˜* j j jÐ1Ñ2Ô2€Iå�B—H’H˜Q¨�HÑ-Ô-¨yÑ9Ô9Ð9Ý�B—H’H˜Q¨�HÑ-Ô-¨yÑ9Ô9Ð9Ð9Ð9r   c                  ó¶  — t          j        d¦  «        } t          j        g d¢g d¢g d¢g¦  «        | d<   t          j        g d¢g d¢g d¢g¦  «        | d<   t          j        | ¦  «        }t          j        g d	¢¦  «        }t          j        |d¬
¦  «        }t          j        g d¢g d¢g¦  «        }t          |                     |¦  «        |¦  «         t          |                     |¦  «        |¦  «         t          j        g d¢g d¢g¦  «        }t          |                     |d¬¦  «        |¦  «         t          |                     |d¬¦  «        |¦  «         d S )N©rU   r   r   ru   r   r   r   r6  r   r   rc   r   r  )r   rë   rU   r  )r   r   rƒ   Tr  )r    rx  r!   r   r‰   r
  r   r  )rp   r%   Úv1Úv2r  r  s         r   Ú*test_apply_multiple_rotations_single_pointr#  ˆ  s\  € Ý
Œ(�9Ñ
Ô
€CÝŒXØˆ
ˆ
Øˆ	ˆ	Øˆ	ˆ	ðñ ô €Cˆ�Fõ
 ŒXØˆ	ˆ	Øˆ
ˆ
Øˆ	ˆ	ðñ ô €Cˆ�Fõ
 	Ô˜SÑ!Ô!€Aå	Œ�)�)�)Ñ	Ô	€BÝ	Œ˜ Ð	#Ñ	#Ô	#€Bå”˜*˜*˜* j j jÐ1Ñ2Ô2€Iå�A—G’G˜B‘K”K Ñ+Ô+Ð+Ý�A—G’G˜B‘K”K Ñ+Ô+Ð+å”˜*˜*˜* j j jÐ1Ñ2Ô2€Iå�A—G’G˜B¨�GÑ-Ô-¨yÑ9Ô9Ð9Ý�A—G’G˜B¨�GÑ-Ô-¨yÑ9Ô9Ð9Ð9Ð9r   c                  ó  — t          j        d¦  «        } t          j        g d¢g d¢g d¢g¦  «        | d<   t          j        g d¢g d¢g d¢g¦  «        | d<   t          j        | ¦  «        }t          j        g d	¢g d
¢g¦  «        }t          j        g d¢g d¢g¦  «        }t          |                     |¦  «        |¦  «         t          j        g d¢g d¢g¦  «        }t          |                     |d¬¦  «        |¦  «         d S )Nr   ru   r   r   r   r6  r   r   rc   r  r  )r   iúÿÿÿr   r  )r   rd   r  Tr  )r    rx  r!   r   r‰   r   r  )rp   r%   r  r  r  s        r   Ú-test_apply_multiple_rotations_multiple_pointsr%  ¤  s  € Ý
Œ(�9Ñ
Ô
€CÝŒXØˆ
ˆ
Øˆ	ˆ	Øˆ	ˆ	ðñ ô €Cˆ�Fõ
 ŒXØˆ	ˆ	Øˆ
ˆ
Øˆ	ˆ	ðñ ô €Cˆ�Fõ
 	Ô˜SÑ!Ô!€Aå
Œ�)�)�)˜Y˜Y˜YÐ'Ñ(Ô(€AÝ”˜*˜*˜* j j jÐ1Ñ2Ô2€IÝ�A—G’G˜A‘J”J 	Ñ*Ô*Ð*å”˜*˜*˜* j j jÐ1Ñ2Ô2€IÝ�A—G’G˜A t�GÑ,Ô,¨iÑ8Ô8Ð8Ð8Ð8r   c                  ó"  — t          j        d¦  «        } t          j        g d¢g d¢g d¢g¦  «        | d<   t          j        g d¢g d¢g d¢g¦  «        | d<   t          j        | ¦  «        }t          |d                              ¦   «         | d         d	¬
¦  «         t          |d                              ¦   «         | d         d	¬
¦  «         t          |d d…                              ¦   «         t          j        | d         d¬¦  «        d	¬
¦  «         d S )Nr   ru   r   r   r   r6  r   r   r1   r[   rR   r   )r    rx  r!   r   r‰   r   r<   r
  ©rp   r%   s     r   Útest_getitemr(  º  s  € Ý
Œ(�9Ñ
Ô
€CÝŒXØˆ
ˆ
Øˆ	ˆ	Øˆ	ˆ	ðñ ô €Cˆ�Fõ
 ŒXØˆ	ˆ	Øˆ
ˆ
Øˆ	ˆ	ðñ ô €Cˆ�Fõ
 	Ô˜SÑ!Ô!€Aå�A�a”D—N’NÑ$Ô$ c¨!¤f°5Ð9Ñ9Ô9Ð9Ý�A�a”D—N’NÑ$Ô$ c¨!¤f°5Ð9Ñ9Ô9Ð9Ý�A�c�r�c”F×$Ò$Ñ&Ô&­¬°s¸1´vÀAÐ(FÑ(FÔ(FÈUÐSÑSÔSÐSÐSÐSr   c                  ó    — t          j        t          d¬¦  «        5  t          j        ¦   «         d          d d d ¦  «         d S # 1 swxY w Y   d S ©Nznot subscriptablera   r   )rh   ri   Ú	TypeErrorr   r¼  r   r   r   Útest_getitem_singler,  Í  s�   € Ý	Œ•yÐ(;Ð	<Ñ	<Ô	<ð ð ÝÔÑÔ˜AÔÐðð ð ñ ô ð ð ð ð ð ð ð øøøð ð ð ð ð ð s   œAÁAÁ
Ac                  óÀ   — t          j        ¦   «         } t          j        t          d¬¦  «        5  t          j        ¦   «         | d<   d d d ¦  «         d S # 1 swxY w Y   d S r*  )r   r¼  rh   ri   r+  rä  s    r   Útest_setitem_singler.  Ò  sœ   € ÝÔÑÔ€AÝ	Œ•yÐ(;Ð	<Ñ	<Ô	<ð #ð #ÝÔ Ñ"Ô"ˆˆ!‰ð#ð #ð #ñ #ô #ð #ð #ð #ð #ð #ð #ð #øøøð #ð #ð #ð #ð #ð #s   ¯AÁAÁAc                  ó"  — t           j                             d¦  «        } t          j        d| ¬¦  «        }t          j        d| ¬¦  «        }||dd…<   t	          |dd…                              ¦   «         |                     ¦   «         ¦  «         d S )Nr²  r7   r³  r   r   rd   ©r    r:   r´  r   r   r#   ©rD   r  r  s      r   Útest_setitem_slicer2  Ø  s}   € Ý
Œ)×
Ò
Ð GÑ
HÔ
H€CÝ	Œ˜ Ð	%Ñ	%Ô	%€BÝ	Œ˜ Ð	$Ñ	$Ô	$€BØ€B€qˆ€s�GÝ��A�a�C”—’Ñ"Ô" B§J¢J¡L¤LÑ1Ô1Ð1Ð1Ð1r   c                  ó  — t           j                             d¦  «        } t          j        d| ¬¦  «        }t          j        | ¬¦  «        }||d<   t	          |d                              ¦   «         |                     ¦   «         ¦  «         d S )Nr²  r7   r³  r   r0  r1  s      r   Útest_setitem_integerr4  à  sq   € Ý
Œ)×
Ò
Ð GÑ
HÔ
H€CÝ	Œ˜ Ð	%Ñ	%Ô	%€BÝ	Œ˜SÐ	!Ñ	!Ô	!€BØ€B€q�EÝ��A”—’‘” "§*¢*¡,¤,Ñ/Ô/Ð/Ð/Ð/r   c                  ó¤   — t          j        dd¬¦  «        } t          j        t          d¬¦  «        5  d| d<   d d d ¦  «         d S # 1 swxY w Y   d S )Nr7   r   r³  zRotation objectra   r   )r   r:   rh   ri   r+  rä  s    r   Útest_setitem_wrong_typer6  è  s™   € ÝŒ˜ Ð"Ñ"Ô"€AÝ	Œ•yÐ(9Ð	:Ñ	:Ô	:ð ð Øˆˆ!‰ðð ð ñ ô ð ð ð ð ð ð ð øøøð ð ð ð ð ð s   ²AÁA	ÁA	c                  óZ  — t          j        d¦  «        } t          j        g d¢g d¢g d¢g¦  «        | d<   t          j        g d¢g d¢g d¢g¦  «        | d<   t          j        | ¦  «        }t          t          |¦  «        d	¦  «         t          t          |d d
…         ¦  «        d¦  «         d S )Nr   ru   r   r   r   r6  r   r   rU   rR   )r    rx  r!   r   r‰   r   r¢   r'  s     r   Útest_n_rotationsr8  î  s½   € Ý
Œ(�9Ñ
Ô
€CÝŒXØˆ
ˆ
Øˆ	ˆ	Øˆ	ˆ	ðñ ô €Cˆ�Fõ
 ŒXØˆ	ˆ	Øˆ
ˆ
Øˆ	ˆ	ðñ ô €Cˆ�Fõ
 	Ô˜SÑ!Ô!€Aå•�Q‘”˜ÑÔÐÝ•�Q�s˜�s”V‘”˜aÑ Ô Ð Ð Ð r   c                  ó  — t           j                             d¦  «        } t          t	          j        | ¬¦  «                             ¦   «         j        d¦  «         t          t	          j        d | ¬¦  «                             ¦   «         j        d¦  «         t          t	          j        d| ¬¦  «                             ¦   «         j        d¦  «         t          t	          j        d| ¬¦  «                             ¦   «         j        d¦  «         d S )Nr²  r³  ©r   r   r�   r   ©r   r   )r    r:   r´  r   r   r#   rw   r³  s    r   Útest_random_rotation_shaper<     sÔ   € Ý
Œ)×
Ò
Ð GÑ
HÔ
H€CÝ•” SÐ)Ñ)Ô)×1Ò1Ñ3Ô3Ô9¸4Ñ@Ô@Ð@Ý•” ¨3Ð/Ñ/Ô/×7Ò7Ñ9Ô9Ô?ÀÑFÔFÐFå•” ¨Ð,Ñ,Ô,×4Ò4Ñ6Ô6Ô<¸fÑEÔEÐEÝ•” ¨Ð,Ñ,Ô,×4Ò4Ñ6Ô6Ô<¸fÑEÔEÐEÐEÐEr   c                  ó  — t          j        g d¢g d¢g¦  «        } |                      ¦   «         }t          j        | |¦  «        \  }}t          |                     ¦   «         t          j        d¦  «        ¦  «         t          |dd¬¦  «         d S )Nrc   r  r   r   r°   r[   )	r    r!   Úcopyr   Úalign_vectorsr   r<   r=   r   )r   r   r%   Úrssds       r   Útest_align_vectors_no_rotationrA  	  s|   € Ý
Œ�)�)�)˜Y˜Y˜YÐ'Ñ(Ô(€AØ	�Š‰Œ€AåÔ$ Q¨Ñ*Ô*�G€A€tÝ˜aŸkšk™mœm­R¬V°A©Y¬YÑ7Ô7Ð7Ý�D˜! $Ð'Ñ'Ô'Ð'Ð'Ð'r   c                  ó€  — t           j                             d¦  «        } t          j        | ¬¦  «        }|                      d¬¦  «        }|                     |¦  «        }t          j        ||¦  «        \  }}t          |                     ¦   «         |                     ¦   «         ¦  «         t          |dd¬¦  «         d S )Nl	   #Þt}":xþ×L r³  )r   r   ©r—   r   r¤  r[   )	r    r:   r´  r   Únormalr  r?  r   r#   )rD   Úcr2  r1  Úestr@  s         r   Útest_align_vectors_no_noiserG    s�   € Ý
Œ)×
Ò
Ð FÑ
GÔ
G€CÝŒ˜CÐ Ñ Ô €AØ�
Š
˜ˆ
ÑÔ€AØ	�Š�‰
Œ
€AåÔ& q¨!Ñ,Ô,�I€CˆÝ�A—I’I‘K”K §¢¡¤Ñ/Ô/Ð/Ý�D˜! $Ð'Ñ'Ô'Ð'Ð'Ð'r   c                  ó  — t          j        g d¢g d¢g¦  «        } t          j        g d¢g d¢g¦  «        }t          j        | |¦  «        \  }}t	          | |                     |¦  «        d¬¦  «         t	          |dd¬¦  «         d S )	N)gð…q“ì?gÔH*×fÜ¿gþHlÒÈB³?)gM·Ós^Eã?g+ObçpÞ¿gÕn^w„ä¿)g¯=Ô2)p˜?g[�[VåKê¿gª?gwí7â?)g�Ëû²Ñ¿gãÜGêvî¿gpÏßßÀ¿r°   r[   r   r¤  )r    r!   r   r?  r   r  )r   r   rF  r@  s       r   Ú$test_align_vectors_improper_rotationrI    s¤   € å
ŒÐ6Ð6Ð6Ø7Ð7Ð7ð9ñ 	:ô 	:€Aå
ŒÐ6Ð6Ð6Ø8Ð8Ð8ð:ñ 	;ô 	;€Aõ Ô& q¨!Ñ,Ô,�I€CˆÝ�A�s—y’y ‘|”|¨$Ð/Ñ/Ô/Ð/Ý�D˜! $Ð'Ñ'Ô'Ð'Ð'Ð'r   c                  ó  — d} t          j        g d¢g d¢g d¢g¦  «        }d}g d¢g d¢g d¢g}g d¢g d	¢g d
¢g}t          j        ||d¬¦  «        \  }}}t          j        || |¬¦  «        sJ ‚t          j        |||¬¦  «        sJ ‚d S )NgÔbÿQÂ?)rÈ   r¯   r¯   )r¯   ç      ø?rž   )r¯   rž   rž   r°   r   ©r   r   r   r   )r   gš™™™™™ñ?r   )r   gÍÌÌÌÌÌì?r   T©Úreturn_sensitivityr[   )r    r!   r   r?  ÚiscloseÚallclose)Úrssd_expectedÚsens_expectedr5   r1  r2  rö   r@  Úsenss           r   Ú#test_align_vectors_rssd_sensitivityrT  )  sÅ   € Ø%€MÝ”H˜n˜n˜nØ,˜n˜nØ,˜n˜nð.ñ /ô /€Mð €DØ	ˆˆ�I�I�I˜y˜y˜yÐ)€AØ	ˆˆ�K�K�K   Ð-€AÝÔ,¨Q°ÀdÐKÑKÔK�O€CˆˆtÝŒ:�d˜M°Ð5Ñ5Ô5Ð5Ð5Ð5ÝŒ;�t˜]°Ð6Ñ6Ô6Ð6Ð6Ð6Ð6Ð6r   c                  óJ  — d} t          j        | d¬¦  «                             g d¢¦  «        }t          j        | d¬¦  «                             g d¢¦  «        }d}t          j        ||t	          j        | ¦  «        d¦  «        \  }}}t          j        |||t	          j        | ¦  «        z  d¦  «        \  }}}	t          |                     ¦   «         |                     ¦   «         ¦  «         t          t	          j        |¦  «        |z  |d¬	¦  «         t          ||	¦  «         d S )
Nr7   r   r³  r   r   rU   Tr°   r[   )	r   r:   r  r?  r    rã  r   r<   r\   )
r  r1  r2  ÚscaleÚest1Úrssd1Úcov1Úest2Úrssd2Úcov2s
             r   Ú!test_align_vectors_scaled_weightsr]  6  s  € Ø
€AÝŒ˜˜qÐ!Ñ!Ô!×'Ò'¨	¨	¨	Ñ2Ô2€AÝŒ˜˜qÐ!Ñ!Ô!×'Ò'¨	¨	¨	Ñ2Ô2€AØ€Eå Ô.¨q°!µR´W¸Q±Z´ZÀÑFÔFÑ€Dˆ%�Ý Ô.¨q°!°U½R¼WÀQ¹Z¼ZÑ5GÈÑNÔNÑ€Dˆ%�å�D—N’NÑ$Ô$ d§n¢nÑ&6Ô&6Ñ7Ô7Ð7Ý•B”G˜E‘N”N UÑ*¨E¸Ð=Ñ=Ô=Ð=Ý�D˜$ÑÔÐÐÐr   c            	      ó¬  — t           j                             d¦  «        } d}t          j        | ¬¦  «        }|                      |df¬¦  «        }|                     |¦  «        }t          j        d¦  «        }d|z  }t          j        |                      |df|¬¦  «        ¦  «        }|                     |¦  «        }t          j        ||d	¬
¦  «        \  }	}
}||	 	                    ¦   «         z   
                    ¦   «         }t          |d         d|¬¦  «         t          |d         d|¬¦  «         t          |d         d|¬¦  «         ||z  }t          |d         d|¬¦  «         t          |d         d|¬¦  «         t          |d         d|¬¦  «         t          |
t          j        ||	                     |¦  «        z
  dz  ¦  «        dz  ¦  «         d S )Nr²  r8   r³  r   rC  r   rK  )r—   rV  TrM  r   r[   rU   rµ   )r   r   )rU   rU   rˆ   )r    r:   r´  r   rD  r  rÐ   rº   r?  r]   rä   r   Úsum)rD   Ú	n_vectorsrö   Úvectorsr½   ÚsigmaÚ	toleranceÚnoiseÚnoisy_resultrF  r@  ÚcovÚerror_vectors                r   Útest_align_vectors_noiserh  D  sÖ  € Ý
Œ)×
Ò
Ð GÑ
HÔ
H€CØ€IÝ
Œ/˜cÐ
"Ñ
"Ô
"€CØ�jŠj˜y¨!˜nˆjÑ-Ô-€GØ�YŠY�wÑÔ€Fõ ŒJ�q‰MŒM€EØ�e‘€IÝÔ Ø�
Š
Ø˜Q�Øð 	ñ 	
ô 	
ñô €Eð —;’;˜vÑ&Ô&€LåÔ+¨L¸'Ø?CðEñ Eô E�N€Cˆˆsð ˜#Ÿ'š'™)œ)‘O×.Ò.Ñ0Ô0€LÝ�L ”O Q¨YÐ7Ñ7Ô7Ð7Ý�L ”O Q¨YÐ7Ñ7Ô7Ð7Ý�L ”O Q¨YÐ7Ñ7Ô7Ð7ð ˆ5�L€CÝ�C˜”I˜q yÐ1Ñ1Ô1Ð1Ý�C˜”I˜q yÐ1Ñ1Ô1Ð1Ý�C˜”I˜q yÐ1Ñ1Ô1Ð1å�D�"œ& ,°·²¸7Ñ1CÔ1CÑ"CÀaÑ!GÑHÔHÈ#ÑMÑNÔNÐNÐNÐNr   c                  óª  — t          j        t          d¬¦  «        5  t          j        g d¢g d¢¦  «         d d d ¦  «         n# 1 swxY w Y   t          j        t          d¬¦  «        5  t          j        g d¢g d¢¦  «         d d d ¦  «         n# 1 swxY w Y   t          j        t          d¬¦  «        5  t          j        g d¢g d¢gg d¢g¦  «         d d d ¦  «         n# 1 swxY w Y   t          j        t          d¬¦  «        5  t          j        g d¢gg d¢gd	gg¬
¦  «         d d d ¦  «         n# 1 swxY w Y   t          j        t          d¬¦  «        5  t          j        g d¢g d¢gg d¢g d¢gg d¢¬
¦  «         d d d ¦  «         n# 1 swxY w Y   t          j        t          d¬¦  «        5  t          j        g d¢gg d¢gdg¬
¦  «         d d d ¦  «         n# 1 swxY w Y   t          j        t          d¬¦  «        5  t          j        g d¢g d¢gg d¢g d¢gt
          j        t
          j        g¬
¦  «         d d d ¦  «         n# 1 swxY w Y   t          j        t          d¬¦  «        5  t          j        g d¢gg d¢g¦  «         d d d ¦  «         n# 1 swxY w Y   t          j        t          d¬¦  «        5  t          j        g d¢g d¢gg d¢g d¢gdt
          j        d	g¬¦  «         d d d ¦  «         n# 1 swxY w Y   t          j        t          d¬¦  «        5  t          j        g d¢gg d¢gd¬¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )Nz Expected input `a` to have shapera   rg   rc   z Expected input `b` to have shapez/Expected inputs `a` and `b` to have same shapesr  z&Expected `weights` to be 1 dimensionalr   rÜ  z+Expected `weights` to have number of valuesz)`weights` may not contain negative valuesrR   z#Only one infinite weight is allowedz(Cannot align zero length primary vectorsrÄ   z Cannot return sensitivity matrixT)rN  rÝ  rM  )rh   ri   rj   r   r?  r    Úinfr   r   r   Ú test_align_vectors_invalid_inputrk  k  sŸ  € Ý	Œ•zÐ)KÐ	LÑ	LÔ	Lð 8ð 8ÝÔ˜|˜|˜|¨Y¨Y¨YÑ7Ô7Ð7ð8ð 8ð 8ñ 8ô 8ð 8ð 8ð 8ð 8ð 8ð 8øøøð 8ð 8ð 8ð 8õ 
Œ•zÐ)KÐ	LÑ	LÔ	Lð 8ð 8ÝÔ˜y˜y˜y¨,¨,¨,Ñ7Ô7Ð7ð8ð 8ð 8ñ 8ô 8ð 8ð 8ð 8ð 8ð 8ð 8øøøð 8ð 8ð 8ð 8õ 
Œ•zð *?ð 
@ñ 
@ô 
@ð Cð CåÔ 	 	 	¨)¨)¨)Ð4°y°y°y°kÑBÔBÐBðCð Cð Cñ Cô Cð Cð Cð Cð Cð Cð Cøøøð Cð Cð Cð Cõ 
Œ•zØEð
Gñ 
Gô 
Gð Hð HåÔ 	 	 	˜{¨Y¨Y¨Y¨KÀ1À#ÀÐGÑGÔGÐGðHð Hð Hñ Hô Hð Hð Hð Hð Hð Hð Høøøð Hð Hð Hð Hõ 
Œ•zØJð
Lñ 
Lô 
Lð 2ð 2åÔ 	 	 	¨9¨9¨9Ð5¸	¸	¸	À9À9À9Ð7MØ'0 y yð	2ñ 	2ô 	2ð 	2ð2ð 2ð 2ñ 2ô 2ð 2ð 2ð 2ð 2ð 2ð 2øøøð 2ð 2ð 2ð 2õ
 
Œ•zØHð
Jñ 
Jô 
Jð Gð GåÔ 	 	 	˜{¨Y¨Y¨Y¨KÀ"ÀÐFÑFÔFÐFðGð Gð Gñ Gô Gð Gð Gð Gð Gð Gð Gøøøð Gð Gð Gð Gõ 
Œ•zØBð
Dñ 
Dô 
Dð 9ð 9åÔ 	 	 	¨9¨9¨9Ð5¸	¸	¸	À9À9À9Ð7MÝ(*¬µ´Ð'7ð	9ñ 	9ô 	9ð 	9ð9ð 9ð 9ñ 9ô 9ð 9ð 9ð 9ð 9ð 9ð 9øøøð 9ð 9ð 9ð 9õ
 
Œ•zØGð
Iñ 
Iô 
Ið 9ð 9åÔ 	 	 	˜{¨Y¨Y¨Y¨KÑ8Ô8Ð8ð9ð 9ð 9ñ 9ô 9ð 9ð 9ð 9ð 9ð 9ð 9øøøð 9ð 9ð 9ð 9õ 
Œ•zØ?ð
Añ 
Aô 
Að Mð MåÔ 	 	 	¨9¨9¨9Ð5¸	¸	¸	À9À9À9Ð7MØ26ÅÄÈÀð	Mñ 	Mô 	Mð 	MðMð Mð Mñ Mô Mð Mð Mð Mð Mð Mð Møøøð Mð Mð Mð Mõ
 
Œ•zØ?ð
Añ 
Aô 
Að 8ð 8åÔ 	 	 	˜{¨Y¨Y¨Y¨KØ26ð	8ñ 	8ô 	8ð 	8ð8ð 8ð 8ñ 8ô 8ð 8ð 8ð 8ð 8ð 8ð 8ð 8øøøð 8ð 8ð 8ð 8ð 8ð 8s³   œAÁAÁ	AÁ(BÂBÂBÂ4CÃC#Ã&C#Ä D1Ä1D5Ä8D5Å&F	Æ	FÆFÆ/GÇGÇ!GÈ :IÉI
ÉI
É,JÊJÊJÊ:1K7Ë7K;Ë>K;ÌMÍMÍMc                  ó  — d} g d¢g d¢g}g d¢g d¢g}t          j        g d¢g d¢g d¢g¦  «        }t          j        ||t           j        dg¬¦  «        \  }}t          |                     ¦   «         || ¬	¦  «         t          |                     |¦  «        || ¬	¦  «         t          j        |d
| ¬	¦  «        sJ ‚g d¢g d¢g}d}t          j        ||t           j        dg¬¦  «        \  }}t          |                     ¦   «         || ¬	¦  «         t          |                     |¦  «        d
         |d
         | ¬	¦  «         t          j        ||| ¬	¦  «        sJ ‚g d¢g d¢g}t          |                     |¦  «        || ¬	¦  «         g d¢g d¢g}g d¢g d¢g}d}t          j        ||t           j        dg¬¦  «        \  }}t          |                     |¦  «        d
         |d
         | ¬	¦  «         t          j        ||| ¬	¦  «        sJ ‚d S )Nrt  r   r­   r   rL  r   r   rÜ  r[   r   )r   rU   r   rž   ©r   r   rU   rc   )rƒ   r   rR   )rR   r   rU   rù   gÿ4ÍÖiöô?)	r    r!   r   r?  rj  r   r<   r  rO  )r5   r2  r1  Ú
m_expectedÚRr@  rQ  Ú
a_expecteds           r   Ú"test_align_vectors_align_constrainrq  —  s5  € ð
 €DØ	ˆˆ�I�I�IÐ€AØ	ˆˆ�I�I�IÐ€AÝ”˜9˜9˜9Ø$˜9˜9Ø$˜9˜9ð&ñ 'ô '€Jõ Ô$ Q¨µB´F¸A°;Ð?Ñ?Ô?�G€A€tÝ�A—K’K‘M”M :°DÐ9Ñ9Ô9Ð9Ý�A—G’G˜A‘J”J ¨Ð-Ñ-Ô-Ð-ÝŒ:�d˜A DÐ)Ñ)Ô)Ð)Ð)Ð)ð 
ˆˆ�I�I�IÐ€AØ€MÝÔ$ Q¨µB´F¸A°;Ð?Ñ?Ô?�G€A€tÝ�A—K’K‘M”M :°DÐ9Ñ9Ô9Ð9Ý�A—G’G˜A‘J”J˜q”M 1 Q¤4¨dÐ3Ñ3Ô3Ð3ÝŒ:�d˜M°Ð5Ñ5Ô5Ð5Ð5Ð5Ø�)�)˜Y˜Y˜YÐ'€JÝ�A—G’G˜A‘J”J 
°Ð6Ñ6Ô6Ð6ð 
ˆˆ�K�K�KÐ €AØ	ˆˆ�Z�Z�ZÐ €AØ&€MÝÔ$ Q¨µB´F¸A°;Ð?Ñ?Ô?�G€A€tÝ�A—G’G˜A‘J”J˜q”M 1 Q¤4¨dÐ3Ñ3Ô3Ð3ÝŒ:�d˜M°Ð5Ñ5Ô5Ð5Ð5Ð5Ð5Ð5r   c                  ó¤  — d} g }t          d¦  «        D ]@}|                     t          j        | d|z   ¬¦  «                             ¦   «         ¦  «         ŒAt          | ¦  «        D ]Ö}d|d         |         d         z  d|d         |         d         z  g}d|d         |         d         z  d	|d         |         d         z  g}t          j        ||d
dg¬¦  «        \  }}t          j        ||t          j        dg¬¦  «        \  }}t          |                     ¦   «         |                     ¦   «         d¬¦  «         Œ×t          | ¦  «        D �]}d|d         |         d         z  d|d         |         d         z  d|d         |         d         z  g}d	|d         |         d         z  d|d	         |         d         z  d|d         |         d         z  g}t          j        ||g d¢¬¦  «        \  }}t          j        ||t          j        ddg¬¦  «        \  }}t          |                     ¦   «         |                     ¦   «         d¬¦  «         �Œd S )Nr8   rd   r7   r³  r   r   rU   r   r   ç    _ BrÜ  ç-Cëâ6?r[   r   )rs  rU   r   )	r¡   Úappendr   r:   r<   r?  r    rj  r   )r  Úmatsr§   r1  r2  ro  Ú_ÚR2s           r   Útest_align_vectors_near_infry  º  s1  € ð 	€AØ€DÝ�1‰XŒXð @ð @ˆØ�Š•H”O A¨2°©6Ð2Ñ2Ô2×<Ò<Ñ>Ô>Ñ?Ô?Ð?Ð?å�1‰XŒXð Bð Bˆàˆt�AŒw�qŒz˜!Œ}‰_˜a  Q¤¨¤
¨1¤™oÐ.ˆØˆt�AŒw�qŒz˜!Œ}‰_˜a  Q¤¨¤
¨1¤™oÐ.ˆåÔ% a¨°T¸1°IÐ>Ñ>Ô>‰ˆˆ1ÝÔ& q¨!µb´f¸a°[ÐAÑAÔA‰ˆˆAÝ˜Ÿš™œ r§|¢|¡~¤~¸DÐAÑAÔAÐAÐAå�1‰XŒXð Bñ Bˆàˆt�AŒw�qŒz˜!Œ}‰_˜a  Q¤¨¤
¨1¤™o¨q°°a´¸´¸A´©Ð?ˆØˆt�AŒw�qŒz˜!Œ}‰_˜a  Q¤¨¤
¨1¤™o¨q°°a´¸´¸A´©Ð?ˆåÔ% a¨°L°L°LÐAÑAÔA‰ˆˆ1ÝÔ& q¨!µb´f¸aÀ°^ÐDÑDÔD‰ˆˆAÝ˜Ÿš™œ r§|¢|¡~¤~¸DÐAÑAÔAÐAÑAðBð Br   c                  óº  — d} g d¢g d¢g}g d¢g d¢g}t          j        g d¢g d¢g d¢g¦  «        }t          j        ||t           j        dg¬¦  «        \  }}t          |                     ¦   «         || ¬¦  «         t          j        |d	         |d	         ¦  «        \  }}t          |                     ¦   «         || ¬¦  «         t          |                     |d	         ¦  «        |d	         | ¬¦  «         g d¢g d¢g}t          j        g d¢g d¢g d¢g¦  «        }t          j        ||t           j        dg¬¦  «        \  }}t          |                     ¦   «         || ¬¦  «         t          j        |d	         |d	         ¦  «        \  }}t          |                     ¦   «         || ¬¦  «         t          |                     |d	         ¦  «        |d	         | ¬¦  «         d S )
Nrt  r   r   r|   r   r   rÜ  r[   r   )r    r!   r   r?  rj  r   r<   r  )r5   r1  r2  rn  ro  rw  s         r   Útest_align_vectors_parallelr{  Ö  sÛ  € Ø€DØ	ˆˆ�I�I�IÐ€AØ	ˆˆ�I�I�IÐ€AÝ”˜9˜9˜9Ø%˜:˜:Ø$˜9˜9ð&ñ 'ô '€Jõ Ô! ! Qµ´¸°Ð<Ñ<Ô<�D€A€qÝ�A—K’K‘M”M :°DÐ9Ñ9Ô9Ð9ÝÔ! ! A¤$¨¨!¬Ñ-Ô-�D€A€qÝ�A—K’K‘M”M :°DÐ9Ñ9Ô9Ð9Ý�A—G’G˜A˜aœD‘M”M 1 Q¤4¨dÐ3Ñ3Ô3Ð3à	ˆˆ�I�I�IÐ€AÝ”˜9˜9˜9Ø$˜9˜9Ø$˜9˜9ð&ñ 'ô '€Jõ Ô! ! Qµ´¸°Ð<Ñ<Ô<�D€A€qÝ�A—K’K‘M”M :°DÐ9Ñ9Ô9Ð9ÝÔ! ! A¤$¨¨!¬Ñ-Ô-�D€A€qÝ�A—K’K‘M”M :°DÐ9Ñ9Ô9Ð9Ý�A—G’G˜A˜aœD‘M”M 1 Q¤4¨dÐ3Ñ3Ô3Ð3Ð3Ð3r   c                  ó¼  — d} t          j        g d¢g d¢gg d¢g d¢gg d¢g d¢gg¦  «        }d„ |D ¦   «         }t          ||¦  «        D ]Š\  }}t          j        ||t           j        dg¬¦  «        \  }}t          |                     ¦   «         t           j        | ¬¦  «         t          | 	                    |d	         ¦  «        |d	         | ¬¦  «         Œ‹t          j
        d
d	¬¦  «        }t          j        |                     ¦   «         dz  ¦  «        }g d¢g d¢g}g d¢g d¢g}g }|D ]8}	|                     |	 	                    |d	         ¦  «        |d         g¦  «         Œ9|D ]z}t          j        ||t           j        dg¬¦  «        \  }}t          j        ||ddg¬¦  «        \  }
}t          |                     ¦   «         |
                     ¦   «         | ¬¦  «         Œ{d S )Nrt  r   r   r   c                 ó0   — g | ]}|d           |d         g‘ŒS ©r   r   r   )Ú.0r1  s     r   ú
<listcomp>z3test_align_vectors_antiparallel.<locals>.<listcomp>ô  s&   € Ð4Ð4Ð4 A�A�a”D�5˜!˜Aœ$�-Ð4Ð4Ð4r   r   rÜ  r[   r   r8   r³  rt  r|   rs  )r    r!   Úzipr   r?  rj  r   r½  r  r  r:   rº   rä   ru  r<   )r5   Ú
as_to_testÚ
bs_to_testr1  r2  ro  rw  ÚRsÚdRsÚdRrx  s              r   Útest_align_vectors_antiparallelr‡  î  s  € à€DÝ”˜I˜I˜I y y yÐ1Ø%˜I˜I y y yÐ1Ø%˜I˜I y y yÐ1ð3ñ 4ô 4€Jð 5Ð4¨Ð4Ñ4Ô4€JÝ�J 
Ñ+Ô+ð 8ð 8‰ˆˆ1ÝÔ% a¨µR´V¸Q°KÐ@Ñ@Ô@‰ˆˆ1Ý˜Ÿš™œ¥r¤u°4Ð8Ñ8Ô8Ð8Ý˜Ÿš  !¤™œ q¨¤t°$Ð7Ñ7Ô7Ð7Ð7õ 
Œ˜ !Ð	$Ñ	$Ô	$€BÝ
Ô
˜rŸ|š|™~œ~¨dÑ2Ñ
3Ô
3€CØ	ˆˆ�Y�Y�YÐ€AØ	ˆˆ�Y�Y�YÐ€AØ€JØð 2ð 2ˆØ×Ò˜2Ÿ8š8 A a¤D™>œ>¨1¨Q¬4Ð0Ñ1Ô1Ð1Ð1Øð Bð BˆÝÔ% a¨µR´V¸Q°KÐ@Ñ@Ô@‰ˆˆ1ÝÔ& q¨!°d¸A°YÐ?Ñ?Ô?‰ˆˆAÝ˜Ÿš™œ r§|¢|¡~¤~¸DÐAÑAÔAÐAÐAðBð Br   c                  ó¢  — d} t          j        dd¬¦  «                             ¦   «         }t          j        dd¬¦  «                             ¦   «         }t          ||¦  «        D ]k\  }}|d         }|d         }t          j        ||¦  «        \  }}t          |                     |¦  «        || ¬¦  «         t          j        |d| ¬¦  «        sJ ‚Œld S )Nrt  r8   r   r³  r   r[   )	r   r:   r<   r�  r?  r   r  r    rO  )	r5   Úmats_aÚmats_bÚmat_aÚmat_br1  r2  ro  r@  s	            r   Útest_align_vectors_primary_onlyr�    s×   € Ø€DÝŒ_˜S aÐ(Ñ(Ô(×2Ò2Ñ4Ô4€FÝŒ_˜S aÐ(Ñ(Ô(×2Ò2Ñ4Ô4€FÝ˜F FÑ+Ô+ð .ð .‰ˆˆuà�!ŒHˆØ�!ŒHˆõ Ô(¨¨AÑ.Ô.‰ˆˆ4Ý˜Ÿš ™
œ
 A¨DÐ1Ñ1Ô1Ð1ÝŒz˜$ ¨Ð-Ñ-Ô-Ð-Ð-Ð-Ð-ð.ð .r   c                  óÞ  — t           j                             d¦  «        } t          j        |                      d¬¦  «        ¦  «        }|                     ¦   «         }g d¢}t          ||¦  «        }g d¢} ||¦  «        }|                     ¦   «         }||d d …df         dk     xx         dz  cc<   ||d d …df         dk     xx         dz  cc<   t          |d         |d         ¦  «         t          |d         |d         ¦  «         t          |d	         |d
         ¦  «         t          |d         |d         ¦  «         t          |d         |d         ¦  «         t          j	        |d         |d
         z  ¦  «        }t          j	        |d
         |d         z  ¦  «        }	t          ||	¦  «         t          j	        |d         |d         z  ¦  «        }
t          j	        |d         |d	         z  ¦  «        }t          |
|¦  «         t          j	        |d         |d         z  ¦  «        }t          |d
|d
z  z  dz
  ¦  «         t          t          |¦  «        t          |¦  «        ¦  «         d S )Nr   r;  rC  )r   r   rU   r   r   )r   rˆ   rW  r   rK  rU   g      @r   g      
@gÍÌÌÌÌÌ@r   rR   r   r   r   rU   re   r7   r   )r    r:   r;   r   r"   ry  r#   r   r   r_  r   r¢   )r¥   Úkey_rotsÚ	key_quatsÚ	key_timesÚinterpolatorÚtimesÚinterp_rotsÚinterp_quatsÚ
cos_theta1Ú
cos_theta2Ú
cos_theta4Ú
cos_theta5Ú
cos_theta3s                r   Ú
test_slerpr›    sV  € Ý
Œ)×
Ò
 Ñ
"Ô
"€CåÔ! #§+¢+°6 +Ñ":Ô":Ñ;Ô;€HØ× Ò Ñ"Ô"€Ià��€IÝ˜ HÑ-Ô-€Là=Ð=Ð=€EØ�,˜uÑ%Ô%€KØ×&Ò&Ñ(Ô(€Lð �˜a˜a˜a ˜eÔ$ qÒ(Ð)Ð)Ô)¨RÑ/Ð)Ð)Ñ)àˆi˜˜˜˜2˜Ô Ò"Ð#Ð#Ô# rÑ)Ð#Ð#Ñ#õ �L ”O Y¨q¤\Ñ2Ô2Ð2Ý�L ”O Y¨q¤\Ñ2Ô2Ð2Ý�L ”O Y¨q¤\Ñ2Ô2Ð2Ý�L ”O Y¨q¤\Ñ2Ô2Ð2Ý�L Ô$ i°¤lÑ3Ô3Ð3õ ”˜ Qœ¨,°q¬/Ñ9Ñ:Ô:€JÝ”˜ Qœ¨,°q¬/Ñ9Ñ:Ô:€JÝ�J 
Ñ+Ô+Ð+å”˜ Qœ¨,°q¬/Ñ9Ñ:Ô:€JÝ”˜ Qœ¨,°q¬/Ñ9Ñ:Ô:€JÝ�J 
Ñ+Ô+Ð+õ ”˜ Qœ¨,°q¬/Ñ9Ñ:Ô:€JÝ�J  Z°¡]Ñ 3°aÑ 7Ñ8Ô8Ð8õ •�[Ñ!Ô!¥3 u¡:¤:Ñ.Ô.Ð.Ð.Ð.r   c                  óî   — t          j        t          d¬¦  «        5  t          j        g d¢g d¢g¦  «        } t          j        ddg¦  «        }t          || ¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )Nzmust be a `Rotation` instancera   rg   rQ   r   r   )rh   ri   r+  r    r!   r   )r%   rÙ  s     r   Útest_slerp_rot_is_rotationr�  C  s¿   € Ý	Œ•yÐ(GÐ	HÑ	HÔ	Hð ð ÝŒH�i�i�iØ�i�ið!ñ "ô "ˆåŒH�a˜�VÑÔˆÝˆa�‰Œˆð	ð ð ñ ô ð ð ð ð ð ð ð øøøð ð ð ð ð ð s   œAA*Á*A.Á1A.z*must be a sequence of at least 2 rotationsc                  óÆ   — t          j        g d¢¦  «        } t          j        t          t
          ¬¦  «        5  t          dg| ¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )Nrg   ra   r   )r   r"   rh   ri   rj   ÚSLERP_EXCEPTION_MESSAGEr   rä  s    r   Útest_slerp_single_rotr   L  sŸ   € ÝÔ˜<˜<˜<Ñ(Ô(€AÝ	Œ•zÕ)@Ð	AÑ	AÔ	Að ð Ýˆqˆc�1‰Œˆðð ð ñ ô ð ð ð ð ð ð ð øøøð ð ð ð ð ð s   ·AÁAÁAc                  ó¾   — t          j        ¦   «         } t          j        t          t
          ¬¦  «        5  t          g | ¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )Nra   ©r   r:   rh   ri   rj   rŸ  r   rä  s    r   Útest_slerp_rot_len0r£  R  s–   € ÝŒÑÔ€AÝ	Œ•zÕ)@Ð	AÑ	AÔ	Að ð Ýˆb�!‰Œˆðð ð ñ ô ð ð ð ð ð ð ð øøøð ð ð ð ð ð s   ´AÁAÁAc                  óÂ   — t          j        d¦  «        } t          j        t          t
          ¬¦  «        5  t          dg| ¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )Nr   ra   r¢  rä  s    r   Útest_slerp_rot_len1r¥  X  sš   € ÝŒ˜ÑÔ€AÝ	Œ•zÕ)@Ð	AÑ	AÔ	Að ð Ýˆqˆc�1‰Œˆðð ð ñ ô ð ð ð ð ð ð ð øøøð ð ð ð ð ð s   µAÁAÁAc                  óL  — t          j        t          d¬¦  «        5  t          j                             d¦  «        } t          j        |                      d¬¦  «        ¦  «        }t          j	        dgdgg¦  «        }t          ||¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )Nz.times to be specified in a 1 dimensional arrayra   r   )rU   r   rC  r   rU   )rh   ri   rj   r    r:   r;   r   r"   ry  r!   r   ©r¥   r%   rÙ  s      r   Útest_slerp_time_dim_mismatchr¨  ^  sä   € Ý	Œ•zØMð
Oñ 
Oô 
Oð ð åŒi×#Ò# AÑ&Ô&ˆÝÔ˜sŸ{š{°˜{Ñ7Ô7Ñ8Ô8ˆÝŒH�q�cØ�cðñ ô ˆåˆa�‰Œˆðð ð ñ ô ð ð ð ð ð ð ð øøøð ð ð ð ð ð s   œA0BÂBÂ Bc                  óD  — t          j        t          d¬¦  «        5  t          j                             d¦  «        } t          j        |                      d¬¦  «        ¦  «        }t          j	        d¦  «        }t          ||¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )Nz7number of rotations to be equal to number of timestampsra   r   r;  rC  re   )rh   ri   rj   r    r:   r;   r   r"   ry  Úaranger   r§  s      r   Ú!test_slerp_num_rotations_mismatchr«  h  sÕ   € Ý	Œ•zð *@ð 
Añ 
Aô 
Að ð åŒi×#Ò# AÑ&Ô&ˆÝÔ˜sŸ{š{°˜{Ñ7Ô7Ñ8Ô8ˆÝŒI�a‰LŒLˆÝˆa�‰Œˆðð ð ñ ô ð ð ð ð ð ð ð øøøð ð ð ð ð ð s   œA,BÂBÂBc                  ó$  — t          j        t          d¬¦  «        5  t          j                             d¦  «        } t          j        |                      d¬¦  «        ¦  «        }g d¢}t          ||¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )Nústrictly increasing orderra   r   r;  rC  )r   r   rU   rU   r   ©
rh   ri   rj   r    r:   r;   r   r"   ry  r   r§  s      r   Útest_slerp_equal_timesr¯  q  óÅ   € Ý	Œ•zÐ)DÐ	EÑ	EÔ	Eð ð ÝŒi×#Ò# AÑ&Ô&ˆÝÔ˜sŸ{š{°˜{Ñ7Ô7Ñ8Ô8ˆØˆOˆOˆÝˆa�‰Œˆð	ð ð ñ ô ð ð ð ð ð ð ð øøøð ð ð ð ð ð ó   œABÂB	ÂB	c                  ó$  — t          j        t          d¬¦  «        5  t          j                             d¦  «        } t          j        |                      d¬¦  «        ¦  «        }g d¢}t          ||¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )Nr­  ra   r   r;  rC  )r   r   r   rU   r   r®  r§  s      r   Útest_slerp_decreasing_timesr³  y  r°  r±  c                  óŠ  — t           j                             d¦  «        } t          j        |                      d¬¦  «        ¦  «        }t          j        d¦  «        }t          ||¦  «        }t          j	        t          d¬¦  «        5  t          j        dgdgg¦  «        } ||¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )	Nr   r;  rC  r   z&`times` must be at most 1-dimensional.ra   g      @gÍÌÌÌÌÌ@)r    r:   r;   r   r"   ry  rª  r   rh   ri   rj   r!   )r¥   r%   rÙ  ÚsÚinterp_timess        r   Ú!test_slerp_call_time_dim_mismatchr·  �  sþ   € Ý
Œ)×
Ò
 Ñ
"Ô
"€CÝÔ˜3Ÿ;š;¨F˜;Ñ3Ô3Ñ4Ô4€AÝ
Œ	�!‰Œ€AÝˆa�‰Œ€Aå	Œ•zØEð
Gñ 
Gô 
Gð ð å”x # Ø"% ð!(ñ )ô )ˆà	ˆˆ,‰Œˆð	ð ð ñ ô ð ð ð ð ð ð ð øøøð ð ð ð ð ð s   Â$B8Â8B<Â?B<c                  óä  — t           j                             d¦  «        } t          j        |                      d¬¦  «        ¦  «        }t          j        d¦  «        dz   }t          ||¦  «        }t          j	        t          d¬¦  «        5   |g d¢¦  «         d d d ¦  «         n# 1 swxY w Y   t          j	        t          d¬¦  «        5   |g d	¢¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )
Nr   r;  rC  r   r   ztimes must be within the rangera   rm  )r   rU   rd   )r    r:   r;   r   r"   ry  rª  r   rh   ri   rj   )r¥   r%   rÙ  rµ  s       r   Ú!test_slerp_call_time_out_of_ranger¹  Ž  s[  € Ý
Œ)×
Ò
 Ñ
"Ô
"€CÝÔ˜3Ÿ;š;¨F˜;Ñ3Ô3Ñ4Ô4€AÝ
Œ	�!‰Œ�qÑ€AÝˆa�‰Œ€Aå	Œ•zÐ)IÐ	JÑ	JÔ	Jð ð Ø	ˆˆ)ˆ)ˆ)‰Œˆðð ð ñ ô ð ð ð ð ð ð øøøð ð ð ð å	Œ•zÐ)IÐ	JÑ	JÔ	Jð ð Ø	ˆˆ)ˆ)ˆ)‰Œˆðð ð ñ ô ð ð ð ð ð ð ð øøøð ð ð ð ð ð s$   Â
B$Â$B(Â+B(Ã
C%Ã%C)Ã,C)c                  ó  — t          j        dddgd¬¦  «        } t          ddg| ¦  «        } |d¦  «        }t          j        ddd¬¦  «        }||                     ¦   «         z  }t	          |                     ¦   «         dd	¬
¦  «         d S )NÚXr   éP   TrÍ   r   rW  rŽ  r2   r[   )r   rL   r   r]   r   r½  )r%   rµ  Úr_interpolatedÚr_interpolated_expectedÚdeltas        r   Útest_slerp_call_scalar_timerÀ  š  s‘   € ÝÔ˜C ! R °$Ð7Ñ7Ô7€AÝˆq�!ˆf�aÑÔ€Aà�Q�t‘W”W€NÝ&Ô1°#°rÀ4ÐHÑHÔHÐàÐ4×8Ò8Ñ:Ô:Ñ:€Eå�E—O’OÑ%Ô% q¨uÐ5Ñ5Ô5Ð5Ð5Ð5r   c                  óú   — t          j        dd¬¦  «        } t          j        dd¬¦  «        }| D ]K}|||z  z  }t          t          j                             |                     ¦   «         d¬¦  «        d¦  «         ŒLd S )Né2   r   r³  rr  r   r   )r   r:   r   r    r@   rA   r#   )ÚqsÚrsrE   s      r   Útest_multiplication_stabilityrÅ  ¦  s�   € Ý	Œ˜ Ð	#Ñ	#Ô	#€BÝ	Œ˜ 1Ð	%Ñ	%Ô	%€BØð Að AˆØ
ˆa�"‰f‰ˆÝ�œ	Ÿš r§z¢z¡|¤|¸!˜Ñ<Ô<¸aÑ@Ô@Ð@Ð@ðAð Ar   c                  ó0  — d} t          j        dd¬¦  «        }|                     ¦   «         }dD �] }||z  }t          j        d¦  «        }t	          t          |¦  «        ¦  «        D ]}|dk    r||z  }Œ||z  }Œ||                     ¦   «         z                       ¦   «         }t          j        || k     ¦  «        sJ ‚t          j	        g d¢¦  «        }||z   
                    ¦   «         j        dk    sJ ‚t          j	        g d¢g¦  «        }||z   
                    ¦   «         j        dk    sJ ‚�Œd	D ]f}||z  }t          j        ||                     ¦   «         z  ¦  «        }t          | 
                    ¦   «         | 
                    ¦   «         | ¬
¦  «         Œgt          j        g d¢¦  «        }d}||z  }t          j        ||                     ¦   «         z  ¦  «        }t          | 
                    ¦   «         | 
                    ¦   «         | ¬
¦  «         d S )Nrv  r7   r   r³  )r  rƒ   rR   r   r   rU   r   rQ   r:  r�   )ç      ø¿r±   g       €r¯   rˆ   rK  r[   )rt  r   r   r   )r   r:   r]   r¼  r¡   rX   r½  r    rj  r"   r#   rw   rº   rä   r   )r5   r«  Úp_invr  rE   r%   rw  Úangs           r   Útest_powrÊ  ®  sÿ  € Ø€DÝŒ˜ Ð"Ñ"Ô"€AØ�EŠE‰GŒG€Eà%ð 0ñ 0ˆà�‰FˆÝÔ˜bÑ!Ô!ˆÝ•s˜1‘v”v‘”ð 	ð 	ˆAØ�1ŠuˆuØ˜‘E��à˜‘I��Ø�1—5’5‘7”7‰{×%Ò%Ñ'Ô'ˆÝŒv�c˜D’jÑ!Ô!Ð!Ð!Ð!õ Ô˜|˜|˜|Ñ,Ô,ˆØ�1‘�~Š~ÑÔÔ%¨Ò-Ð-Ð-Ð-ÝÔ   ˜~Ñ.Ô.ˆØ�1‘�~Š~ÑÔÔ%¨Ò/Ð/Ð/Ð/Ñ/ð /ð =ð =ˆØ�‰FˆÝÔ   Q§[¢[¡]¤]Ñ!2Ñ3Ô3ˆÝ˜Ÿ	š	™œ Q§Y¢Y¡[¤[°tÐ<Ñ<Ô<Ð<Ð<õ 	Ô˜]˜]˜]Ñ+Ô+€AØ	€AØ	ˆQ‰€AÝÔ˜Q §¢¡¤Ñ.Ñ/Ô/€AÝ�A—I’I‘K”K §¢¡¤°4Ð8Ñ8Ô8Ð8Ð8Ð8r   c                  óº   — t          j        d¬¦  «        } t          j        t          d¬¦  «        5  t          | dd¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )Nr   r³  zmodulus not supportedra   r   )r   r:   rh   ri   ÚNotImplementedErrorÚpow)r«  s    r   Útest_pow_errorsrÎ  Ó  sž   € ÝŒ˜AÐÑÔ€AÝ	ŒÕ*Ð2IÐ	JÑ	JÔ	Jð ð ÝˆAˆq�!‰Œˆðð ð ñ ô ð ð ð ð ð ð ð øøøð ð ð ð ð ð s   ±AÁAÁAc                  óè  — t          j        d¬¦  «        } t          j        dd¬¦  «        }t          j        | ¦  «        }t	          |j        d¦  «         t          j        |¦  «        }t	          |j        d¦  «         t          |d                              ¦   «         |d                              ¦   «         ¦  «         t          |d                              ¦   «         |d                              ¦   «         ¦  «         t          j        | g¦  «        }t	          |j        d¦  «         t	          |d         | ¦  «         t          j        |g¦  «        }t	          |j        d¦  «         t          |d	                              ¦   «         |d                              ¦   «         ¦  «         t          |d
                              ¦   «         |d                              ¦   «         ¦  «         t          j        | |gt          ¬¦  «        }t	          |j        d¦  «         t	          |d         | ¦  «         t	          |d         |¦  «         t          j        |||g¦  «        }t	          |j        d¦  «         d S )Nr   r³  rU   r   r   )rU   )r   )r   rU   rµ   r~  )Údtype)r   rU   )	r   r:   r    r!   r   rw   r   r<   Úobject)ÚsingleÚmultipler!   s      r   Ú test_rotation_within_numpy_arrayrÔ  Ù  s  € ÝŒ_ Ð#Ñ#Ô#€FÝŒ˜q aÐ(Ñ(Ô(€HåŒH�VÑÔ€EÝ�”˜bÑ!Ô!Ð!åŒH�XÑÔ€EÝ�”˜dÑ#Ô#Ð#Ý�E˜!”H×&Ò&Ñ(Ô(¨(°1¬+×*?Ò*?Ñ*AÔ*AÑBÔBÐBÝ�E˜!”H×&Ò&Ñ(Ô(¨(°1¬+×*?Ò*?Ñ*AÔ*AÑBÔBÐBåŒH�f�XÑÔ€EÝ�”˜dÑ#Ô#Ð#Ý��q”˜6Ñ"Ô"Ð"åŒH�h�ZÑ Ô €EÝ�”˜fÑ%Ô%Ð%Ý�E˜$”K×)Ò)Ñ+Ô+¨X°a¬[×-BÒ-BÑ-DÔ-DÑEÔEÐEÝ�E˜$”K×)Ò)Ñ+Ô+¨X°a¬[×-BÒ-BÑ-DÔ-DÑEÔEÐEåŒH�f˜hÐ'­vÐ6Ñ6Ô6€EÝ�”˜dÑ#Ô#Ð#Ý��q”˜6Ñ"Ô"Ð"Ý��q”˜8Ñ$Ô$Ð$åŒH�h ¨(Ð3Ñ4Ô4€EÝ�”˜fÑ%Ô%Ð%Ð%Ð%r   c            	      ón  — t          j        ddt          j        t          j        dz  ¦  «        t          j        t          j        dz  ¦  «        g¦  «        } t          j        | ¦  «        }t          j        |¦  «        }t          |  
                    ¦   «         | 
                    ¦   «         d¬¦  «         d S ©Nr   r   r1   r[   )r   r"   r    Úsinr  rå   ÚpickleÚdumpsÚloadsr   r<   )r%   ÚpklÚ	unpickleds      r   Útest_picklingrÝ  ÷  s‚   € ÝÔ˜A˜q¥"¤&­¬¨q©¡/¤/µ2´6½"¼%À¹'±?´?ÐCÑDÔD€AÝ
Œ,�q‰/Œ/€CÝ”˜SÑ!Ô!€IÝ�A—K’K‘M”M 9×#6Ò#6Ñ#8Ô#8¸uÐEÑEÔEÐEÐEÐEr   c            	      óF  — t          j        ddt          j        t          j        dz  ¦  «        t          j        t          j        dz  ¦  «        g¦  «        } t          j        | ¦  «        }t          |  	                    ¦   «         | 	                    ¦   «         d¬¦  «         d S rÖ  )
r   r"   r    r×  r  rå   r>  Údeepcopyr   r<   )r%   r  s     r   Útest_deepcopyrà  þ  sq   € ÝÔ˜A˜q¥"¤&­¬¨q©¡/¤/µ2´6½"¼%À¹'±?´?ÐCÑDÔD€AÝ	Œ�qÑ	Ô	€BÝ�A—K’K‘M”M 2§<¢<¡>¤>¸Ð>Ñ>Ô>Ð>Ð>Ð>r   c                  óJ  — t          j        g d¢¦  «        } |                      d¦  «        }|                      d¦  «        }|j        d         du sJ ‚|j        d         du sJ ‚t	          d„ |j        D ¦   «         ¦  «        sJ ‚t	          d„ |j        D ¦   «         ¦  «        sJ ‚d S )NrQ   rI   ÚXYZÚC_CONTIGUOUSTc              3   ó"   K  — | ]
}|d k    V — ŒdS ©r   Nr   ©r  r§   s     r   ú	<genexpr>z+test_as_euler_contiguous.<locals>.<genexpr>
  ó&   è è € Ð*Ð*˜!ˆq�AŠvÐ*Ð*Ð*Ð*Ð*Ð*r   c              3   ó"   K  — | ]
}|d k    V — ŒdS rå  r   ræ  s     r   rç  z+test_as_euler_contiguous.<locals>.<genexpr>  rè  r   )r   r"   r|  Úflagsrj  Ústrides)r%   Úe1Úe2s      r   Útest_as_euler_contiguousrî    s¸   € ÝÔ˜<˜<˜<Ñ(Ô(€AØ	
�Š�EÑ	Ô	€BØ	
�Š�EÑ	Ô	€BØŒ8�NÔ# tÐ+Ð+Ð+Ð+ØŒ8�NÔ# tÐ+Ð+Ð+Ð+ÝÐ*Ð*˜rœzÐ*Ñ*Ô*Ñ*Ô*Ð*Ð*Ð*ÝÐ*Ð*˜rœzÐ*Ñ*Ô*Ñ*Ô*Ð*Ð*Ð*Ð*Ð*r   c                  ó¾  ‡— t          j        dd¬¦  «        Šg d¢} dgt          t          j        | ¦  «        ¦  «        z   }ˆfd„t          || ¦  «        D ¦   «         }t          j        |¦  «        }t          ‰                     ¦   «         |                     ¦   «         ¦  «         t          j        ‰¦  «        }t          ‰                     ¦   «         |                     ¦   «         ¦  «         ‰|usJ ‚t          j        t          j	        ¦   «         ¦  «        }t          t          j	        ¦   «                              ¦   «         |                     ¦   «         ¦  «         d S )Nr7   r   r³  )r   rU   r   r   r   c                 ó0   •— g | ]\  }}‰|||z   …         ‘ŒS r   r   )r  r§   r  r�  s      €r   r€  z$test_concatenate.<locals>.<listcomp>  s*   ø€ Ð>Ð>Ð>¡4 1 aˆX�a˜˜A™�gÔÐ>Ð>Ð>r   )
r   r:   Úlistr    Úcumsumr�  rÕ  r   r#   r¼  )ÚsizesÚstartsÚsplitr½   r�  s       @r   Útest_concatenaterö    s2  ø€ ÝŒ˜r qÐ)Ñ)Ô)€HØˆOˆO€EØˆS•4�œ	 %Ñ(Ô(Ñ)Ô)Ñ)€FØ>Ð>Ð>Ð>­3¨v°uÑ+=Ô+=Ð>Ñ>Ô>€EÝÔ! %Ñ(Ô(€FÝ�×!Ò!Ñ#Ô# V§^¢^Ñ%5Ô%5Ñ6Ô6Ð6õ Ô! (Ñ+Ô+€FÝ�×!Ò!Ñ#Ô# V§^¢^Ñ%5Ô%5Ñ6Ô6Ð6ð ˜6Ð!Ð!Ð!Ð!õ Ô!¥(Ô"3Ñ"5Ô"5Ñ6Ô6€FÝ•Ô"Ñ$Ô$×,Ò,Ñ.Ô.°·²Ñ0@Ô0@ÑAÔAÐAÐAÐAr   c                  ó¾   — t          j        t          d¬¦  «        5  t          j        t          j        ¦   «         dd g¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )NzRotation objects onlyra   r   )rh   ri   r+  r   rÕ  r¼  r   r   r   Útest_concatenate_wrong_typerø  "  s�   € Ý	Œ•yÐ(?Ð	@Ñ	@Ô	@ð =ð =ÝÔ�hÔ/Ñ1Ô1°1°dÐ;Ñ<Ô<Ð<ð=ð =ð =ñ =ô =ð =ð =ð =ð =ð =ð =ð =øøøð =ð =ð =ð =ð =ð =s   œ)AÁAÁAc                  óf  — t          g d¢g¦  «        } t          g d¢g d¢g¦  «        }t          g d¢¦  «        }t          | ¦  «        dk    sJ ‚t          |¦  «        dk    sJ ‚t          j        t          d¬¦  «        5  t          |¦  «         d d d ¦  «         n# 1 swxY w Y   | sJ ‚|sJ ‚|sJ ‚d S )NrQ   r   rU   zSingle rotation has no len().ra   )r   r¢   rh   ri   r+  )Úrotation_multi_oneÚrotation_multiÚrotation_singles      r   Útest_len_and_boolrý  (  s  € Ý! < < < .Ñ1Ô1ÐÝ˜|˜|˜|¨\¨\¨\Ð:Ñ;Ô;€NÝ˜|˜|˜|Ñ,Ô,€OåÐ!Ñ"Ô" aÒ'Ð'Ð'Ð'Ýˆ~ÑÔ !Ò#Ð#Ð#Ð#Ý	Œ•yÐ(GÐ	HÑ	HÔ	Hð ð ÝˆOÑÔÐðð ð ñ ô ð ð ð ð ð ð øøøð ð ð ð ð ÐÐÐØÐÐˆ>ØÐÐˆ?ÐÐs   Á>BÂBÂ!Bc                  óØ   — g d¢} t          j        | ddd¬¦  «                             ¦   «         }t          j        g d¢¦  «        t          j        d¦  «        z  }t          ||¦  «         d S )Nr   r'  r"  TrÍ   rs   rU   )r   Úfrom_davenportr#   r    r!   r\   r   )r   ro   r&   s      r   Ú#test_from_davenport_single_rotationr   8  sm   € Øˆ9ˆ9€DÝÔ" 4¨°bØ+/ð1ñ 1ô 1ß18²±´ð 	å”H˜\˜\˜\Ñ*Ô*­R¬W°Q©Z¬ZÑ7€MÝ�D˜-Ñ(Ô(Ð(Ð(Ð(r   c                  ó˜  — g d¢} g d¢}t          j        t          j        | ¦  «        t          j        z  dz  ¦  «        }t          j        | dt          j        dz  ¦  «        }t          |                     d¬¦  «        |                     d¬¦  «        ¦  «         t          j        t          j        | ¦  «        t          j        z  dz  g¦  «        }t          j        | gdt          j        dz  g¦  «        }t          |                     d¬¦  «        |                     d¬¦  «        ¦  «         t          j        t          j        | ¦  «        t          j        z  dz  t          j        |¦  «        t          j        z  dz  g¦  «        }|d         |d	         z  }t          j        || gdt          j        dz  t          j        dz  g¦  «        }t          |                     d¬¦  «        |                     d¬¦  «        ¦  «         t          j        t          j        | ¦  «        t          j        z  dz  t          j        | ¦  «        t          j        z  dz  g¦  «        }t          j        | gdt          j        dz  t          j        dz  g¦  «        }t          |                     d¬¦  «        |                     d¬¦  «        ¦  «         d S )
Nr   r   r   ÚeTrK   rd   r   r   )r   rº   r    r!   r  rÿ  r   r#   )ÚezÚeyrö   Úrot_davs       r   Ú#test_from_davenport_one_or_two_axesr  @  s^  € Ø	ˆˆ€BØ	ˆˆ€Bõ Ô
�rœx¨™|œ|­b¬eÑ3°AÑ5Ñ
6Ô
6€CÝÔ% b¨#­r¬u°Q©wÑ7Ô7€GÝ�C—K’K¨$�KÑ/Ô/Ø—O’O¨d�OÑ3Ô3ñ5ô 5ð 5õ Ô
¥¤¨¡¤­r¬uÑ 4°QÑ 6Ð7Ñ
8Ô
8€CÝÔ% r d¨Cµ"´%¸±'°Ñ;Ô;€GÝ�C—K’K¨$�KÑ/Ô/Ø—O’O¨d�OÑ3Ô3ñ5ô 5ð 5õ Ô
¥¤¨¡¤­r¬uÑ 4°QÑ 6Ý "¤¨¡¤­r¬uÑ 4°QÑ 6ð 8ñ 9ô 9€Cà
ˆaŒ&�3�q”6‰/€CÝÔ% r¨2 h°µb´e¸A±g½r¼uÀQ¹wÐ5GÑHÔH€GÝ�C—K’K¨$�KÑ/Ô/Ø—O’O¨d�OÑ3Ô3ñ5ô 5ð 5õ Ô
¥¤¨¡¤­r¬uÑ 4°QÑ 6Ý "¤¨¡¤­r¬uÑ 4°QÑ 6ð 8ñ 9ô 9€CåÔ% r d¨Cµ"´%¸±'½2¼5À¹7Ð1CÑDÔD€GÝ�C—K’K¨$�KÑ/Ô/Ø—O’O¨d�OÑ3Ô3ñ5ô 5ð 5ð 5ð 5r   c                  óˆ  — g d¢} g d¢}g d¢}t          j        t          d¬¦  «        5  t          j        | |gdddg¦  «         d d d ¦  «         n# 1 swxY w Y   t          j        t          d¬¦  «        5  t          j        | ||gdg d¢¦  «         d d d ¦  «         n# 1 swxY w Y   t          j        t          d	¬¦  «        5  t          j        | gd
dg¦  «         d d d ¦  «         n# 1 swxY w Y   t          j        t          d¬¦  «        5  t          j        | || gdg d¢¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )Nr   r   rL  zmust be orthogonalra   r  r   rÄ   zorder should berI   zExpected `angles`)r   r   rU   r   )rh   ri   rj   r   rÿ  )r  r  Úezys      r   Ú!test_from_davenport_invalid_inputr	  `  s`  € Ø	ˆˆ€BØ	ˆˆ€BØ
ˆ)ˆ)€CÝ	Œ•zÐ)=Ð	>Ñ	>Ô	>ð 8ð 8ÝÔ  S 	¨3°°A°Ñ7Ô7Ð7ð8ð 8ð 8ñ 8ô 8ð 8ð 8ð 8ð 8ð 8ð 8øøøð 8ð 8ð 8ð 8å	Œ•zÐ)=Ð	>Ñ	>Ô	>ð ?ð ?ÝÔ  R¨ ¨s°I°I°IÑ>Ô>Ð>ð?ð ?ð ?ñ ?ô ?ð ?ð ?ð ?ð ?ð ?ð ?øøøð ?ð ?ð ?ð ?å	Œ•zÐ):Ð	;Ñ	;Ô	;ð 2ð 2ÝÔ   e¨a¨SÑ1Ô1Ð1ð2ð 2ð 2ñ 2ô 2ð 2ð 2ð 2ð 2ð 2ð 2øøøð 2ð 2ð 2ð 2å	Œ•zÐ)<Ð	=Ñ	=Ô	=ð Að AÝÔ  R¨ ¨c°<°<°<Ñ@Ô@Ð@ðAð Að Añ Aô Að Að Að Að Að Að Að Aøøøð Að Að Að Að Að AsG   ¨AÁAÁAÁ5BÂB!Â$B!ÃC(Ã(C,Ã/C,ÄD7Ä7D;Ä>D;c                  óN  — t           j                             d¦  «        } d}t          j        |df¦  «        }|                      t           j         t           j        |f¬¦  «        |d d …df<   |                      dt           j        |f¬¦  «        }|                      t           j         t           j        |f¬¦  «        |d d …df<   |                      dt           j        d¬¦  «        }t          j        g d¢¦  «        }t          j        g d¢¦  «        }|D ]�}||t          j        ||z  ¦  «         	                    |¦  «        g}||z
  |d d …d	f<   d
D ]Q}	|	dk    r|n
|d d d…         }
t          j
        |
|	|¦  «        }|                     |
|	¦  «        }t          ||¦  «         ŒRŒ�d S )Nr   r8   r   r,  rU   )rŽ  r   r   r   r&  r(  rR   )r    r:   r;   rx  ry  r  r!   r   rº   r  rÿ  Úas_davenportr   )r¥   r  rH  Úangles_middleÚlambdasrì  rí  ÚlambÚax_lambÚorderÚaxrö   Ú
angles_davs                r   Útest_as_davenportr  n  s¤  € Ý
Œ)×
Ò
 Ñ
"Ô
"€CØ€AÝŒX�q˜!�fÑÔ€FØ—;’;¥B¤E 6µ´¸Q¸D�;ÑAÔA€Fˆ1ˆ1ˆ1ˆaˆ4�LØ—K’K A­B¬E¸¸�KÑ=Ô=€MØ—;’;¥B¤E 6µ´¸Q¸D�;ÑAÔA€Fˆ1ˆ1ˆ1ˆaˆ4�LØ�kŠk˜a¥b¤e°%ˆkÑ8Ô8€Gå	Œ�)�)�)Ñ	Ô	€BÝ	Œ�)�)�)Ñ	Ô	€Bàð 0ð 0ˆØ�r�8Ô/°°R±Ñ8Ô8×>Ò>¸rÑBÔBÐCˆØ$ tÑ+ˆˆqˆqˆq�!ˆt‰Ø/ð 	0ð 	0ˆEØ! [Ò0Ð0��°g¸d¸dÀ¸d´mˆBÝÔ)¨"¨e°VÑ<Ô<ˆCØ×)Ò)¨"¨eÑ4Ô4ˆJÝ˜J¨Ñ/Ô/Ð/Ð/ð		0ð0ð 0r   c                  ó  ‡— t           j                             d¦  «        Šd} t          j        | df¦  «        }‰                     t           j         t           j        | f¬¦  «        |d d …df<   ˆfd„t          | ¦  «        D ¦   «         }‰                     t           j         t           j        | f¬¦  «        |d d …df<   ‰                     dt           j        d¬¦  «        }t          j        g d¢¦  «        }t          j        g d	¢¦  «        }|D ]þ}||t          j	        ||z  ¦  «         
                    |¦  «        g}||z
  |d d …d
f<   dD ]À}|dk    r|n
|d d d…         }	t          j        |	||¦  «        }
t          j        t          d¬¦  «        5  |
                     |	|¦  «        }d d d ¦  «         n# 1 swxY w Y   |
                     ¦   «         }t          j        |	||¦  «                             ¦   «         }t#          ||¦  «         ŒÁŒÿd S )Nr   r   r   r,  c                 óR   •— g | ]#}‰                      d t          j        g¦  «        ‘Œ$S ©r   )Úchoicer    r  )r  r§   r¥   s     €r   r€  z0test_as_davenport_degenerate.<locals>.<listcomp>Ž  s+   ø€ Ð>Ð>Ð>°�S—Z’Z ¥B¤E 
Ñ+Ô+Ð>Ð>Ð>r   rU   )r   r   r   r   r&  r(  rR   r“  ra   )r    r:   r;   rx  ry  r  r¡   r!   r   rº   r  rÿ  rh   r•  r–  r  r<   r   )r  rH  r  r  rì  rí  r  r  r  r  rö   r  r˜  rš  r¥   s                 @r   Útest_as_davenport_degenerater  „  sK  ø€ õ Œ)×
Ò
 Ñ
"Ô
"€CØ	€AÝŒX�q˜!�fÑÔ€Fð —;’;¥B¤E 6µ´¸Q¸D�;ÑAÔA€Fˆ1ˆ1ˆ1ˆaˆ4�LØ>Ð>Ð>Ð>µU¸1±X´XÐ>Ñ>Ô>€MØ—;’;¥B¤E 6µ´¸Q¸D�;ÑAÔA€Fˆ1ˆ1ˆ1ˆaˆ4�LØ�kŠk˜a¥b¤e°$ˆkÑ7Ô7€Gå	Œ�)�)�)Ñ	Ô	€BÝ	Œ�)�)�)Ñ	Ô	€Bàð 
Cð 
CˆØ�r�8Ô/°°R±Ñ8Ô8×>Ò>¸rÑBÔBÐCˆØ$ tÑ+ˆˆqˆqˆq�!ˆt‰Ø/ð 	Cð 	CˆEØ! [Ò0Ð0��°g¸d¸dÀ¸d´mˆBÝÔ)¨"¨e°VÑ<Ô<ˆCÝ”�k°Ð?Ñ?Ô?ð 9ð 9Ø ×-Ò-¨b°%Ñ8Ô8�
ð9ð 9ð 9ñ 9ô 9ð 9ð 9ð 9ð 9ð 9ð 9øøøð 9ð 9ð 9ð 9àŸ=š=™?œ?ˆLÝ$Ô3°B¸¸zÑJÔJ×TÒTÑVÔVˆMÝ% l°MÑBÔBÐBÐBð	Cð
Cð 
Cs   ÆF4Æ4F8Æ;F8c                  óÜ  — t           j                             d¦  «        } d}t          j        |df¦  «        }|                      t           j         t           j        |f¬¦  «        |d d …df<   |                      dt           j        |f¬¦  «        |d d …df<   |                      t           j         t           j        |f¬¦  «        |d d …df<   dD ]É}t          d¦  «        D ]·}d	                     |d         |d         |d         g¦  «        }d
„ |D ¦   «         }|dk    r|                     ¦   «         }t          j
        ||¦  «        }t          j        |||¦  «        }t          |                     d¬¦  «        |                     d¬¦  «        d¬¦  «         Œ¸ŒÊ|d d …dfxx         t           j        dz  z  cc<   dD ]°}t          d¦  «        D ]ž}d	                     |¦  «        }d„ |D ¦   «         }|dk    r|                     ¦   «         }t          j
        ||¦  «        }t          j        |||¦  «        }t          |                     ¦   «         |                     ¦   «         d¬¦  «         ŒŸŒ±d S )Nr   r8   r   r,  r   rU   r&  rI   rs  c                 ó,   — g | ]}t          |¦  «        ‘ŒS r   ©r   ræ  s     r   r€  z:test_compare_from_davenport_from_euler.<locals>.<listcomp>®  ó   € Ð,Ð,Ð, 1•)˜A‘,”,Ð,Ð,Ð,r   r(  TrK   rt  r9   c                 ó,   — g | ]}t          |¦  «        ‘ŒS r   r  ræ  s     r   r€  z:test_compare_from_davenport_from_euler.<locals>.<listcomp>»  r  r   )r    r:   r;   rx  ry  r  r	   rz  r{  r   rL   rÿ  r   r#   )	r¥   r  rH  r  rb  r€  r  ÚeulÚdavs	            r   Ú&test_compare_from_davenport_from_eulerr   ¢  sy  € Ý
Œ)×
Ò
 Ñ
"Ô
"€CØ€AÝŒX�q˜!�fÑÔ€Fð —;’;¥B¤E 6µ´¸Q¸D�;ÑAÔA€Fˆ1ˆ1ˆ1ˆaˆ4�LØ—;’; 1­2¬5¸°t�;Ñ<Ô<€Fˆ1ˆ1ˆ1ˆaˆ4�LØ—;’;¥B¤E 6µ´¸Q¸D�;ÑAÔA€Fˆ1ˆ1ˆ1ˆaˆ4�LØ+ð 	(ð 	(ˆÝ% eÑ,Ô,ð 	(ð 	(ˆIØ—'’'˜9 Qœ<¨°1¬°yÀ´|ÐDÑEÔEˆCØ,Ð,¨Ð,Ñ,Ô,ˆBØ˜Ò#Ð#Ø—i’i‘k”k�ÝÔ% c¨6Ñ2Ô2ˆCÝÔ)¨"¨e°VÑ<Ô<ˆCÝ˜CŸKšK°$˜KÑ7Ô7¸¿ºÈt¸Ñ9TÔ9TØ!&ð(ñ (ô (ð (ð (ð	(ð ˆ1ˆ1ˆ1ˆaˆ4€L€L„L•B”E˜A‘IÑ€L€L�LØ+ð Fð FˆÝ% eÑ,Ô,ð 	Fð 	FˆIØ—'’'˜)Ñ$Ô$ˆCØ,Ð,¨Ð,Ñ,Ô,ˆBØ˜Ò#Ð#Ø—i’i‘k”k�ÝÔ% c¨6Ñ2Ô2ˆCÝÔ)¨"¨e°VÑ<Ô<ˆCÝ˜CŸKšK™MœM¨3¯;ª;©=¬=¸uÐEÑEÔEÐEÐEð	FðFð Fr   c                  ó˜  — t           j                             d¦  «        } d}t          j        |df¦  «        }|                      t           j         t           j        |f¬¦  «        |d d …df<   |                      dt           j        |f¬¦  «        |d d …df<   |                      t           j         t           j        |f¬¦  «        |d d …df<   dD ]¶}t          d¦  «        D ]¤}d	                     |d         |d         |d         g¦  «        }d
„ |D ¦   «         }|dk    r|                     ¦   «         }t          j
        ||¦  «        }|                     |¦  «        }|                     ||¦  «        }	t          ||	d¬¦  «         Œ¥Œ·|d d …dfxx         t           j        dz  z  cc<   dD ]¡}t          d¦  «        D ]�}d	                     |¦  «        }d„ |D ¦   «         }|dk    r|                     ¦   «         }t          j
        ||¦  «        }|                     |¦  «        }|                     ||¦  «        }	t          ||	d¬¦  «         Œ�Œ¢d S )Nr   r8   r   r,  r   rU   r&  rI   rs  c                 ó,   — g | ]}t          |¦  «        ‘ŒS r   r  ræ  s     r   r€  z6test_compare_as_davenport_as_euler.<locals>.<listcomp>Ï  r  r   r(  rt  r9   c                 ó,   — g | ]}t          |¦  «        ‘ŒS r   r  ræ  s     r   r€  z6test_compare_as_davenport_as_euler.<locals>.<listcomp>Ü  r  r   )r    r:   r;   rx  ry  r  r	   rz  r{  r   rL   r|  r  r   )
r¥   r  rH  r  rb  r€  r  rö   r  r  s
             r   Ú"test_compare_as_davenport_as_eulerr$  Ã  s_  € Ý
Œ)×
Ò
 Ñ
"Ô
"€CØ€AÝŒX�q˜!�fÑÔ€Fð —;’;¥B¤E 6µ´¸Q¸D�;ÑAÔA€Fˆ1ˆ1ˆ1ˆaˆ4�LØ—;’; 1­2¬5¸°t�;Ñ<Ô<€Fˆ1ˆ1ˆ1ˆaˆ4�LØ—;’;¥B¤E 6µ´¸Q¸D�;ÑAÔA€Fˆ1ˆ1ˆ1ˆaˆ4�LØ+ð 	2ð 	2ˆÝ% eÑ,Ô,ð 	2ð 	2ˆIØ—'’'˜9 Qœ<¨°1¬°yÀ´|ÐDÑEÔEˆCØ,Ð,¨Ð,Ñ,Ô,ˆBØ˜Ò#Ð#Ø—i’i‘k”k�ÝÔ% c¨6Ñ2Ô2ˆCØ—,’,˜sÑ#Ô#ˆCØ×"Ò" 2 uÑ-Ô-ˆCÝ˜C ¨5Ð1Ñ1Ô1Ð1Ð1ð	2ð ˆ1ˆ1ˆ1ˆaˆ4€L€L„L•B”E˜A‘IÑ€L€L�LØ+ð 	2ð 	2ˆÝ% eÑ,Ô,ð 	2ð 	2ˆIØ—'’'˜)Ñ$Ô$ˆCØ,Ð,¨Ð,Ñ,Ô,ˆBØ˜Ò#Ð#Ø—i’i‘k”k�ÝÔ% c¨6Ñ2Ô2ˆCØ—,’,˜sÑ#Ô#ˆCØ×"Ò" 2 uÑ-Ô-ˆCÝ˜C ¨5Ð1Ñ1Ô1Ð1Ð1ð	2ð	2ð 	2r   c                  óü  — t          j        d¬¦  «        } t          | ¦  «        dk    sJ ‚t          j        d¬¦  «        }t          |¦  «        dk    sJ ‚t          j        d¬¦  «        g          }t          |¦  «        dk    sJ ‚t          j        t          j        d¦  «        ¦  «        }t          |¦  «        dk    sJ ‚t          j        t          j        d¦  «        ¦  «        }t          |¦  «        dk    sJ ‚t          j        dt          j        d¦  «        ¦  «        }t          |¦  «        dk    sJ ‚t          j	        t          j        d¦  «        ¦  «        }t          |¦  «        dk    sJ ‚t          j
        t          j        d¦  «        dt          j        d¦  «        ¦  «        }t          |¦  «        dk    sJ ‚t          j        t          j        d¦  «        ¦  «        }t          |¦  «        dk    sJ ‚d S )	Nr   ©rª  r   ©r   r   ©r   r   r   rI   rÉ   r'  )r   r:   r¢   r¼  r"   r    rM   r‰   rL   rº   rÿ  r=   rþ   )	r%   Úr_ideÚr_getÚr_quatÚr_matrixÚr_eulerÚr_vecÚr_davÚr_mrps	            r   Útest_zero_rotation_constructionr1  å  s£  € ÝŒ˜AÐÑÔ€AÝˆq‰6Œ6�QŠ;ˆ;ˆ;ˆ;åÔ !Ð$Ñ$Ô$€EÝˆu‰:Œ:˜Š?ˆ?ˆ?ˆ?åŒO Ð"Ñ"Ô" 2Ô&€EÝˆu‰:Œ:˜Š?ˆ?ˆ?ˆ?åÔ¥¤¨Ñ 0Ô 0Ñ1Ô1€FÝˆv‰;Œ;˜!ÒÐÐÐåÔ#¥B¤H¨YÑ$7Ô$7Ñ8Ô8€HÝˆx‰=Œ=˜AÒÐÐÐåÔ! %­¬°&Ñ)9Ô)9Ñ:Ô:€GÝˆw‰<Œ<˜1ÒÐÐÐåÔ ¥¤¨&Ñ!1Ô!1Ñ2Ô2€EÝˆu‰:Œ:˜Š?ˆ?ˆ?ˆ?åÔ#¥B¤F¨1¡I¤I¨{½B¼HÀVÑ<LÔ<LÑMÔM€EÝˆu‰:Œ:˜Š?ˆ?ˆ?ˆ?åÔ�bœh vÑ.Ô.Ñ/Ô/€EÝˆu‰:Œ:˜Š?ˆ?ˆ?ˆ?ˆ?ˆ?r   c                  óÎ  — t          j        d¬¦  «        } |                      ¦   «         j        dk    sJ ‚|                      ¦   «         j        dk    sJ ‚|                      d¦  «        j        dk    sJ ‚|                      ¦   «         j        dk    sJ ‚|                      ¦   «         j        dk    sJ ‚|                      t          j
        d¦  «        d¦  «        j        dk    sJ ‚d S )	Nr   r&  r'  r(  rI   rÉ   r   r'  )r   r:   r#   rw   r<   r|  rä   r  r  r    r=   rä  s    r   Ú!test_zero_rotation_representationr3    sÔ   € ÝŒ˜AÐÑÔ€AØ�9Š9‰;Œ;Ô Ò&Ð&Ð&Ð&Ø�;Š;‰=Œ=Ô )Ò+Ð+Ð+Ð+Ø�:Š:�eÑÔÔ" fÒ,Ð,Ð,Ð,Ø�;Š;‰=Œ=Ô &Ò(Ð(Ð(Ð(Ø�8Š8‰:Œ:Ô˜vÒ%Ð%Ð%Ð%Ø�>Š>�"œ& ™)œ) [Ñ1Ô1Ô7¸6ÒAÐAÐAÐAÐAÐAr   c                  óÆ  — t          j        d¬¦  «        } t          j        g d¢¦  «        }|                      |¦  «        }|j        dk    sJ ‚t          j        d¦  «        }|                      |¦  «        }|j        dk    sJ ‚t          j        d¦  «        }t          j	        t          d¬¦  «        5  |                      |¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )Nr   r&  rc   rÉ   )rU   r   z/Expected equal numbers of rotations and vectorsra   )r   r:   r    r!   r  rw   rM   rã  rh   ri   rj   )r%   r  r  Úv0Úv0_rotr"  s         r   Ú!test_zero_rotation_array_rotationr7    s  € ÝŒ˜AÐÑÔ€Aå
Œ���ÑÔ€AØ—’˜‘
”
€IØŒ?˜fÒ$Ð$Ð$Ð$å	Œ�&Ñ	Ô	€BØ�WŠW�R‰[Œ[€FØŒ<˜6Ò!Ð!Ð!Ð!å	Œ�‰Œ€BÝ	ŒÝÐKð
Mñ 
Mô 
Mð ð à	�Š�‰Œˆðð ð ñ ô ð ð ð ð ð ð ð øøøð ð ð ð ð ð s   Â3CÃCÃCc                  ó(  — t          j        d¬¦  «        } t          j        ¦   «         }| |z  }t          |¦  «        dk    sJ ‚|| z  }t          |¦  «        dk    sJ ‚t          j        d¦  «        }| |z  }t          |¦  «        dk    sJ ‚d}t          j        d¦  «        }t          j        t
          |¬¦  «        5  ||z   d d d ¦  «         n# 1 swxY w Y   t          j        t
          |¬¦  «        5  ||z   d d d ¦  «         d S # 1 swxY w Y   d S )Nr   r&  ú"Expected equal number of rotationsrU   ra   )r   r:   r¢   rh   ri   rj   )r%   Úr_singleÚr_mult_leftÚr_mult_rightÚr0Úr_multÚmsg_rotation_errorr  s           r   Ú!test_zero_rotation_multiplicationr@    s¢  € ÝŒ˜AÐÑÔ€AåŒÑ Ô €HØ�h‘,€KÝˆ{ÑÔ˜qÒ Ð Ð Ð à˜a‘<€LÝˆ|ÑÔ Ò!Ð!Ð!Ð!å	Œ˜Ñ	Ô	€BØ�‰V€FÝˆv‰;Œ;˜!ÒÐÐÐà=ÐÝ	Œ˜Ñ	Ô	€BÝ	Œ•zÐ);Ð	<Ñ	<Ô	<ð ð Ø
ˆR‰ˆðð ð ñ ô ð ð ð ð ð ð øøøð ð ð ð õ 
Œ•zÐ);Ð	<Ñ	<Ô	<ð ð Ø
ˆR‰ˆðð ð ñ ô ð ð ð ð ð ð ð øøøð ð ð ð ð ð s$   Â<CÃCÃCÃ4DÄDÄDc                  óø  — t          j        d¬¦  «        } t          j        | | g¦  «        }t          |¦  «        dk    sJ ‚|                      t          j        ¦   «         | g¦  «        }t          |¦  «        dk    sJ ‚|                      t          j        d¦  «        | g¦  «        }t          |¦  «        dk    sJ ‚|                      | t          j        d¦  «        g¦  «        }t          |¦  «        dk    sJ ‚d S )Nr   r&  r   r   r   )r   r:   rÕ  r¢   )r%   r=  r  r^   Úr4s        r   Ú!test_zero_rotation_concatentationrC  4  sÖ   € ÝŒ˜AÐÑÔ€Aå	Ô	˜q !˜fÑ	%Ô	%€BÝˆr‰7Œ7�aŠ<ˆ<ˆ<ˆ<à	
�Š�œÑ)Ô)¨1Ð-Ñ	.Ô	.€BÝˆr‰7Œ7�aŠ<ˆ<ˆ<ˆ<à	
�Š�œ¨Ñ*Ô*¨AÐ.Ñ	/Ô	/€BÝˆr‰7Œ7�aŠ<ˆ<ˆ<ˆ<à	
�Š˜�8œ?¨1Ñ-Ô-Ð.Ñ	/Ô	/€BÝˆr‰7Œ7�aŠ<ˆ<ˆ<ˆ<ˆ<ˆ<r   c                  ón   — t          j        d¬¦  «        } dD ]}| |z  }t          |¦  «        dk    sJ ‚Œd S )Nr   r&  )rÇ  rR   r   r   rK  )r   r:   r¢   )r%   ÚppÚpow0s      r   Útest_zero_rotation_powerrG  D  sK   € ÝŒ˜AÐÑÔ€AØ#ð ð ˆØ�"‰uˆÝ�4‰yŒy˜AŠ~ˆ~ˆ~ˆ~ˆ~ðð r   c                  ó‚   — t          j        d¬¦  «        } |                      ¦   «         }t          |¦  «        dk    sJ ‚d S )Nr   r&  )r   r:   r]   r¢   )r%   Úr_invs     r   Útest_zero_rotation_inverserJ  K  s8   € ÝŒ˜AÐÑÔ€AØ�EŠE‰GŒG€EÝˆu‰:Œ:˜Š?ˆ?ˆ?ˆ?ˆ?ˆ?r   c                  ór   — t          j        d¬¦  «        } |                      ¦   «         }|j        dk    sJ ‚d S )Nr   r&  r  )r   r:   r½  rw   )r%   r½  s     r   Útest_zero_rotation_magnituderL  Q  s:   € ÝŒ˜AÐÑÔ€AØ—’‘”€IØŒ?˜dÒ"Ð"Ð"Ð"Ð"Ð"r   c                  óÀ   — t          j        d¬¦  «        } t          j        t          d¬¦  «        5  |                      ¦   «          d d d ¦  «         d S # 1 swxY w Y   d S )Nr   r&  z+Mean of an empty rotation set is undefined.ra   )r   r:   rh   ri   rj   rg  rä  s    r   Útest_zero_rotation_meanrN  W  s›   € ÝŒ˜AÐÑÔ€AÝ	Œ•zÐ)VÐ	WÑ	WÔ	Wð ð Ø	�Š‰Œˆðð ð ñ ô ð ð ð ð ð ð ð øøøð ð ð ð ð ð s   ±AÁAÁAc                  ó¤  — t          j        d¦  «        } |                      t          j        d¦  «        ¦  «        j        dk    sJ ‚|                      t          j        ¦   «         ¦  «        j        dk    sJ ‚t          j        ¦   «                              | ¦  «        j        dk    sJ ‚d}t          j        d¦  «        }t	          j        t          |¬¦  «        5  |                      |¦  «         d d d ¦  «         n# 1 swxY w Y   t	          j        t          |¬¦  «        5  |                     | ¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )Nr   r  r9  rU   ra   )r   r:   rÎ  rw   rh   ri   rj   )r%   Ú
approx_msgr^   s      r   Útest_zero_rotation_approx_equalrQ  ]  sª  € ÝŒ˜ÑÔ€AØ�>Š>�(œ/¨!Ñ,Ô,Ñ-Ô-Ô3°tÒ;Ð;Ð;Ð;Ø�>Š>�(œ/Ñ+Ô+Ñ,Ô,Ô2°dÒ:Ð:Ð:Ð:ÝŒ?ÑÔ×)Ò)¨!Ñ,Ô,Ô2°dÒ:Ð:Ð:Ð:à5€JÝ	Œ˜Ñ	Ô	€BÝ	Œ•z¨Ð	4Ñ	4Ô	4ð ð Ø	�Š�rÑÔÐðð ð ñ ô ð ð ð ð ð ð øøøð ð ð ð õ 
Œ•z¨Ð	4Ñ	4Ô	4ð ð Ø
�Š˜ÑÔÐðð ð ñ ô ð ð ð ð ð ð ð øøøð ð ð ð ð ð s$   ÃC<Ã<D ÄD Ä"EÅE	ÅE	c                  ó  — t          j        d¦  «        } | g          }t          |¦  «        dk    sJ ‚| d d…         }t          |¦  «        dk    sJ ‚t          j        t
          ¦  «        5  | dg          d d d ¦  «         n# 1 swxY w Y   t          j        t
          ¦  «        5  | dg          d d d ¦  «         n# 1 swxY w Y   t          j        t
          ¦  «        5  t          j        ¦   «         | d<   d d d ¦  «         d S # 1 swxY w Y   d S )Nr   T©r   r:   r¢   rh   ri   Ú
IndexError)r%   r*  Úr_slices      r   Útest_zero_rotation_get_setrV  l  sº  € ÝŒ˜ÑÔ€AàˆbŒE€EÝˆu‰:Œ:˜Š?ˆ?ˆ?ˆ?à���Œe€GÝˆw‰<Œ<˜1ÒÐÐÐå	Œ•zÑ	"Ô	"ð ð Ø	ˆ1ˆ#Œˆðð ð ñ ô ð ð ð ð ð ð øøøð ð ð ð õ 
Œ•zÑ	"Ô	"ð ð Ø	ˆ4ˆ&Œ	ˆ	ðð ð ñ ô ð ð ð ð ð ð øøøð ð ð ð õ 
Œ•zÑ	"Ô	"ð !ð !ÝŒÑ Ô ˆˆ!‰ð!ð !ð !ñ !ô !ð !ð !ð !ð !ð !ð !ð !øøøð !ð !ð !ð !ð !ð !s6   Á*
B Â BÂBÂ$
B:Â:B>ÃB>ÃDÄDÄ	Dc                  ó`  — t          j        d¦  «        } | g d¢         }t          |¦  «        dk    sJ ‚| g d¢         }t          |¦  «        dk    sJ ‚| g d¢         }t          |¦  «        dk    sJ ‚t          j        t
          ¦  «        5  | ddg          d d d ¦  «         d S # 1 swxY w Y   d S )Nr   )FFFr   )FTFr   )TTTTrS  )r%   r=  r  r^   s       r   Útest_boolean_indexesrX    sþ   € ÝŒ˜ÑÔ€Aà	
Ð Ð Ð Ô	!€BÝˆr‰7Œ7�aŠ<ˆ<ˆ<ˆ<à	
ÐÐÐÔ	 €BÝˆr‰7Œ7�aŠ<ˆ<ˆ<ˆ<à	
ÐÐÐÔ	€BÝˆr‰7Œ7�aŠ<ˆ<ˆ<ˆ<å	Œ•zÑ	"Ô	"ð ð Ø	ˆ4�ˆ,Œˆðð ð ñ ô ð ð ð ð ð ð ð øøøð ð ð ð ð ð s   ÂB#Â#B'Â*B')žrh   Únumpyr    Únumpy.testingr   r   r   Úscipy.spatial.transformr   r   Úscipy.statsr   Ú	itertoolsr	   rØ  r>  r   r'   r*   r,   rG   rN   rV   rY   r_   rk   rm   rq   ry   r€   r…   r‹   r�   r•   r›   r«   r³   r¶   r¾   rÀ   rÆ   rË   r×   rÛ   rß   rè   rò   rô   r÷   rú   r  r  r  r	  r  r  r  r  r  r   r#  r)  r3  r7  rI  rX  r^  ra  ÚmarkÚparametrizer„  rˆ  Úthread_unsafer›  r¢  r¨  r°  rº  r¾  rÀ  rÅ  rÇ  rÉ  rË  rÐ  rÓ  rÚ  rá  rå  rë  rò  r  r  r  r#  r%  r(  r,  r.  r2  r4  r6  r8  r<  rA  rG  rI  rT  r]  rh  rk  rq  ry  r{  r‡  r�  r›  r�  rŸ  r   r£  r¥  r¨  r«  r¯  r³  r·  r¹  rÀ  rÅ  rÊ  rÎ  rÔ  rÝ  rà  rî  rö  rø  rý  r   r  r	  r  r  r   r$  r1  r3  r7  r@  rC  rG  rJ  rL  rN  rQ  rV  rX  r   r   r   ú<module>ra     s¼
  ðØ €€€à Ð Ð Ð Ø AÐ AÐ AÐ AÐ AÐ AÐ AÐ AØ )Ð )Ð )Ð )Ð )Ð )Ø 3Ð 3Ð 3Ð 3Ð 3Ð 3Ð 3Ð 3Ø +Ð +Ð +Ð +Ð +Ð +Ø "Ð "Ð "Ð "Ð "Ð "à €€€Ø €€€ðð ð ð:ð :ð :ð:ð :ð :ð:ð :ð :ðDð Dð Dð(Oð Oð Oð<:ð :ð :ð
>ð 
>ð 
>ð/ð /ð /ð@ð ð ð(ð ð ð.ð .ð .ð	4ð 	4ð 	4ð1ð 1ð 1ð81ð 1ð 1ð>	ð 	ð 	ð	ð 	ð 	ð+ð +ð +ðJð Jð Jð
2ð 2ð 2ð(Pð Pð Pð("ð "ð "ð?ð ?ð ?ð?ð ?ð ?ðð ð ð 2ð 2ð 2ð2	"ð 	"ð 	"ð%ð %ð %ð
ð ð ðEð Eð Eð4ð 4ð 4ð4ð 4ð 4ð*ð *ð *ð	ð 	ð 	ð?ð ?ð ?ð?ð ?ð ?ð	Oð 	Oð 	Oð"ð "ð "ð
ð ð ðOð Oð Oðð ð ð.ð .ð .ð.ð .ð .ðJð Jð Jð)ð )ð )ð*ð *ð *ðð ð ð1ð 1ð 1ðð ð ð6ð ð ð6ð ð ð6ð ð ð6 „×Ò˜ l l°5Ñ&9Ô&9Ñ:Ô:Ø„×Ò˜ mÑ4Ô4ð2ð 2ñ 5Ô4ñ ;Ô:ð2ð> „×Ò˜ l l°5Ñ&9Ô&9Ñ:Ô:Ø„×Ò˜ mÑ4Ô4ð2ð 2ñ 5Ô4ñ ;Ô:ð2ð: „ÔØ„×Ò˜ l l°5Ñ&9Ô&9Ñ:Ô:Ø„×Ò˜ mÑ4Ô4ð;ð ;ñ 5Ô4ñ ;Ô:ñ Ôð;ð0 „ÔØ„×Ò˜ l l°5Ñ&9Ô&9Ñ:Ô:Ø„×Ò˜ mÑ4Ô4ð;ð ;ñ 5Ô4ñ ;Ô:ñ Ôð;ð2 „ÔØ„×Ò˜ l l°5Ñ&9Ô&9Ñ:Ô:Ø„×Ò˜ mÑ4Ô4ð>ð >ñ 5Ô4ñ ;Ô:ñ Ôð>ðB.ð .ð .ð&.ð .ð .ð<?ð ?ð ?ð6ð 6ð 6ð
?ð ?ð ?ð?ð ?ð ?ð@ð @ð @ð ð  ð  ð:ð :ð :ð „Ôð2ð 2ñ Ôð2ð=ð =ð =ð
Cð 
Cð 
Cð$ð $ð $ð(ð (ð (ð
ð ð ð5ð 5ð 5ð4Að Að Að8:ð :ð :ð*:ð :ð :ð89ð 9ð 9ð,Tð Tð Tð&ð ð ð
#ð #ð #ð2ð 2ð 2ð0ð 0ð 0ðð ð ð!ð !ð !ð$Fð Fð Fð(ð (ð (ð(ð (ð (ð	(ð 	(ð 	(ð
7ð 
7ð 
7ð ð  ð  ð$Oð $Oð $OðN)8ð )8ð )8ðX 6ð  6ð  6ðFBð Bð Bð84ð 4ð 4ð0Bð Bð Bð4.ð .ð .ð)/ð )/ð )/ðXð ð ð GÐ ðð ð ðð ð ðð ð ðð ð ðð ð ðð ð ðð ð ð
ð 
ð 
ð	ð 	ð 	ð	6ð 	6ð 	6ðAð Að Að"9ð "9ð "9ðJð ð ð&ð &ð &ð<Fð Fð Fð?ð ?ð ?ð+ð +ð +ðBð Bð Bð(=ð =ð =ðð ð ð )ð )ð )ð5ð 5ð 5ð@Að Að Að0ð 0ð 0ð, „ÔðCð Cñ ÔðCð:Fð Fð FðB2ð 2ð 2ðDð ð ð:Bð Bð Bðð ð ð"ð ð ð.ð ð ð ð ð ðð ð ð#ð #ð #ðð ð ðð ð ð!ð !ð !ð&ð ð ð ð r   