+
    ƒ°ñj  ã                  óœ   € R t ^ RIHt ^ RI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 ltR R ltR R ltR R ltR# )z9Geometry / camera transform helpers for Depth Anything 3.)Úannotations)ÚTupleNc               ó    € V ^8„  d   QhRRRR/# )é   Úextútorch.TensorÚreturn© )Úformats   "ÚHC:\Ai_Coding\apps\studio\ComfyUI\comfy\ldm\depth_anything_3\transform.pyÚ__annotate__r      s   € ÷ ;ñ ;˜ð ;¨ñ ;ó    c                óü   € V P                   RR R8X  d   V # V P                   RR R8X  d<   \        P                  ! V R,          4      pRVR	&   \        P                  ! W.RR7      # \	        RV P                    24      h)
zjPromote (...,3,4) extrinsics to (...,4,4) homogeneous form. No-op when the input is already ``(...,4,4)``.Nç      ð?©ÚdimzInvalid affine shape: éþÿÿÿ)é   r   )é   r   ).:Né   N:Nr   N).é    r   )ÚshapeÚtorchÚ
zeros_likeÚcatÚ
ValueError)r   Úoness   & r   Úas_homogeneousr      ss   € à
‡y�y��€~˜ÔØˆ
Ø
‡y�y��€~˜ÔÜ×Ò  KÕ 0Ó1ˆØˆˆY‰Ü�yŠy˜#˜¨"Ô-Ð-Ü
Ð-¨c¯i©i¨[Ð9Ó
:Ð:r   c               ó    € V ^8„  d   QhRRRR/# )r   ÚAr   r   r	   )r
   s   "r   r   r      s   € ÷ Hñ H�lð H |ñ Hr   c                óÔ   € V R,          pV R,          pV R,          p\         P                  ! \         P                  ! VP                  VP                  ) V,          .RR7      V.RR7      # )z/Inverse of an affine matrix ``[R|T; 0 0 0 1]``.r   ©.ºNr   Nr"   ).r"   ºr   NN).r#   ºNNNéÿÿÿÿr   )r   r   ÚmT)r   ÚRÚTÚPs   &   r   Úaffine_inverser*      sQ   € à	ˆ+�€AØ	ˆ+�€AØ	ˆ*�€AÜ�9Š9”e—i’i §¡¨¯© u¨q¥yÐ 1°rÔ:¸AÐ>ÀBÔGÐGr   c               ó    € V ^8„  d   QhRRRR/# )r   Úxr   r   r	   )r
   s   "r   r   r   (   s   € ÷ ñ ˜<ð ¨Lñ r   c                ó
  € \         P                  ! V 4      pV ^ 8„  p\         P                  ! 4       '       d!   \         P                  ! W,          4      W&   V# \         P                  ! V\         P                  ! V 4      V4      pV# )z5sqrt(max(0, x)) with a zero subgradient where x == 0.)r   r   Úis_grad_enabledÚsqrtÚwhere)r,   ÚretÚpositive_masks   &  r   Ú_sqrt_positive_partr3   (   sf   € ä
×
Ò
˜1Ó
€CØ˜‘E€MÜ×Ò×ÒÜ"ŸZšZ¨Õ(8Ó9ˆÑð €Jô �kŠk˜-¬¯ª°A«¸Ó<ˆØ€Jr   c               ó    € V ^8„  d   QhRRRR/# ©r   Úquaternionsr   r   r	   )r
   s   "r   r   r   3   s   € ÷ Mñ M¨ð M¸ñ Mr   c                óH   € \         P                  ! V R,          ^ 8  V ) V 4      # )zCForce the real part of a unit quaternion (xyzw) to be non-negative.).:r   r   N)r   r0   )r6   s   &r   Ústandardize_quaternionr8   3   s!   € ä�;Š;�{ 8Õ,¨qÑ0°;°,ÀÓLÐLr   c               ó    € V ^8„  d   QhRRRR/# r5   r	   )r
   s   "r   r   r   8   s   € ÷ 6ñ 6˜\ð 6¨lñ 6r   c                óú  € \         P                  ! V R4      w  rr4RW ,          P                  R4      ,          p\         P                  ! ^WRV,          W3,          ,           ,          ,
          WQV,          W4,          ,
          ,          WQV,          W$,          ,           ,          WQV,          W4,          ,           ,          ^WQV,          W3,          ,           ,          ,
          WRV,          W,          ,
          ,          WQV,          W$,          ,
          ,          WRV,          W,          ,           ,          ^WQV,          W",          ,           ,          ,
          3	R4      pVP	                  V P
                  RR R,           4      # )z:Convert quaternions (xyzw) to (...,3,3) rotation matrices.ç       @Nr%   ©r   r   )r   ÚunbindÚsumÚstackÚreshaper   )r6   ÚiÚjÚkÚrÚtwo_sÚos   &      r   Úquat_to_matrG   8   s  € ä—’˜k¨2Ó.�J€Aˆ!Ø�;Õ,×1Ñ1°"Ó5Õ5€EÜ�Šà�˜Q� ¥�Õ'Õ'Ø˜•U˜Q�U•]Õ#Ø˜•U˜Q�U•]Õ#Ø˜•U˜Q�U•]Õ#Ø�˜Q� ¥�Õ'Õ'Ø˜•U˜Q�U•]Õ#Ø˜•U˜Q�U•]Õ#Ø˜•U˜Q�U•]Õ#Ø�˜Q� ¥�Õ'Õ'ð
	
