+
    ƒ°ñjÉ.  ã                  ó–   € R t ^ RIHt ^ RIHtHt ^ RI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 R lltR R ltR# )zCRay-to-pose conversion for the multi-view path of Depth Anything 3.)Úannotations)ÚOptionalÚTupleNc               ó    € V ^8„  d   QhRRRR/# )é   ÚAútorch.TensorÚreturnz!Tuple[torch.Tensor, torch.Tensor]© )Úformats   "ÚGC:\Ai_Coding\apps\studio\ComfyUI\comfy\ldm\depth_anything_3\ray_pose.pyÚ__annotate__r      s   € ÷ ñ ˜ð Ð*Kñ ó    c                ó  € \         P                  ! . RO. RO. RO.V P                  V P                  R7      pW,          p\         P                  P                  VP                  4       4      w  r4VP                  V P                  4      pVP                  V P                  4      pW1,          pW,          V,          p\         P                  ! V4      p\         P                  ! V4      pWXR,          ,          pWhR,          ,          pWV3# )z¼Decompose A = Q @ L with Q orthogonal and L lower-triangular.
Implemented in terms of QR by reversing the columns/rows; the standard
trick from the upstream reference. Inputs A are (3, 3).©ÚdeviceÚdtype)é    r   é   )r   r   r   )r   r   r   )NºNNN)r   N)
ÚtorchÚtensorr   r   ÚlinalgÚqrÚfloatÚtoÚdiagÚsign)	r   ÚPÚA_tildeÚQ_tildeÚR_tildeÚQÚLÚdr   s	   &        r   Ú_ql_decompositionr%      s¶   € ô 	�Š’i¢ªIÐ6¸q¿x¹xÈqÏwÉwÔW€AØ�e€Gä—|‘|—‘ w§}¡}£Ó7Ñ€GØ�j‰j˜Ÿ™Ó!€GØ�j‰j˜Ÿ™Ó!€GØ�€AØ	��a�€AÜ�
Š
�1‹€AÜ�:Š:�a‹=€DØ	��MÕ€AØ	��MÕ€AØˆ4€Kr   c               ó    € V ^8„  d   QhRRRR/# )r   Úpointsr   r	   r
   )r   s   "r   r   r       s   € ÷ Iñ I˜|ð I°ñ Ir   c                ól   € \         P                  ! V \         P                  ! V R,          4      .RR7      # ).©Údim©.:Nr   Néÿÿÿÿ)r   ÚcatÚ	ones_like)r'   s   &r   Ú_homogenize_pointsr/       s%   € Ü�9Š9�fœeŸošo¨f°W­oÓ>Ð?ÀRÔHÐHr   c               ó(   € V ^8„  d   QhRRRRRRRR/# )r   Úsrc_ptsr   Údst_ptsÚconfident_weightr	   r
   )r   s   "r   r   r   )   s.   € ÷ ñ ¨<ð À,ð Ðbnð ð  uAñ r   c                óX  € V P                   ^ ,          pV^8  d   \        R4      hVP                  4       P                  ^4      pV R,          pV R,          pVR,          pVR,          p\        P
                  ! V4      p	\        P                  ! V) V,          V) V,          V) W™W•V,          V,          Wg,          V,          Wt,          .	^R7      p
