+
    „°ñj¼  ã                   óN   € R t ^ RIt^ RItR R ltR R ltR
R R lltR R	 ltR# )z˜Pure-numpy port of MediaPipe's face_geometry (FACE_LANDMARK_PIPELINE mode)
+ weighted Procrustes solver. Computes the 4x4 facial transformation matrix.
Nc                ó˜   € V ^8„  d   QhR\         P                  R\         P                  R\         P                  R\         P                  /# )é   ÚsrcÚtgtÚweightsÚreturn)ÚnpÚndarray)Úformats   "ÚHC:\Ai_Coding\apps\studio\ComfyUI\comfy_extras\mediapipe\face_geometry.pyÚ__annotate__r   
   s>   € ÷ ñ ¬B¯J©Jð ¼R¿Z¹Zð ÔRT×R\ÑR\ð Ôac×akÑakñ ó    c                ó¦  € \         P                  ! VP                  \         P                  4      4      p\	        V^,          P                  4       4      pV P                  \         P                  4      V,          pVP                  \         P                  4      V,          pWS,          V,          pV\         P                  ! Ws4      ,
          p\         P                  P                  WhP                  ,          RR7      w  ršpV	P                  4       VP                  P                  4       rÜ\         P                  P                  V4      \         P                  P                  V4      ,          ^ 8  d   VR;;,          R,          uu&   WÍP                  ,          p\	        W…,          P                  4       4      pVR8  d   \        R4      h\	        Wè,          V,          P                  4       4      V,          pVVWå,          ,          ,
          V,          V,          p\         P                  ! ^\         P                  R7      pVV,          VR&   VVR	&   V# )
u´   Weighted orthogonal Procrustes (similarity). Returns 4x4 M with
`target â‰ˆ M @ homogeneous(source)` in the weighted LS sense. fp64 for
SVD stability. Port of procrustes_solver.cc.T)Úfull_matricesgê-�™—q=z5Procrustes denominator collapsed (degenerate source).©Údtype©ºNNNr   ç      ð¿)ºNé   Nr   )r   r   )r   ÚsqrtÚastypeÚfloat64ÚfloatÚsumÚouterÚlinalgÚsvdÚTÚcopyÚdetÚ
ValueErrorÚeye)r   r   r   Úsqrt_wÚw_totalÚwsÚwtÚc_wÚcenteredÚUÚ_SÚVtÚpostÚpreÚRÚdenomÚscaleÚtranslationÚMs   &&&                r   Ú"_solve_weighted_orthogonal_problemr4   
   s‹  € ô �WŠW�W—^‘^¤B§J¡JÓ/Ó0€FÜ�V˜q•[×%Ñ%Ó'Ó(€GØ	�‰”B—J‘JÓ	 &Õ	(€BØ	�‰”B—J‘JÓ	 &Õ	(€Bà�;˜'Õ
!€CØ”B—H’H˜SÓ)Õ)€HÜ—	‘	—‘˜b§:¡:�o¸T�ÓB�I€Aˆ2à—‘“˜"Ÿ$™$Ÿ)™)›+ˆ#Ü	‡y�y‡}�}�TÓœRŸY™YŸ]™]¨3Ó/Õ/°!Ô3ØˆT�
�dÕ‹
Ø�u‰u�€Aä�8•=×%Ñ%Ó'Ó(€EØˆu„}ÜÐPÓQÐQÜ�1•< "Õ$×)Ñ)Ó+Ó,¨uÕ4€EØ˜ !¥&Õ)Õ)¨VÕ3°wÕ>€Kä
�ŠˆqœŸ
™
Ô#€AØ˜•	€A€f�IØ€A€e�HØ€Hr   c                ó„   € V ^8„  d   QhR\         P                  R\         P                  R\         P                  R\        /# )r   Ú	canonicalÚruntimer   r   ©r   r	   r   )r
   s   "r   r   r   (   s;   € ÷ iñ iœrŸz™zð i´B·J±Jð iÌÏÉð iÔX]ñ ir   c           	     ót   € \        \        P                  P                  \	        WV4      R,          4      4      # )uL   scale = â€–first column of M[:3]â€– per geometry_pipeline.cc::EstimateScale.)r   é    )r   r   r   Únormr4   )r6   r7   r   s   &&&r   Ú_estimate_scaler<   (   s)   € ä”—‘—‘Ô BÀ9ÐW^Ó _Ð`eÕ fÓgÓhÐhr   c                óè   € V ^8„  d   QhR\         P                  R\         P                  R\         P                  R\         P                  R\        R\        R\        R\        R	\         P                  /	# )
r   Úlandmarks_normalizedÚcanonical_verticesÚprocrustes_indicesÚprocrustes_weightsÚimage_widthÚimage_heightÚvertical_fov_degreesÚnearr   )r   r	   Úintr   )r
   s   "r   r   r   -   s�   € ÷ +nñ +nÜŸ*™*ð+näŸ
™
ð+nô Ÿ
™
ð+nô Ÿ
™
ð	+nô
 ð+nô ð+nô  ð+nô ð+nô ‡Z�Zñ+nr   c                ó,  aa€ RS,          \         P                  ! R\         P                  ! V4      ,          4      ,          pWH,          V,          p	VP                  \        P
                  4      p
W
,          P                  P                  \        P                  4      P                  4       pW,          P                  P                  \        P                  4      P                  4       pVP                  \        P                  4      pRV^,          ,
          V^&   V^ ,          V	,          RV	,          ,
          V^ &   V^,          V,          RV,          ,
          V^&   V^,          V	,          V^&   \        V^,          P                  4       4      oR VV3R llpVP                  4       pV^;;,          R,          uu&   \        WÏV4      p\        WÎ! VV4      V4      p\        WÎ! VVV,          4      V4      P                  \        P                  4      # )z¿4x4 facial transformation matrix via two-pass scale recovery