ð 	ó	€Að �9‰9�[×&Ñ& s¨Ð+¨fÕ4Ó5Ð5r   c               ó    € V ^8„  d   QhRRRR/# )r   Úmatrixr   r   r	   )r
   s   "r   r   r   M   s   € ÷ ('ñ ('˜ð ('¨ñ ('r   c                ó’  € V P                  R4      ^8w  g   V P                  R4      ^8w  d   \        RV P                   R24      hV P                  RR p\        P                  ! V P                  VR,           4      RR7      w	  r#rErgr‰p
\        \        P                  ! RV,           V,           V
,           RV,           V,
          V
,
          RV,
          V,           V
,
          RV,
          V,
          V
,           .RR7      4      p\        P                  ! \        P                  ! VR,          ^,          W—,
          WH,
          WS,
          .RR7      \        P                  ! W—,
          VR,          ^,          WS,           WH,           .RR7      \        P                  ! WH,
          WS,           VR,          ^,          Wy,           .RR7      \        P                  ! WS,
          W„,           W—,           VR,          ^,          .RR7      .RR7      p\        P                  ! R4      P                  VP                  VP                  R7      pVR	VR,          P                  V4      ,          ,          pV\        P                  ! VP                  RR7      ^R
7      R8„  R3,          P                  VR,           4      pVR. RO3,          p\!        V4      # )z:Convert (...,3,3) rotation matrices to quaternions (xyzw).zInvalid rotation matrix shape Ú.Nr   r   .gš™™™™™¹?)ÚdtypeÚdevicer;   )Únum_classesg      à?r$   r%   r   )é	   ).r   ).r   ).r   ).r   ©.N)r   )r   r   r   r   )Úsizer   r   r   r=   r@   r3   r?   ÚtensorÚtorL   rM   ÚmaxÚFÚone_hotÚargmaxr8   )rI   Ú	batch_dimÚm00Úm01Úm02Úm10Úm11Úm12Úm20Úm21Úm22Úq_absÚquat_by_rijkÚflrÚquat_candidatesÚouts   &               r   Úmat_to_quatrg   M   s/  € à‡{�{�2ƒ˜!Ô˜vŸ{™{¨2›°!Ô3ÜÐ9¸&¿,¹,¸ÀqÐIÓJÐJà—‘˜S˜bÐ!€IÜ27·,²,Ø�‰�y 4Õ'Ó(¨bô3Ñ/€Cˆc˜ #¨Cô  Ü�Šà�c•	˜C• #Õ%Ø�c•	˜C• #Õ%Ø�c•	˜C• #Õ%Ø�c•	˜C• #Õ%ð	ð ô	
ó
€Eô —;’;ä�KŠK˜˜v�¨!Õ+¨S­Y¸½	À3Å9ÐMÐSUÔVÜ�KŠK˜� E¨&¥M°QÕ$6¸½	À3Å9ÐMÐSUÔVÜ�KŠK˜� C¥I¨u°V­}ÀÕ/AÀ3Å9ÐMÐSUÔVÜ�KŠK˜� C¥I¨s­y¸%À½-È1Õ:LÐMÐSUÔVð		
ð ô€Lô �,Š,�sÓ
×
Ñ
 U§[¡[¸¿¹Ð
Ó
F€CØ" c¨E°)Õ,<×,@Ñ,@ÀÓ,EÕ&EÕF€Oà
œ!Ÿ)š) E§L¡L°R LÓ$8ÀaÔHÈ3ÑNÐPQÐQÕ
R×
ZÑ
ZØ�DÕó€Cð ˆc’<ÐÕ
 €CÜ! #Ó&Ð&r   c               ó(   € V ^8„  d   QhRRRRRRRR/# )r   Ú