\        P                  ! W™W•) V,          V) V,          V) WX,          V,          Wh,          V,          W„,          .	^R7      p\        P                  ! W«.^ R7      p\        P                  P                  VP                  4       4      w   rÞVP                  VP                  4      pVR,          P                  ^^4      pWÿR,          ,          # )z3Solve a single H with weighted least-squares (DLT).z7At least 4 points are required to compute a homography.r)   )r   ºr   r   N)r   ºr   r   Nr,   )r,   r,   )ÚshapeÚ
ValueErrorÚsqrtÚ	unsqueezer   Ú
zeros_liker-   r   Úsvdr   r   r   Úreshape)r1   r2   r3   ÚNÚwÚxÚyÚuÚvÚzerosÚA1ÚA2r   Ú_ÚVhÚHs   &&&             r   Ú_find_homography_weighted_lsqrJ   )   sQ  € à�‰�aÕ€AØˆ1„uÜÐRÓSÐSØ×ÑÓ×)Ñ)¨!Ó,€AØ��€AØ��€AØ��€AØ��€AÜ×Ò˜QÓ€EÜ	�Š�Q�B˜•F˜Q˜B �F Q B¨°eÀ½UÀQ½YÈÍÐPQÍ	ÐSTÕSXÐYÐ_`Ô	a€BÜ	�Š�E %¨¨a­°!°°aµ¸!¸¸Q½UÀQ½YÈÍÐPQÍ	ÐSTÕSXÐYÐ_`Ô	a€BÜ�	Š	�2�( Ô"€Aä�|‰|×Ñ §¡£	Ó*�H€A€qØ	�‰ˆq�w‰w‹€BØ
ˆ2��‰�q˜!Ó€AØ��y�=Ðr   c               ó(   € V ^8„  d   QhRRRRRRRR/# )r   Úsrc_pts_batchr   Údst_pts_batchÚconfident_weight_batchr	   r
   )r   s   "r   r   r   >   s3   € ÷ ñ ¸ð ÐVbð ð  }Ið ð  NZñ r   c                ó0  € V P                   w  r4pVP                  4       P                  ^4      pV R,          pV R,          pVR,          p	VR,          p
\        P                  ! V4      p\        P
                  ! V) V,          V) V,          V) W»W·V	,          V,          W‰,          V,          W–,          .	^R7      p\        P
                  ! W»W·) V,          V) V,          V) Wz,          V,          WŠ,          V,          W¦,          .	^R7      p\        P
                  ! WÍ.^R7      p\        P                  P                  VP                  4       4      w   r_VP                  VP                  4      pVR,          P                  V^^4      pVVR,          ,          # )z@Batched DLT solver. Inputs (B, K, 2) / (B, K); output (B, 3, 3).r)   )r   r   r5   )r   r   r6   )r   r,   )r   ºr   é   NrP   )r7   r9   r:   r   r;   r-   r   r<   r   r   r   r=   )rL   rM   rN   ÚBÚKrG   r?   r@   rA   rB   rC   rD   rE   rF   r   rH   rI   s   &&&              r   Ú%_find_homography_weighted_lsq_batchedrT   >   sJ  € à×!Ñ!�G€Aˆ!Ø×#Ñ#Ó%×/Ñ/°Ó2€AØ�iÕ €AØ�iÕ €AØ�iÕ €AØ�iÕ €AÜ×Ò˜QÓ€EÜ	�Š�Q�B˜•F˜Q˜B �F Q B¨°eÀ½UÀQ½YÈÍÐPQÍ	ÐSTÕSXÐYÐ_`Ô	a€BÜ	�Š�E %¨¨a­°!°°aµ¸!¸¸Q½UÀQ½YÈÍÐPQÍ	ÐSTÕSXÐYÐ_`Ô	a€BÜ�	Š	�2�( Ô"€Aä�|‰|×Ñ §¡£	Ó*�H€A€qØ	�‰ˆq�w‰w‹€BØ
ˆ5�	×Ñ˜!˜Q Ó"€AØˆq��~ÕÐr   c               ó@   € V ^8„  d   QhRRRRRRRRRRRR	R
RRRRRRR/
# )r   r1   r   r2   r3   Ún_sampleÚintÚn_iterÚreproj_thresholdr   Únum_sample_for_ransacÚmax_inlier_numÚrand_sample_iters_idxúOptional[torch.Tensor]r	   r
   )r   s   "r   r   r   Q   sx   € ÷ G-ñ G-ØðG-àðG-ð #ðG-ð ð	G-ð
 ðG-ð ðG-ð ðG-ð ðG-ð 2ðG-ð ñG-r   c	                óP  € V P                   w  ršpV
