+
    ƒ°ñjC8  ã                   óÜ   € ^ RI HtHt ^ RIt^ RIHu Ht R R ltR R lt	R R lt
R	 R
 ltRR R lltR R ltR R ltR R ltR R ltR R ltR R ltR R ltR R ltR R ltR# ) é    )ÚDictÚTupleNc                óz   € V ^8„  d   QhR\         R\        \        P                  \        P                  3,          /# )é   ÚpaddingÚreturn)Úfloatr   ÚtorchÚTensor)Úformats   "Ú>C:\Ai_Coding\apps\studio\ComfyUI\comfy\ldm\sam3d_body\utils.pyÚ__annotate__r      s,   € ÷ ñ ¤ð ¬%´·±¼e¿l¹lÐ0JÕ*Kñ ó    c                óÔ  € \         P                  ! V \         P                  R7      p V P                  4       pV^8X  d   V P	                  ^ 4      p V R,          V R,          V R,          V R,          3w  r4rV\         P
                  ! W5,           WF,           .^R7      R,          p\         P
                  ! WS,
          Wd,
          .^R7      V,          pV^8X  d   V^ ,          V^ ,          3# Wx3# )z>xyxy bbox -> (center, scale) with optional padding multiplier.©Údtype©Údimç      à?©ºNNN:r   é   N©r   :r   r   N)r   :r   é   N)r   :r   é   N)r
   Ú	as_tensorÚfloat32r   Ú	unsqueezeÚcat)	Úbboxr   r   Úx1Úy1Úx2Úy2ÚcenterÚscales	   &&       r   Úbbox_xyxy2csr'      s¶   € ä�?Š?˜4¤u§}¡}Ô5€DØ
�(‰(‹*€CØ
ˆa„xØ�~‰~˜aÓ ˆØ˜&•\ 4¨¥<°°fµ¸tÀF½|ÐK�N€BˆBÜ�YŠY˜� ¥Ð)¨qÔ1°CÕ7€FÜ�IŠI�r•w ¥Ð(¨aÔ0°7Õ:€EØ
ˆa„xØ�a�y˜% �(Ð"Ð"Øˆ=Ðr   c                óD   € V ^8„  d   QhR\         R\        P                  /# )r   Úaspect_ratior   )r	   r
   r   )r   s   "r   r   r      s   € ÷ 'ñ '¬uð '¼¿¹ñ 'r   c           	     óž  € \         P                  ! V \         P                  R7      p V P                  4       pV^8X  d   V P	                  ^ 4      p V R,          V R,          rC\         P
                  ! W4V,          8„  \         P                  ! W3V,          .^R7      \         P                  ! WA,          V.^R7      4      pV^8X  d
   V^ ,          # T# )z=Pad whichever side is too narrow to hit `aspect_ratio` (w/h).r   r   r   r   )r
   r   r   r   r   Úwherer   )Ú
bbox_scaler)   r   ÚwÚhÚouts   &&    r   Úfix_aspect_ratior0      s¦   € ä—’ ´5·=±=ÔA€JØ
�.‰.Ó
€CØ
ˆa„xØ×)Ñ)¨!Ó,ˆ
Ø�fÕ˜z¨&Õ1€qÜ
�+Š+Ø	�ÕÑÜ�	Š	�1˜,Õ&Ð'¨QÔ/Ü�	Š	�1Õ# QÐ'¨QÔ/ó€Cð
 ˜A”Xˆ3ˆq�6Ð& 3Ð&r   c                óf   € V ^8„  d   QhR\         \        \        3,          R\        P                  /# )r   Úoutput_sizer   )r   Úintr
   r   )r   s   "r   r   r   ,   s&   € ÷ ñ ´E¼#¼s¸(µOð ÌÏÉñ r   c                óŒ  € \         P                  ! V \         P                  R7      p \         P                  ! V\         P                  R7      pV P                  4       ^8X  d#   V P	                  ^ 4      p VP	                  ^ 4      pV P
                  ^ ,          pVR,          p\        V^ ,          4      p\        V^,          4      pWd,          p\         P                  ! V^^3V P                  V P                  R7      pWxR&   WxR&   VR,          WpR,          ,          ,
          VR&   VR,          WpR,          ,          ,
          VR	&   V# )