extrinsicsr   Ú
intrinsicsÚimage_size_hwúTuple[int, int]r   r	   )r
   s   "r   r   r   }   s4   € ÷ Tñ T¨\ð TÀ|ð TÐdsð Tð  yEñ Tr   c                óz  € V R,          pV R,          p\        V4      pVw  rg^\        P                  ! V^,          VR,          ,          4      ,          p^\        P                  ! V^,          VR,          ,          4      ,          p	\        P                  ! WEVR,          V	R,          .RR7      P	                  4       # )zÄPack (extr, intr, image_size) into the 9-D pose-encoding vector.
extrinsics: camera-to-world (c2w) (B,S,4,4) matrices,
intrinsics: pixel-space (B,S,3,3) matrices,
image_size_hw: is a (H, W) pair.
r   r!   ).r"   r   ©.r   r   ©.r   r   rP   r%   )rg   r   Úatanr   Úfloat)
ri   rj   rk   r'   r(   ÚquatÚHÚWÚfov_hÚfov_ws
   &&&       r   Úextri_intri_to_pose_encodingrw   }   s•   € ð 	�;Õ€AØ�:Õ€AÜ�q‹>€DØ�D€AØ”—
’
˜A �E Z°	Õ%:Õ:Ó;Õ;€EØ”—
’
˜A �E Z°	Õ%:Õ:Ó;Õ;€EÜ�9Š9�a˜u YÕ/°°yÕ1AÐBÈÔK×QÑQÓSÐSr   c               ó$   € V ^8„  d   QhRRRRRR/# )r   Úpose_encodingr   rk   rl   r   z!Tuple[torch.Tensor, torch.Tensor]r	   )r
   s   "r   r   r   Œ   s&   € ÷ "ñ "°ð "È_ð "ð  bCñ "r   c                óÔ  € V R
,          pV R,          pV R,          pV R,          pW3P                  RRR7      P                  RR7      ,          p\        V4      p\        P                  ! WbR,          .RR7      pVw  r‰VR,          \        P                  ! \        P
                  ! VR,          4      R4      ,          p
V	R,          \        P                  ! \        P
                  ! VR,          4      R4      ,          p\        P                  ! V P                  R,          R,           V P                  V P                  R7      pW¼R&   W¬R&   V	^,          VR&   V^,          VR&   R	VR&   W|3# )z(Inverse of extri_intri_to_pose_encoding.T)r   Úkeepdimg�íµ ÷Æ°>)Úminr   r;   :Nr   N)rM   rL   r   ).r"   ).:r   é   N).r}   ).é   r%   rP   r<   ro   rn   ).r   r   ).r   r   ).r   r   )
ÚnormÚclamprG   r   r   ÚtanÚzerosr   rM   rL   )ry   rk   r(   rr   ru   rv   r'   ri   rs   rt   ÚfyÚfxrj   s   &&           r   Úpose_encoding_to_extri_intrir…   Œ   s1  € à�gÕ€AØ˜Õ"€DØ˜&Õ!€EØ˜&Õ!€Eð —)‘) ¨D�)Ó1×7Ñ7¸DÐ7ÓAÕA€DÜ�DÓ€AÜ—’˜A �|Ð,°"Ô5€JØ�D€AØ
ˆc�'”U—[’[¤§¢¨5°3­;Ó!7¸Ó>Õ	>€BØ
ˆc�'”U—[’[¤§¢¨5°3­;Ó!7¸Ó>Õ	>€BÜ—’˜]×0Ñ0°Õ4°vÕ=Àm×FZÑFZÐbo×buÑbuÔv€JØˆyÑØˆyÑØ �E€JˆyÑØ �E€JˆyÑØ€JˆyÑØÐ!Ð!r   )Ú__doc__Ú
__future__r   Útypingr   r   Útorch.nn.functionalÚnnÚ
functionalrU   r   r*   r3   r8   rG   rg   rw   r…   r	   r   r   Ú<module>rŒ      sC   ðÙ ?å "å ã ß Ð õ;õHõõMõ
6õ*('õ`T÷"r   