^8¼  g   Q hV P                  p\        P                  ! VR^R7      pVRRV13,          pVfJ   \        P                  ! \        V4       Uu. uF  p\        P                  ! W<R7      RV NK  	  up^ R7      pVRV3,          p\        P                  ! WœR7      P                  V	^^4      P                  W”V4      pV VV3,          pVVV3,          pVVV3,          pVP                   R,          w  pp\        VP                  ^ ^4      VP                  ^ ^4      VP                  ^ ^4      4      P                  ^ VV34      p\        P                  ! V \        P                  ! Wš^WÀP                  R7      .^R7      p\        P                   ! VP#                  ^4      P                  W”V
^4      P%                  RV
^4      VP%                  R^^4      P'                  ^^4      4      pVR,          VR,          ,          P%                  W”V
^4      pVVP#                  ^4      ,
          ^,          P)                  R4      P+                  4       pVV8  pVVP#                  ^4      ,          P)                  ^R7      p\        P,                  ! V^R7      pV\        P                  ! WœR7      V3,          p. p\        V	4       EF+  p VV ,          p!V V ,          V!,          p"VV ,          V!,          p#VV ,          V!,          p$V"P                   ^ ,          ^8  d4   VP/                  \        P0                  ! ^WÀP                  R7      4       Kˆ  \        P                  ! V$RR	7      p%\3        V%4      V8”  dK   \5        \7        \3        V%4      R
,          4      V4      p&V%RV& \        P                  ! V&VR7      RV ,          p%VP/                  \9        V"V%,          V#V%,          V$V%,          4      4       EK.  	  \        P                  ! V^ R7      # u upi )zTBatched weighted-RANSAC homography estimator. Returns (B, 3, 3) homography matrices.T)Ú
descendingr*   r   N©r   r)   ºNr   Nr   )r_   gffffffî?r,   )r   r   ra   )r   r   rP   )r7   r   r   ÚargsortÚstackÚrangeÚrandpermÚarangeÚviewÚexpandrT   ÚflattenÚ	unflattenr-   Úonesr   Úbmmr:   r=   Ú	transposeÚsumr9   ÚargmaxÚappendÚeyeÚlenÚmaxrW   rJ   )'r1   r2   r3   rV   rX   rY   rZ   r[   r\   rR   r>   rG   r   Ú
sorted_idxÚcandidate_idxÚrand_idxÚb_idxÚsrc_bÚdst_bÚw_bÚcBÚcNÚH_batchÚsrc_homoÚprojÚproj_xyÚerrÚinlier_maskÚscoreÚbest_idxÚbest_inlier_maskÚH_inlier_listÚbÚmaskÚin_srcÚin_dstÚin_wÚsorted_wÚkeeps'   &&&&&&&&&                              r   Ú(_ransac_find_homography_weighted_batchedrŽ   Q   s�  € ð �m‰m�G€Aˆ!Ø�Œ6€Mˆ6Ø�^‰^€Fä—’Ð/¸DÀaÔH€JØ˜q ) 8 )˜|Õ,€MàÒ$Ü %§¢ä˜F”mó%Ù#�ô �^Š^˜HÔ4Ð5KÐ6KÓLÙ#ñ%àô!
Ðð ˜QÐ 5Ð5Õ6€Hä�Š�QÔ&ß	‰ˆa��A‹ß	‰�Ð0Ó	1ð 
ð
 �E˜8�OÕ$€EØ�E˜8�OÕ$€EØ