zÑBatched 2x3 affine matrices mapping each (center, scale) bbox region to
the output box. `output_size` is (H_out, W_out). With rot=0 the MMPose
3-point fit reduces to a closed-form isotropic scale + translate.
r   ©r   Údevicer   )r   r   )r   r   r   )r   r   r   )r   r   r   )r   r   )r   r   r   )
r
   r   r   r   r   Úshaper	   Úzerosr   r6   )	ÚcentersÚscalesr2   ÚnÚsrc_wÚdst_hÚdst_wÚsÚmatss	   &&&      r   Úget_warp_matricesrA   ,   sû   € ô
 �oŠo˜g¬U¯]©]Ô;€GÜ�_Š_˜V¬5¯=©=Ô9€FØ‡{�{ƒ}˜ÔØ×#Ñ# AÓ&ˆØ×!Ñ! !Ó$ˆØ�‰�aÕ€AØ�4�L€EÜ�+˜a•.Ó!€EÜ�+˜a•.Ó!€Eð 	�€AÜ�;Š;˜˜1˜a�y¨¯©¸g¿n¹nÔM€DØˆ�MØˆ�MØ˜C•K !¨d¥mÕ"3Õ3€Dˆ�MØ˜C•K !¨d¥mÕ"3Õ3€Dˆ�MØ€Kr   c                ó¦   € V ^8„  d   QhR\         P                  R\         P                  R\        \        \        3,          R\         P                  /# )r   Úsrc_tr@   r2   r   )r
   r   r   r3   )r   s   "r   r   r   E   sJ   € ÷  eñ  eÜ�<‰<ð eä
�,‰,ð eô ”sœC�x•ð eô 
�‰ñ	 er   c           	     ó²  € \        V^ ,          4      \        V^,          4      rCV P                  w  rVrxV P                  p	VP                  V	\        P
                  R7      p
V
P                  . RO4      P                  V^^4      p\        P                  ! W«.^R7      p\        P                  P                  V4      R,          p\        P                  ! \        P                  ! V\        P
                  V	R7      R,           \        P                  ! V\        P
                  V	R7      R,           RR7      w  rï\        P                  ! Wþ\        P                  ! V4      .RR7      p\        P                  ! RVV4      pVR,          V,          ^,          ^,
          VR&   VR,          V,          ^,          ^,
          VR&   \         P"                  ! V VRR	R
R7      # )a"  Apply N forward (src->dst) 2x3 affine warps to N source images in one
grid_sample call. Kept generic over arbitrary affines (not specialized to
the scale+translate produced by `get_warp_matrices`) so callers can pass
rotated/sheared affines; the per-crop 3x3 invert is O(N) of trivial work.)r6   r   r   r5   r   Úij)Úindexingznkl,ijl->nijkÚbilinearr8   F)ÚmodeÚpadding_modeÚalign_corners)ç        rK   ç      ð?)r   ºNr   Nr   éÿÿÿÿ©.r   ©.r   )r3   r7   r6   Útor
   r   Ú