`landmarks_normalized` is (N, 3) in MediaPipe normalized convention: x, y
in [0,1] with TOP-LEFT origin, z in width-scaled units.
g       @g      à?ç      ð?c                ód   € V ^8„  d   QhR\         P                  R\        R\         P                  /# )r   Úsr1   r   r8   )r
   s   "r   r   Ú8solve_facial_transformation_matrix.<locals>.__annotate__L   s)   € ÷ ñ ”b—j‘jð ¬ð ´2·:±:ñ r   c                 ó   <€ V P                  4       p V ^,          S,
          S,           V,          V ^&   V ^ ;;,          V ^,          S,          ,          uu&   V ^;;,          V ^,          S,          ,          uu&   V ^;;,          R,          uu&   V # )r   r   )r    )rJ   r1   Údepth_offsetrE   s   &&€€r   Ú
_unprojectÚ6solve_facial_transformation_matrix.<locals>._unprojectL   sh   ø€ Ø�F‰F‹HˆØ�!•�|Õ# dÕ*¨eÕ3ˆˆ!‰Ø	ˆ!���!•�t•Õ‹Ø	ˆ!���!•�t•Õ‹Ø	ˆ!���‹Øˆr   r   )ÚmathÚtanÚradiansr   r   Úint64r   r   r    r   Úmeanr<   r4   Úfloat32)r>   r?   r@   rA   rB   rC   rD   rE   Úh_nearÚw_nearÚsubÚscreenÚcanonr   rN   ÚfirstÚs1Ús2rM   s   &&&&&&&f          @r   Ú"solve_facial_transformation_matrixr^   -   s�  ù€ ð  �4�Zœ$Ÿ(š( 3¬¯ªÐ6JÓ)KÕ#KÓLÕL€FØÕ! LÕ0€Fà
×
#Ñ
#¤B§H¡HÓ
-€CØ!Õ&×(Ñ(×/Ñ/´·
±
Ó;×@Ñ@ÓB€FØÕ#×%Ñ%×,Ñ,¬R¯Z©ZÓ8×=Ñ=Ó?€EØ ×'Ñ'¬¯
©
Ó3€Gð �f˜Q•i•€Fˆ1�IØ�q•	˜FÕ" S¨6¥\Õ1€Fˆ1�IØ�q•	˜FÕ" S¨6¥\Õ1€Fˆ1�IØ�q•	˜FÕ"€Fˆ1�IÜ˜ �Ÿ™Ó)Ó*€L÷ñ ð �K‰K‹M€EØ	ˆ!‡H�ÕƒHÜ	˜ wÓ	/€BÜ	˜ 
¨6°2Ó 6¸Ó	@€BÜ-¨e°ZÀÈÈRÍÓ5PÐRYÓZ×aÑaÔbd×blÑblÓmÐmr   c          
      óh   € V ^8„  d   QhR\         R\        R\        R\         R\        P                  /# )r   Ú	face_dictrB   rC   Úcanonical_datar   )ÚdictrF   r   r	   )r
   s   "r   r   r   [   s@   € ÷ ñ ´Dð Äsð ÔZ]ð Ôosð Ôxz÷  yCñ  yCñ r   c           	     ó&  € V R,          V R,          rT\         P                  ! VR,          P                  \         P                  4      \         P                  ! VP
                  ^ ,          ^34      .^R7      p\         P                  P                  WdP                  \         P                  4      RR7      vrx\        \         P                  P                  V^ ,          4      4      p	V	R8”  d	   W‘,          MRV,          p
\         P                  ! VP
                  ^ ,          ^3\         P                  R7      pVR,          V,          VR&   VR,          V,          VR&   VR,          V
,          VR&   \        W³R	,          VR
,          VR,          WR7      # )z½Adapt a FaceLandmarker face dict to MP's normalized convention and solve.
FaceMesh emits (x, y, z) in 192-canonical units; MP's geometry expects
z_norm = z_canonical * scale_x / image_widthÚlandmarks_xyÚlandmarks_3d)ÚaxisN)Úrcondg�íµ ÷Æ°>rH   r   r?   r@   rA   )rB   rC   )r   :Nr   N)r   r:   )r   é   r   )r   Úconcatenater   r   ÚonesÚshaper   Úlstsqr   r;   ÚemptyrU   r^   )r`   rB   rC   ra   Úlmks_xyÚlmks_3dÚaugr3   Ú_Úscale_xÚz_scaleÚ
normalizeds   &&&&        r   Ú$transformation_matrix_from_detectionru   [   s1  € ð
 ! Õ0°)¸NÕ2KˆWÜ
�.Š.˜' %�.×/Ñ/´·
±
Ó;¼R¿WºWÀgÇmÁmÐTUÕFVÐXYÐEZÓ=[Ð\ÐcdÔ
e€CÜ�I‰I�O‰O˜C§¡´·
±
Ó!;À4ˆOÓH€E€AÜ”B—I‘I—N‘N 1 Q¥4Ó(Ó)€GØ'.°¤~ˆgÖ#¸3ÀÕ;L€Gä—’˜7Ÿ=™=¨Õ+¨QÐ/´r·z±zÔB€JØ˜t•} {Õ2€JˆtÑØ˜t•} |Õ3€JˆtÑØ˜t•} wÕ.€JˆtÑÜ-ØÐ#7Õ8ØÐ+Õ,¨nÐ=QÕ.RØôð r   )g     €O@rH   )Ú__doc__rP   Únumpyr   r4   r<   r^   ru   © r   r   Ú<module>ry      s)   ðñó
 Û õõ<i÷
+n÷\r   