˜5 (˜?Õ
+€Cà�[‰[˜�_�F€BˆÜ3Ø�‰�a˜Ó˜UŸ]™]¨1¨aÓ0°#·+±+¸aÀÓ2Cóç�i��B˜�8Óð ô �yŠy˜'¤5§:¢:¨a°A¸fÏMÉMÔ#ZÐ[ÐabÔc€HÜ�9Š9Ø×Ñ˜1Ó×$Ñ$ Q°°1Ó5×=Ñ=¸bÀ!ÀQÓGØ�‰˜˜A˜qÓ!×+Ñ+¨A¨qÓ1ó€Dð �H�~  Y¥Õ/×8Ñ8¸ÀAÀqÓI€GØ�g×'Ñ'¨Ó*Õ*¨qÕ0×
5Ñ
5°bÓ
9×
>Ñ
>Ó
@€CØÐ(Ñ(€KØÐ+×5Ñ5°aÓ8Õ8×=Ñ=À!Ð=ÓD€EÜ�|Š|˜E qÔ)€HØ"¤5§<¢<°Ô#AÀ8Ð#KÕLÐð €MÜ�1�XˆØ Õ"ˆØ˜•˜DÕ!ˆØ˜•˜DÕ!ˆØ Õ" 4Õ(ˆØ�<‰<˜�?˜QÔà× Ñ ¤§¢¨1°VÇ=Á=Ô!QÔRÙÜ—=’= °$Ô7ˆÜˆx‹=˜>Ô)Ü”sœ3˜x›=¨4Õ/Ó0°.ÓAˆDØ  �¤u§~¢~°dÀ6Ô'JÈ?ÈNÐ'[Õ\ˆHØ×ÑÜ)¨&°Õ*:¸FÀ8Õ<LÈdÐS[ÍnÓ]÷	
ñ ô  �;Š;�}¨!Ô,Ð,ùòe%s   Á,#P#c          
     ó,   € V ^8„  d   QhRRRRRRRRRR/# )r   Únum_yrW   Únum_xrR   ÚSr	   r   r
   )r   s   "r   r   r       s7   € ÷ Eñ E˜sð E¨3ð E°3ð E¸3ð EÐR^ñ Er   c                óü  € RV,          pRV ,          p\         P                  ! ^V,
          ) ^V,
          WVR7      p\         P                  ! ^V,
          ) ^V,
          WVR7      p	\         P                  ! W‰RR7      w  r«\         P                  ! Wº3RR7      pVP	                  ^ 4      P	                  ^ 4      P                  W#W^4      p\         P                  ! V\         P                  ! VR,          4      .RR7      # )zFCamera-space unit rays for an identity intrinsic on a 2x2 image plane.ç      ð?r   Úij)Úindexingr)   r,   r+   )r   ÚlinspaceÚmeshgridrc   r:   rh   r-   r.   )r�   r‘   rR   r’   r   r   ÚdxÚdyrA   r@   ÚyyÚxxÚgrids   &&&&&&       r   Ú_unproject_identityrž       sÁ   € à	ˆu�€BØ	ˆu�€Bô 	�Š˜˜R��y 1 r¥6¨EÈÔN€AÜ�Š˜˜R��y 1 r¥6¨EÈÔN€AÜ�^Š^˜A¨4Ô0�F€BÜ�;Š;˜�x RÔ(€DØ�>‰>˜!Ó×&Ñ& qÓ)×0Ñ0°°uÀQÓG€DÜ�9Š9�dœEŸOšO¨D°­MÓ:Ð;ÀÔDÐDr   c               ó(   € V ^8„  d   QhRRRRRRRR/# )	r   Úcamrayr   Ú
confidencer]   rY   r   r	   z=Tuple[torch.Tensor, torch.Tensor, torch.Tensor, torch.Tensor]r
   )r   s   "r   r   r   ®   s7   € ÷ Q'ñ Q'ØðQ'à&ðQ'ð ðQ'ð Cñ	Q'r   c                ó\  € Vf   \         P                  ! V R,          4      pV P                  w  r4rVpV P                  pV P                  p	V R,          p