new_tensorÚexpandr   ÚlinalgÚinvÚmeshgridÚarangeÚstackÚ	ones_likeÚeinsumÚFÚgrid_sample)rC   r@   r2   ÚH_outÚW_outÚNÚ_ÚH_srcÚW_srcr6   Úmats_tÚbottomÚmats_3Úmats_invÚysÚxsÚhomoÚsrc_poss   &&&               r   Úwarp_affine_batchedrk   E   s`  € ô �{ 1•~Ó&¬¨K¸­NÓ(;ˆ5ØŸ™Ñ€Aˆ%Ø�\‰\€Fð �W‰W˜F¬%¯-©-ˆWÓ8€FØ×ÑšÓ/×6Ñ6°q¸!¸QÓ?€FÜ�YŠY˜Ð'¨QÔ/€FÜ�|‰|×Ñ Ó'¨Õ1€Hô �^Š^Ü�Š�U¤%§-¡-¸Ô?À#ÕEÜ�Š�U¤%§-¡-¸Ô?À#ÕEØô�F€Bô
 �;Š;˜¤§¢°Ó 3Ð4¸"Ô=€DÜ�lŠl˜?¨H°dÓ;€Gà˜f•o¨Õ-°Õ1°AÕ5€GˆF�OØ˜f•o¨Õ-°Õ1°AÕ5€GˆF�Oä�=Š=˜ ¨jÀwÐ^cÔdÐdr   c                ój   € V ^8„  d   QhR\         \        \        3,          R\        R\        R\        /# )r   Ú
input_sizeÚbbox_paddingr)   r   )r   r3   r	   r   )r   s   "r   r   r   j   sB   € ÷ Uñ Uô ”cœ3�h•ðUô ð	Uô
 ðUô 
ñUr   c                ó,
  € \        V \        4      pV'       dA   \        V 4      VP                  ^ ,          8X  g   Q hV ^ ,          P                  R,          w  ršMV P                  R,          w  rš\	        VP                  ^ ,          4      pV^ 8”  g   Q R4       h\	        V^ ,          4      \	        V^,          4      rÜ\        WR7      w  rï\        Wô4      p\        WüV,          4      p\        WïWÜ34      pV'       d#   \        P                  ! \        V 4      ^ R7      pM#V P                  ^ 4      P                  VRRR4      pVP                  ^ ^^^4      P                  4       P                  4       p\        VVWÜ34      p\        P                   ! V4      P#                  RR4      R,          p\        P$                  ! V\        P&                  R7      pVfR   \        P(                  ! W½V3\        P&                  R7      p\        P(                  ! V3\        P&                  R7      pEMV\        P                  ! \+        V4       Uu. uF   p\        P$                  ! VV,          4      NK"  	  up^ R7      pVP-                  4       ^8X  d"   VP                  R,          ^8X  d
   VR,          pVP                  4       P                  ^4      p\        VVWÜ34      p\        P                   ! VP/                  ^4      4      P#                  RR4      pVeH   \        P$                  ! \+        V4       Uu. uF  pVV,          NK  	  up\        P&                  R7      pM'\        P0                  ! V3\        P&                  R7      p\        P2                  ! WÍ.\        P&                  R7      P                  V^4      P                  4       pRVP                  ^ 4      R	VP                  ^ 4      R
VP                  ^ 4      RVP                  ^ 4      RVP                  ^ 4      RVP                  ^ 4      RVP                  ^ 4      P                  ^4      RVP                  ^ 4      R\        P0                  ! ^V3\        P&                  R7      /	pVe   VP5                  VR,          4      VR&   V# V	^,          V
^,          ,           R,          p\        P2                  ! V^ V
R,          .^ VV	R,          .. RO..4      P5                  VR,          4      VR&   V# u upi u upi )zhBuild the batch dict the SAM3DBody forward expects, doing the N crops in one batched `grid_sample` call.rM   z$prepare_batch needs at least one box)r   r   rK   g     ào@r   ÚimgÚimg_sizeÚbbox_centerr,   r    Úaffine_transÚmaskÚ
mask_scoreÚperson_validÚcam_intr   g       @rN   rO   )r   r   r   )Ú
isinstanceÚlistÚlenr7   r3   r'   r0   rA   r
   rX   r   rS   ÚpermuteÚ
contiguousr	   rk   ÚfloorÚclamp_r   r   r8   Úranger   ÚsqueezeÚonesÚtensorrQ   )rp   Úboxesrm   rn   r)   ÚmasksÚmasks_scorerw   Úis_multi_imageÚheightÚwidthr;   r^   r]   r9   r:   r@   rC   Úwarped_tÚimg_tÚboxes_tÚmask_tÚmask_score_tÚiÚmasks_tÚmasks_src_tÚwarped_masksÚ
img_size_tÚbatchÚfs   &&&&&&&&                      r   Úprepare_batchr•   j   sý  € ô   ¤TÓ*€NßÜ�3‹x˜5Ÿ;™; q�>Ô)Ð)Ð)Ø˜A�Ÿ™ RÕ(‰ˆ�àŸ	™	 "�‰ˆäˆE�K‰K˜�NÓ€AØˆqŒ5Ð8Ð8Ó8ˆ5ä�z !•}Ó%¤s¨:°a­=Ó'9ˆ5ô # 5Ô?�O€Gô ˜fÓ3€FÜ˜f¨e¥mÓ4€FÜ˜W¨u¨nÓ=€D÷ Ü—’œD ›I¨1Ô-‰à—‘˜aÓ ×'Ñ'¨¨2¨r°2Ó6ˆØ�M‰M˜!˜Q  1Ó%×0Ñ0Ó2×8Ñ8Ó:€Eä" 5¨$°°Ó?€Hä�KŠK˜Ó!×(Ñ(¨¨eÓ4°uÕ<€Eô �oŠo˜e¬5¯=©=Ô9€GØ‚}Ü—’˜a¨Ð.´e·m±mÔDˆÜ—{’{ A 4¬u¯}©}Ô=Šô —+’+Ä%ÈÄ(ÓKÁ(¸QœuŸš¨u°Q­xÖ8Á(ÑKÐQRÔSˆØ�;‰;‹=˜AÔ '§-¡-°Õ"3°qÔ"8Ø˜f•oˆGØ—m‘m“o×/Ñ/°Ó2ˆÜ*¨;¸¸u¸nÓMˆÜ—’˜\×1Ñ1°!Ó4Ó5×<Ñ<¸SÀ%ÓHˆØÒ"Ü Ÿ?š?ÄEÈ!ÄHÓ+MÁH¸q¨K¸¯N¨NÁHÑ+MÔUZ×UbÑUbÔc‰Lä Ÿ:š: q d´%·-±-Ô@ˆLä—’˜u˜n´E·M±MÔB×IÑIÈ!ÈQÓO×ZÑZÓ\€Jð 	ˆu�‰˜qÓ!Ø�J×(Ñ(¨Ó+Ø�w×(Ñ(¨Ó+Ø�f×&Ñ& qÓ)Ø�×!Ñ! !Ó$Ø˜Ÿ™ qÓ)Ø�× Ñ  Ó#×-Ñ-¨aÓ0Ø�l×,Ñ,¨QÓ/ØœŸ
š
 A q 6´·±Ô?ð
€Eð ÒØ"Ÿ:™: e¨E¥lÓ3ˆˆiÑð €Lð �q�[˜5 A�:Õ%¨#Õ-ˆÜ Ÿ<š<Ø�!�U˜S•[Ð! A q¨&°3­,Ð#7ºÐCÐDó
ç
‰"ˆU�5�\Ó
ð 	ˆiÑð €LùòE Lùò ,Ns   É&TÌ+Tc                óX   € V ^8„  d   QhR\         P                  R\         P                  /# )r   Úxr   ©r
   r   )r   s   "r   r   r   Ä   s$   € ÷ 	-ñ 	-Ü�<‰<ð	-ä	�‰ñ	-r   c                ó¶  € V P                  R^^4      P                  ^ ^^4      P                  4       p V R,          V R,          r!\        P                  ! V4      p\        P                  ! V\
        P                  ! RW24      P                  R4      V,          ,
          4      p\
        P                  P                  W44      p\
        P                  ! W4V3RR7      # )zK6D continuous rotation rep (Zhou et al., CVPR 2019) -> 3x3 rotation matrix.zbi,bi->br   rN   )r   r   r   )r   r   r   )Úreshaper{   r|   r[   Ú	normalizer
   rZ   r   rT   ÚcrossrX   )r—   Úa1Úa2Úb1Úb2Úb3s   &     r   Úrot6d_to_rotmatr¢   Ä   s¡   € ð 	
�	‰	�"�a˜Ó×#Ñ# A q¨!Ó,×7Ñ7Ó9€AØˆw�Z˜˜7�ˆÜ	
�Š�R‹€BÜ	
�Š�Rœ%Ÿ,š, z°2Ó:×DÑDÀRÓHÈ2ÕMÕMÓ	N€BÜ	�‰×	Ñ	˜BÓ	#€BÜ�;Š;˜ �|¨Ô,Ð,r   c                óx   € V ^8„  d   QhR\         P                  R\         P                  R\         P                  /# )r   r—   ÚKr   r˜   )r   s   "r   r   r   Ð   s2   € ÷ ñ Ü�<‰<ðä�<‰<ðô 
�‰ñr   c                ó~   € W R,          P                  R4      ,          p\        P                  ! RW4      pVR,          # )zAProject 3D points (already in camera frame) through intrinsics K.zbij,bkj->bkirN   )r   r   rN   )r   r   rM   )r   r
   rZ   )r—   r¤   Úys   && r   Úperspective_projectionr§   Ð   s5   € ð
 	
ˆh�K×!Ñ! "Ó%Õ%€AÜ�Š�^ QÓ*€AØˆX�;Ðr   c                ód   € V ^8„  d   QhR\         R\        P                  R\        P                  /# )r   ÚaxisÚangler   ©Ústrr
   r   )r   s   "r   r   r   Ü   s.   € ÷ Cñ C”sð C¤5§<¡<ð C´E·L±Lñ Cr   c           	     ó¨  € \         P                  ! V4      p\         P                  ! V4      p\         P                  ! V4      p\         P                  ! V4      pV R8X  d   WEVWRV) WSV3	pM2V R8X  d   W%VWTVV) WR3	pM!V R8X  d   W#) VW2VWUV3	pM\        RV : R24      h\         P                  ! VRR7      P                  VP                  R,           4      # )	zERotation matrices around a single coordinate axis. Shape (..., 3, 3).ÚXÚYÚZzInvalid axis z; expected X/Y/Z.r   rN   ©r   r   )	r
   ÚcosÚsinrY   Ú
zeros_likeÚ
ValueErrorrX   rš   r7   )r©   rª   r²   r³   ÚoneÚzeroÚflats   &&     r   Ú_axis_rotmatr¹   Ü   sÙ   € ä
�)Š)�EÓ
€CÜ
�)Š)�EÓ
€CÜ
�/Š/˜%Ó
 €CÜ×Ò˜EÓ"€DØˆs„{Ø˜4Ø˜C˜4Ø˜3ð ‰ð 
�ŒØ˜3Ø˜4Ø��dð!‰ð 
�ŒØ�T˜4Ø˜$Ø˜Cð!‰ô ˜=¨©Ð0AÐBÓCÐCÜ�;Š;�t Ô$×,Ñ,¨U¯[©[¸6Õ-AÓBÐBr   c                ód   € V ^8„  d   QhR\         R\        P                  R\        P                  /# )r   Ú
conventionÚanglesr   r«   )r   s   "r   r   r   ó   s)   € ÷ ñ ¤ð ¬U¯\©\ð ¼e¿l¹lñ r   c                ó&  € V P                  4       p\        V^ ,          VR,          4      p\        V^,          VR,          4      p\        V^,          VR,          4      pV P                  4       '       d   WT,          V,          # W4,          V,          # )zGEuler angles -> rotation matrix, matching roma's case-keyed convention.rO   rP   ).r   )Úupperr¹   Úislower)r»   r¼   ÚaxesÚR0ÚR1ÚR2s   &&    r   Úeuler_to_rotmatrÄ   ó   ss   € à×ÑÓ€DÜ	�d˜1•g˜v f�~Ó	.€BÜ	�d˜1•g˜v f�~Ó	.€BÜ	�d˜1•g˜v f�~Ó	.€BØ×Ñ×ÒØ�w˜�|ÐØ�7�R�<Ðr   c                ó0   € V ^8„  d   QhR\         R\        /# )r   Úletterr   )r¬   r3   )r   s   "r   r   r   þ   s   € ÷ ,ñ ,œsð ,¤sñ ,r   c                 ó    € R ^ R^R^/V ,          # )r®   r¯   r°   © )rÆ   s   &r   Ú_index_from_letterrÉ   þ   s   € Ø��C˜˜C Ð# FÕ+Ð+r   c                óˆ   € V ^8„  d   QhR\         R\         R\        P                  R\        R\        R\        P                  /# )r   r©   Ú
other_axisÚdataÚ
horizontalÚ
tait_bryanr   )r¬   r
   r   Úbool)r   s   "r   r   r     sL   € ÷ 6ñ 6Ü
ð6äð6ô �,‰,ð6ô ð	6ô
 ð6ô ‡\�\ñ6r   c                ód  € RRRRRR/V ,          w  rVV'       d   YVrVW,           R9   pW78X  d*   \         P                  ! VRV3,          VRV3,          4      # V'       d+   \         P                  ! VRV3,          ) VRV3,          4      # \         P                  ! VRV3,          VRV3,          ) 4      # )	z~Extract an outer Euler angle from a row/column of a rotation matrix.

Adapted from PyTorch3D's matrix_to_euler_angles helper.
r®   r¯   r°   .)r   r   )r   r   )r   r   )ÚXYÚYZÚZX)r
   Úatan2)r©   rË   rÌ   rÍ   rÎ   Úi1Úi2Úevens   &&&&&   r   Ú_angle_from_tanrØ     s£   € ð �6˜3 ¨¨VÐ4°TÕ:�F€BßØˆBØÕÐ"4Ñ4€DØÔÜ�{Š{˜4  R �=¨$¨s°B¨w­-Ó8Ð8ßÜ�{Š{˜D  b �M˜>¨4°°R°­=Ó9Ð9Ü�;Š;�t˜C ˜G•} t¨C°¨G¥} nÓ5Ð5r   c                ód   € V ^8„  d   QhR\         P                  R\        R\         P                  /# )r   Úmatrixr»   r   )r
   r   r¬   )r   s   "r   r   r     s)   € ÷ $ñ $¤u§|¡|ð $Äð $ÌÏÉñ $r   c           
     óÜ  € \        V^ ,          4      p\        V^,          4      pW#8g  pV'       d9   W#,
          R9   d   R	MRp\        P                  ! V RW#3,          V,          4      pM\        P                  ! V RW"3,          4      p\	        V^ ,          V^,          V RV3,          RV4      V\	        V^,          V^,          V RVR3,          RV4      3p\        P
                  ! VRR7      # )
z{Decompose a rotation matrix into intrinsic Euler angles (uppercase abc).

Adapted from PyTorch3D's matrix_to_euler_angles.
rL   .Fr   Tr   rN   )rN   r   g      ð¿)rÉ   r
   ÚasinÚacosrØ   rX   )rÚ   r»   Úi0rÖ   rÎ   ÚsignÚcentralr/   s   &&      r   Ú_matrix_to_euler_intrinsicrá     sÐ   € ô
 
˜J q�MÓ	*€BÜ	˜J q�MÓ	*€BØ‘€JßØ� GÔ+‰t°ˆÜ—*’*˜V C¨ KÕ0°4Õ7Ó8‰ä—*’*˜V C¨ KÕ0Ó1ˆô 	˜
 1� z°!¥}°f¸SÀ"¸WµoÀuÈjÓYØÜ˜
 1� z°!¥}°f¸SÀ"Àa¸ZÕ6HÈ$ÐPZÓ[ð€Cô
 �;Š;�s Ô#Ð#r   c                ód   € V ^8„  d   QhR\         R\        P                  R\        P                  /# )r   r»   rÚ   r   r«   )r   s   "r   r   r   .  s)   € ÷ ñ ¤ð ¬U¯\©\ð ¼e¿l¹lñ r   c                ó  € VP                   RR R8w  d#   \        R\        VP                   4       R24      hV P                  4       '       d   \	        W4      # \	        WP                  4       RRR1,          4      pVP                  R4      # )ae  Rotation matrix -> Euler angles, inverse of :func:`euler_to_rotmat`.

PyTorch3D's matrix_to_euler_angles uses the convention R = R_a R_b R_c for
convention "abc"; that matches roma's UPPERCASE ordering directly. For
roma's lowercase, the matrix is reversed (R_c R_b R_a), so we decompose
with the reversed convention and flip the angles back to axis order.
Nz*Expected (..., 3, 3) rotation matrix, got Ú.éþÿÿÿr±   rN   )r7   rµ   ÚtupleÚisupperrá   r¾   Úflip)r»   rÚ   Ú
decomposeds   && r   Úrotmat_to_eulerrê   .  s|   € ð ‡|�|�B�CÐ˜FÔ"ÜÐEÄeÈFÏLÉLÓFYÐEZÐZ[Ð\Ó]Ð]Ø×Ñ×ÒÜ)¨&Ó=Ð=Ü+¨F×4DÑ4DÓ4FÁtÈÀtÕ4LÓM€JØ�?‰?˜2ÓÐr   c                óX   € V ^8„  d   QhR\         P                  R\         P                  /# )r   Úquatr   r˜   )r   s   "r   r   r   >  s&   € ÷ Gñ GœUŸ\™\ð G¬e¯l©lñ Gr   c                ó<  € V P                  RR7      w  rr4^V,          ^V,          ^V,          rvpWT,          Wd,          Wt,          r©pWQ,          Wa,          Wq,          rÜpWb,          Wr,          Ws,          prþ\        P                  ! V4      pVVV,           ,
          WÊ,
          WÙ,           WÊ,           VVV,           ,
          Wø,
          WÙ,
          Wø,           VW¾,           ,
          3	p\        P                  ! VRR7      P	                  V P
                  RR R,           4      # )zâUnit quaternion (x, y, z, w) -> rotation matrix.

Matches roma.unitquat_to_rotmat (scalar-last). The quaternion is assumed to be normalized.

Args:
    quat: (..., 4) unit quaternion.
Returns:
    (..., 3, 3) rotation matrix.
r   NrN   r±   )Úunbindr
   rY   rX   rš   r7   )rì   r—   r¦   Úzr-   ÚtxÚtyÚtzÚtwxÚtwyÚtwzÚtxxÚtxyÚtxzÚtyyÚtyzÚtzzr¶   r¸   s   &                  r   Úunitquat_to_rotmatrü   >  sÞ   € ð —‘ �Ó$�J€Aˆ!Ø�Q•˜˜A�˜q 1�uˆB€BØ•F˜B�F B¥Fˆc€CØ•F˜B�F B¥Fˆc€CØ•F˜B�F B¥FˆcˆÜ
�/Š/˜!Ó
€Càˆs�S�yÕ˜C�I°µØ�	˜C 3¨¥9Õ-°µØ�	˜C�I°¸½	Õ1Bð€Dô
 �;Š;�t Ô$×,Ñ,¨T¯Z©Z¸¸¨_¸vÕ-EÓFÐFr   )g      ô?g      è?NNN)Útypingr   r   r
   Útorch.nn.functionalÚnnÚ
functionalr[   r'   r0   rA   rk   r•   r¢   r§   r¹   rÄ   rÉ   rØ   rá   rê   rü   rÈ   r   r   Ú<module>r     s_   ð÷
 ã ß Ð õõ'õõ2 e÷JUõt	-õõCõ.õ,õ6õ,$õ,÷ Gr   