\        WVW4W‰4      pV
P                  ^ ^4      P                  ^^4      p
VP                  ^ ^4      P                  ^^4      pVP                  ^ ^4      P                  ^^4      P                  4       pRpV
R,          P                  4       V8„  VR,          P                  4       V8„  ,          p\         P                  ! Wì\         P                  ! V4      4      pVP                  4       pV
P                  4       p\         P                  ! WïR,          VR,          ,          VR,          4      VR&   \         P                  ! WïR,          VR,          ,          VR,          4      VR&   \         P                  ! VVR,          VR,          ,          VR,          4      VR&   \         P                  ! VVR,          VR,          ,          VR,          4      VR&   VR,          pVR,          pVP                  ^,          p^dpRp^p\        V\        VV,          4      4      p\         P                  ! \        V4       Uu. uF  p\         P                  ! VVR7      RV NK   	  up^ R7      p^p. p\        ^ VP                  ^ ,          V4       F–  p\!        VVVV,            VVVV,            VVVV,            VVVVVRR7	      p\         P"                  P%                  VP'                  4       4      ^ 8  p\         P                  ! VR,          V) V4      pVP)                  V4       K˜  	  \         P*                  ! V^ R7      p. . . ppp\        VP                  ^ ,          4       FÆ  p\-        VV,          4      w  pp V V ^,          ^,          ,          p VP)                  \         P                  ! V ^ ,          ^ ,          V ^,          ^,          34      4       VP)                  \         P                  ! V ^,          ^ ,          V ^,          ^,          34      4       VP)                  V4       KÈ  	  \         P                  ! V4      P/                  W4^^4      p\         P                  ! V4      P/                  W4^4      p!\         P                  ! V4      P/                  W4^4      p"VP                  ^ ^4      P                  ^^4      p#V P                  ^ ^4      P                  ^^4      R,          V#P1                  R4      ,          P3                  ^R7      p$V$V#P3                  RRR	7      ,          p$V$P/                  W4^4      p$VV$R
V!,          V"R
,           3# u upi )zCConvert per-pixel camera rays to per-view (R, T, focal, principal).Ng-Cëâ6?g333333Ó?r`   r)   i@  )rV   rX   rZ   rY   r\   r[   T)r*   Úkeepdimr”   ).r   ).:NrQ   N)r   r   r   ).r   ).r   ).ra   )r   NN).:rQ   NNr,   )r   r.   r7   r   r   rž   ri   ÚcloneÚabsÚwherer;   rs   rW   rc   rd   re   rŽ   r   Údetr   rp   r-   r%   r=   r:   rn   )%r    r¡   rY   rR   r’   Úhr?   rG   r   r   Úrays_targetÚrays_originÚweightsÚz_threshrˆ   ÚsrcÚdstr>   rX   Úsample_ratiorZ   rV   rv   ÚchunkÚA_listÚir   ÚflipÚR_listÚf_listÚpp_listÚRr#   ÚfocalÚppÚcfÚTs%   &&&                                  r   Ú_camray_to_caminfor¼   ®   s­  € ð ÒÜ—_’_ V¨F¥^Ó4ˆ
Ø—L‘L�M€Aˆ!�Ø�]‰]€FØ�L‰L€Eà˜•/€KÜ% a¨A°&Ó@€Kð ×%Ñ% a¨Ó+×3Ñ3°A°qÓ9€KØ×%Ñ% a¨Ó+×3Ñ3°A°qÓ9€KØ× Ñ   AÓ&×.Ñ.¨q°!Ó4×:Ñ:Ó<€Gð €HØ˜Õ ×$Ñ$Ó&¨Ñ1°kÀ'Õ6J×6NÑ6NÓ6PÐS[Ñ6[Õ\€DÜ�kŠk˜$¬×)9Ò)9¸'Ó)BÓC€GØ
×
Ñ
Ó
€CØ
×
Ñ
Ó
€CÜ—+’+˜d¨¥K°#°fµ+Õ$=¸sÀ6½{ÓK€Cˆ�KÜ—+’+˜d¨¥K°#°fµ+Õ$=¸sÀ6½{ÓK€Cˆ�KÜ—+’+˜d C¨¥K°#°fµ+Õ$=¸sÀ6½{ÓK€Cˆ�KÜ—+’+˜d C¨¥K°#°fµ+Õ$=¸sÀ6½{ÓK€Cˆ�KØ
ˆg�,€CØ
ˆg�,€Cà�	‰	�!�€AØ€FØ€LØÐÜÐ(¬#¨a°,Õ.>Ó*?Ó@€HÜ�{Š{ÜRWÐX^ÔR_Ó`ÑR_ÈQŒ�Š˜¨Ô	0Ð1GÐ2GÓ	HÑR_Ñ`Øô€Hð €EØ€FÜ�1�c—i‘i •l EÖ*ˆÜ4Ø��!�e•)Ð˜c ! A¨¥IÐ.°¸¸!¸e½)Ð0DØ fØ"7Ø-Ø"*Øô
ˆô �|‰|×Ñ §¡£	Ó*¨QÑ.ˆÜ�KŠK˜˜]Õ+¨a¨R°Ó3ˆØ�‰�aÖñ +ô 	�	Š	�&˜aÔ €Aà  " b�GˆF€FÜ�1—7‘7˜1•:ÖˆÜ   1¥Ó&‰ˆˆ1Ø��!•�Q•�KˆØ�‰”e—k’k 1 Q¥4¨¥7¨A¨a­D°­GÐ"4Ó5Ô6Ø�‰”u—{’{ A a¥D¨¥G¨Q¨q­T°!­WÐ#5Ó6Ô7Ø�‰�aÖñ ô 	�Š�FÓ×#Ñ# A¨!¨QÓ/€AÜ�KŠK˜Ó×'Ñ'¨¨aÓ0€EÜ	�Š�WÓ	×	%Ñ	% a¨AÓ	.€Bð 
×	Ñ	˜A˜qÓ	!×	)Ñ	)¨!¨QÓ	/€BØ	�‰˜˜1Ó	×	%Ñ	% a¨Ó	+¨GÕ	4°r·|±|ÀBÓ7GÕ	G×LÑLÐQRÐLÓS€AØ	ˆB�F‰F�r 4ˆFÓ(Õ(€AØ	�	‰	�!˜Ó€Að ˆa��u•˜b 3�hÐ&Ð&ùòU 	as   Ê$V)c          
     ó,   € V ^8„  d   QhRRRRRRRRRR/# )	r   r    r   ÚconfÚpatch_size_yrW   Úpatch_size_xr	   z/Tuple[torch.Tensor, torch.Tensor, torch.Tensor]r
   )r   s   "r   r   r     s:   € ÷ ñ Øðà
ðð ðð ð	ð
 5ñr   c                ó  € VP                   ^8X  d*   VP                  R,          ^8X  d   VP                  R4      p\        WR7      w  rErg\        P
                  ! WEP                  R4      .RR7      p\        P                  ! . ROVP                  VP                  R7      p	V	P                  ^^^^4      P                  VP                  ^ ,          VP                  ^,          ^^4      p	\        P
                  ! W‰.RR7      pW†V3# )z?Wrap a 4x4 extrinsic + per-view focal + principal-point output.)r¡   r)   )r   r   r,   )r   r   r   r   éþÿÿÿ)Úndimr7   Úsqueezer¼   r   r-   r:   r   r   r   rg   rh   )
r    r¾   r¿   rÀ   r·   r»   r¸   r¹   ÚextrÚhomo_rows
   &&&&      r   Úget_extrinsic_from_camrayrÇ     sÁ   € ð ‡y�y�A„~˜$Ÿ*™* R�.¨AÔ-Ø�|‰|˜BÓˆÜ(¨ÔA�O€Aˆ%Ü�9Š9�aŸ™ R›Ð)¨rÔ2€DÜ�|Š|šL°·±ÀÇÁÔI€HØ�}‰}˜Q  1 aÓ(×/Ñ/°·±¸µ
¸A¿G¹GÀA½JÈÈ1ÓM€HÜ�9Š9�dÐ%¨2Ô.€DØ˜ˆ?Ðr   )éd   g      @é   i'  N)Ngš™™™™™É?)Ú__doc__Ú
__future__r   Útypingr   r   r   r%   r/   rJ   rT   rŽ   rž   r¼   rÇ   r
   r   r   Ú<module>rÍ      s?   ðÙ Iå "ç "ã õõ&Iõõ*÷&G-õ^E÷Q'÷hr   