+
    …°ñjU  ã                   óB  € ^ RI t ^ RIHtHtHtHtHt ^ RIt^ RIH	u H
t ^ RIt^ RIHt ^ RIHt ^ RIHt ^ RIt^ RIt^ RIHt R R ltR	 R
 lt^@tR R ltR R ltR R ltR!R R lltRR]3R R lltR R lt R R lt!R R lt"R"R R llt#R#R R llt$R R  lt%R# )$é    N)ÚAnyÚDictÚListÚOptionalÚTuple)Úprepare_batch)Úunpack_masks)Ú	SAM3DBody)Útqdmc                óX   € V ^8„  d   QhR\         P                  R\         P                  /# )é   ÚmaskÚreturn©ÚtorchÚTensor)Úformats   "ÚAC:\Ai_Coding\apps\studio\ComfyUI\comfy_extras\sam3d_body\utils.pyÚ__annotate__r      s&   € ÷ Iñ Iœ%Ÿ,™,ð I¬5¯<©<ñ Ió    c           
     ó.  € V P                  4       ^8X  d
   V R,          MT pV^ 8„  pVP                  \        P                  4      R,          p\        P
                  ! V) ^^^R7      ) pVR,          R8„  p\        P                  ! VP                  4       WR4      pVP                  w  rx\        P                  ! W†P                  R7      p	\        P                  ! WvP                  R7      p
VP                  ^ R7      pVP                  ^R7      p\        P                  ! \        P                  ! W¹V4      P                  4       \        P                  ! WÊV4      P                  4       \        P                  ! W¹^,           ^ 4      P                  4       \        P                  ! WÊ^,           ^ 4      P                  4       .4      pVP                  ^ ^ W‡.4      p\        P                  ! VP                  4       WÞ4      P                  \        P                  4      # )zAxyxy bounds of a binary mask, with sub-5px speckles filtered out.)Úkernel_sizeÚstrideÚpaddingç      à?©Údevice©Údim).r   ©NN)r   r   )r   Útor   Úfloat32ÚFÚ
max_pool2dÚwhereÚanyÚshapeÚaranger   ÚstackÚaminÚamaxÚ
new_tensor)r   ÚmÚm_boolÚtÚerodedÚeroded_maskÚkeepÚHÚWÚxsÚysÚcolsÚrowsÚbboxÚ
full_frames   &              r   Ú_bbox_from_maskr;      sw  € àŸ™›
 aœˆˆVŽ¨T€AØ�‰U€FØ�	‰	”%—-‘-Ó  Õ,€AÜ�lŠl˜A˜2¨1°QÀÔBÐB€FØ˜•, Ñ$€KÜ�;Š;�{—‘Ó(¨+Ó>€Dà�:‰:�D€AÜ	�Š�a§¡Ô	,€BÜ	�Š�a§¡Ô	,€BØ�8‰8˜ˆ8‹?€DØ�8‰8˜ˆ8‹?€DÜ�;Š;Ü�Š�D˜aÓ ×%Ñ%Ó'Ü�Š�D˜aÓ ×%Ñ%Ó'Ü�Š�D˜q�& !Ó$×)Ñ)Ó+Ü�Š�D˜q�& !Ó$×)Ñ)Ó+ð	ó €Dð —‘ ! Q¨ Ó.€JÜ�;Š;�v—z‘z“| TÓ6×9Ñ9¼%¿-¹-ÓHÐHr   c                ó<   € V ^8„  d   QhR\         R\         R\         /# )r   ÚBr3   r4   )Úint)r   s   "r   r   r   )   s!   € ÷ -ñ -¬#ð -´#ð -¼#ñ -r   c           	     ó   € \        V \        4      '       d   V P                  R4      MRpVf   R	# VP                  ^ ,          VP                  ^,          reWQ8w  g   V^ 8X  d   R	# \        P
                  P                  4       p\        VP                  V4      4      pVP                  ^,          VP                  ^,          r©\        P                  ! VP                  4       P                  WV,          ^Wš4      W#3RRR7      pVR8„  P                  \        P                  4      P                  WVW#4      pVP                  4       p\!        V4       Uu. uF  qíVRRRR3,          P#                  4       NK   	  pp. p\!        V4       Fp  p. p\!        V4       F5  p\%        WÎV3,          4      pVP'                  VP                  4       4       K7  	  VP'                  \        P(                  ! V^ R7      4       Kr  	  VV3# u upi )
z�Unpack SAM3_TRACK_DATA into per-frame per-object bboxes + masks at image
resolution. Returns (None, None) on empty track / frame-count mismatch.Úpacked_masksNÚbilinearF)ÚsizeÚmodeÚalign_cornersr   ºNNNr   r    )Ú
isinstanceÚdictÚgetr'   ÚcomfyÚmodel_managementÚget_torch_devicer	   r!   r#   ÚinterpolateÚfloatÚreshaper   Úuint8ÚcpuÚrangeÚ
contiguousr;   Úappendr)   )Ú
track_datar=   r3   r4   ÚpackedÚNÚKr   ÚunpackedÚHmÚWmÚresizedÚarr_gpuÚarrÚfÚper_frame_masksÚper_frame_bboxesÚderivedÚkÚbs   &&&&                r   Úinputs_from_sam3_trackrd   )   sž  € ô 0:¸*Äd×/KÒ/KˆZ�^‰^˜NÔ+ÐQU€FØ‚~ØÐØ�<‰<˜�?˜FŸL™L¨�O€qØ„v��a”ØÐä×#Ñ#×4Ñ4Ó6€FÜ˜FŸI™I fÓ-Ó.€HØ�^‰^˜AÕ §¡¨qÕ 1ˆÜ�mŠmØ�‰Ó× Ñ  ¥¨¨2Ó2ØˆV˜*°Eô€Gð ˜‰}× Ñ ¤§¡Ó-×5Ñ5°a¸AÓA€GØ
�+‰+‹-€CäCHÈÄ8ÓLÁ8¸a˜1˜a  A tÐ+Õ,×7Ñ7Ö9Á8€OÐLØÐÜ�1ŽXˆØˆÜ�q–ˆAä ¨1¨¥Ó.ˆAØ�N‰N˜1Ÿ5™5›7Ö#ñ ð 	×Ñ¤§¢¨G¸Ô ;Ö<ñ ð ˜_Ð,Ð,ùò Ms   Å$G;c          
      óh   € V ^8„  d   QhR\         R\         R\         R\         R\        P                  /# )r   ÚwÚxÚyÚzr   ©rM   ÚnpÚndarray)r   s   "r   r   r   N   s3   € ÷ ñ œð ¤5ð ¬Uð ´uð ÄÇÁñ r   c                ó@  € \         P                  ! W ,          W,          ,           W",          ,           W3,          ,           4      ;'       g    RpW,          W,          W$,          W4,          3w  rr#\        P                  ! ^^W",          W3,          ,           ,          ,
          ^W,          W,          ,
          ,          ^W,          W,          ,           ,          .^W,          W,          ,           ,          ^^W,          W3,          ,           ,          ,
          ^W#,          W,          ,
          ,          .^W,          W,          ,
          ,          ^W#,          W,          ,           ,          ^^W,          W",          ,           ,          ,
          ..\        P                  R7      # )zD(3,3) rotation from a wxyz quaternion; columns are the rotated axes.ç      ð?©Údtype)ÚmathÚsqrtrk   Úarrayr"   )rf   rg   rh   ri   Úns   &&&& r   Ú_quat_to_mat_wxyzru   N   s	  € ä�	Š	�!•%˜!�%•- !¥%Õ'¨!­%Õ/Ó0×7Ð7°C€AØ•˜�˜q�u a¥eÐ+�J€Aˆ!Ü�8Š8Ø	
ˆQ�!•%˜!�%•-Õ Õ	  ! q¥u¨q­u¥}Õ"5°q¸A½EÀAÅE½MÕ7JÐKØ	
ˆa�e�a•e�mÕ	˜a ! q¥u¨q­u¥}Õ"5Õ5°q¸A½EÀAÅE½MÕ7JÐKØ	
ˆa�e�a•e�mÕ	˜a 1¥5¨1­5¥=Õ1°1°q¸A½EÀAÅE½MÕ7JÕ3JÐKðô �Z‰Zô	ð r   c          	      ór   € V ^8„  d   QhR\         R\         R\        R\        \        P                  ,          /# )r   ÚheightÚwidthÚfov_degreesr   )r>   rM   r   r   r   )r   s   "r   r   r   Y   s1   € ÷ ñ œSð ¬ð ¼5ð ÄXÌeÏlÉlÕE[ñ r   c                ó  € V^ 8:  d   R# V R\         P                  ! \         P                  ! V4      R,          4      ,          ,          p\        P                  ! VRVR,          .RW0R,          .. RO..\        P
                  R7      # )zÏ(1,3,3) intrinsic matrix from a vertical FOV in degrees. Matches MoGe2's
convention (vertical focal for both axes). Returns None for fov<=0 so the
caller falls back to prepare_batch's diagonal-focal default.Nç       @ç        ro   )r|   r|   rn   )rq   ÚtanÚradiansr   Útensorr"   )rw   rx   ry   Úfocals   &&& r   Úcam_int_from_fovr�   Y   sv   € ð �aÔÙØ�cœDŸHšH¤T§\¢\°+Ó%>ÀÕ%DÓEÕEÕF€EÜ�<Š<Ø�#�u˜s•{Ð
#Ø� •|Ð
$Ú
ð
ð 	ô �m‰mô	ð r   c                óº   € V ^8„  d   QhR\         \        \        3,          R\         \        \        3,          R\        R\        R\         \        \        3,          /# )r   Úmhr_pose_dataÚcamera_infor3   r4   r   )r   Ústrr   r>   )r   s   "r   r   r   h   sR   € ÷ yñ y¬¬c´3¨h­ð yÄdÌ3ÔPSÈ8Ånð yÜ ðyÜ%(ðyÜ-1´#´s°(­^ñyr   c                ó8  € V R,          '       d   V R,          ^ ,          M. pV'       g   V # . . reV FÓ  pVP                  R4      pVf   K  \        P                  ! V\        P                  R7      P	                  ^4      pVP                  V4       VP                  R4      p	TP                  V	eN   \        P                  ! V	\        P                  R7      P	                  R$^4      P                  ^ R7      V,           MT4       KÕ  	  V'       g   V # \        P                  ! \        P                  ! V^ R7      ^ R7      p
\        P                  ! \        P                  ! V^ R7      ^ R7      pVP                  R4      ;'       g    / pVP                  R4      ;'       g    / p\        P                  ! \        VP                  R	R
4      4      \        VP                  RR4      4      ) \        VP                  RR
4      4      ) .\        P                  R7      p\        P                  ! \        VP                  R	R
4      4      \        VP                  RR
4      4      ) \        VP                  RR
4      4      ) .\        P                  R7      pWï,
          p\        \        P                  P                  V4      4      R8¬  pVP                  R4      pV'       g   V'       g   V # \        VP                  RR4      4      ;'       g    Rp\        \        P                  P                  V4      4      R8  d   TpMW¯,           pV'       d»   R pR p\        \        VP                  RR4      4      \        VP                  R	R
4      4      \        VP                  RR
4      4      \        VP                  RR
4      4      4      pV! V! VR%,          4      4      pV! V! VR&,          ) 4      4      pV! V! VR',          ) 4      4      pMäV) \        \        P                  P                  V4      4      ,          p\        P                  ! V\        P                  ! . R)O\        P                  R7      4      p\        \        P                  P                  V4      4      pVR8”  d
   VV,          M'\        P                  ! . R*O\        P                  R7      p\        P                  ! VV4      p\        P                  ! VVV.^ R7      P                  \        P                  4      pV'       d   VV\        RV4      ,          ,           pM=\        R\        V^,          4      4      pVVV\        RV4      ,          ,          ,
          p\        VP                  RR
4      ;'       g    R
4      pV^ 8”  dS   \        V4      R\        \        P                   ! \        P"                  ! V4      R,          4      4      ,          ,          p M²V^ ,          P                  R4      p!V!eF   \        \        P                  ! V!\        P                  R7      P	                  R$4      ^ ,          4      MP\        V4      R\        \        P                   ! \        P"                  ! R4      R,          4      4      ,          ,          p \        P                  ! VR,          VR,          .\        P                  R7      p"RRRR/p#V P                  R 4      p$V$RJ;'       d!    \%        V$P                  R!R"4      4      '       * p%. p&V R,           EFÐ  p'. p(V' EF²  p\'        V4      pVP                  R4      pVf   V(P                  V4       K7  \        P                  ! V\        P                  R7      P	                  ^4      pR+ Fí  p)VP                  V)4      p	V	f   K  \        P                  ! V	\        P                  R7      V,           V,
          VP(                  ,          p*V*P                  \        P                  4      VV)&   V)V#9   g   KŠ  \        P*                  ! V*R,,          R4      p+V*R-,          V ,          V+,          V",           P                  \        P                  4      VV#V),          &   Kï  	  VP                  R#4      p,V,eÜ   \        P                  ! V,\        P                  R7      P-                  4       p,V%'       d+   V,R.;;,          R(,          uu&   V,R/;;,          R(,          uu&   V,V,           V,
          VP(                  ,          p,V%'       d+   V,R.;;,          R(,          uu&   V,R/;;,          R(,          uu&   V,P                  \        P                  4      VR#&   \        P.                  ! ^\        P                  R7      VR&   \        P                  ! V \        P                  R7      VR&   V(P                  V4       EKµ  	  V&P                  V(4       EKÓ  	  \'        V 4      p-V&V-R&   V-# )0z¡Re-project every frame's pose through a Load3D 6DOF camera (position/
target/zoom + optional FOV). Returns a new mhr_pose_data, unchanged on
empty/invalid input.ÚframesÚ
pred_cam_tNro   Úpred_vertices©ÚaxisÚpositionÚtargetrg   r|   rh   g      @ri   ç�íµ ÷Æ°>Ú
quaternionÚzoomrn   c                 ó‚   € \         P                  ! V ^ ,          V ^,          ) V ^,          ) .\         P                  R7      # )r   ro   )rk   rs   r"   ©Úvs   &r   Ú<lambda>Ú'apply_camera_override.<locals>.<lambda>“   s*   € ”r—x’x  1¥¨¨!­ u¨q°­t¨eÐ 4¼B¿J¹JÕGr   c           	      ót   € V \        R \        \        P                  P	                  V 4      4      4      ,          # )rŽ   )ÚmaxrM   rk   ÚlinalgÚnormr’   s   &r   r”   r•   ”   s"   € ˜œS ¤u¬R¯Y©Y¯^©^¸AÓ->Ó'?Ó@Ö@r   rf   g{®Gáz„?gš™™™™™¹?Úfovr{   Úfocal_lengthg      I@r   Úpred_keypoints_3dÚpred_keypoints_2dÚpred_face_keypoints_3dÚpred_face_keypoints_2dÚ_skeleton_overrideÚper_frame_y_downFÚpred_joint_coordséÿÿÿÿ©rE   r   ©rE   é   ©rE   r   ç      ð¿)r|   r¨   r|   )rn   r|   r|   )rœ   r‰   rž   ).:r   é   N).:Nr   N).r¦   ).r   )rH   rk   Úasarrayr"   rN   rS   Úmeanr)   rs   rM   r˜   r™   ru   ÚcrossÚastyper—   r}   Údeg2radÚboolrG   ÚTÚmaximumÚcopyÚzeros).rƒ   r„   r3   r4   Úfirst_frameÚrootsÚ	centroidsÚpÚcam_tr“   Ú	subj_rootÚsubj_centroidÚposÚtgtÚpos_vÚtgt_vÚoffsetÚ
has_offsetÚqr�   r�   Úmvr™   ÚRcÚx_axisÚy_axisÚz_axisÚx_normÚRÚeyeÚdÚcam_fovÚ	new_focalÚf0ÚcenterÚreprojÚoverrideÚjoints_y_upÚ
new_framesÚframeÚscaledrb   Úcamri   ÚjcÚouts.   &&&&                                          r   Úapply_camera_overriderØ   h   s^  € ð
 1>¸h×0GÔ0G�- Õ)¨!Ö,ÈR€KßØÐà˜2ˆ9ÛˆØ—‘�lÓ#ˆØŠ=ÙÜ—
’
˜5¬¯
©
Ô3×;Ñ;¸AÓ>ˆØ�‰�UÔØ�E‰E�/Ó"ˆØ×ÑØšMô Ÿš A¬R¯Z©ZÔ8×@Ñ@ÀÀQÓG×LÑLÐRSÐLÓTÐW\Ö\Ø/4ö	6ñ ÷ ØÐÜ—’œŸš ¨QÔ/°aÔ8€IÜ—G’GœBŸHšH Y°QÔ7¸aÔ@€Mð �/‰/˜*Ó
%×
+Ð
+¨€CØ
�/‰/˜(Ó
#×
)Ð
) r€CÜ�HŠH”e˜CŸG™G C¨Ó-Ó.´°s·w±w¸sÀCÓ7HÓ1IÐ0IÌEÐRU×RYÑRYÐZ]Ð_bÓRcÓLdÐKdÐeÔmo×mwÑmwÔx€EÜ�HŠH”e˜CŸG™G C¨Ó-Ó.´°s·w±w¸sÀCÓ7HÓ1IÐ0IÌEÐRU×RYÑRYÐZ]Ð_bÓRcÓLdÐKdÐeÔmo×mwÑmwÔx€EØ�]€FÜ”r—y‘y—~‘~ fÓ-Ó.°$Ñ6€JØ�‰˜Ó%€AßŸaØÐä�—‘ ¨Ó-Ó.×5Ð5°#€DäŒR�Y‰Y�^‰^˜EÓ"Ó# dÔ*Ø‰àÕ"ˆçÙGˆÙ@ˆÜÜ�!—%‘%˜˜S“/Ó"¤E¨!¯%©%°°S«/Ó$:Ü�!—%‘%˜˜S“/Ó"¤E¨!¯%©%°°S«/Ó$:ó
ˆñ ‘b˜˜D�“lÓ#ˆÙ‘b˜"˜T�(˜“mÓ$ˆÙ‘b˜"˜T�(˜“mÓ$‰ð �œ5¤§¡§¡°Ó!7Ó8Õ8ˆÜ—’˜&¤"§(¢(Ò+;Ä2Ç:Á:Ô"NÓOˆÜ”r—y‘y—~‘~ fÓ-Ó.ˆØ$*¨T¤M�˜&–´r·x²xÂÔWY×WaÑWaÔ7bˆÜ—’˜& &Ó)ˆÜ
�Š�&˜& &Ð)°Ô2×9Ñ9¼"¿*¹*ÓE€A÷ Ø�v¤ D¨$£Õ/Õ/‰ä�”U˜6 !�9Ó%Ó&ˆØ�v ¤S¨¨t£_Õ!4Õ5Õ5ˆô �K—O‘O E¨3Ó/×6Ð6°3Ó7€GØ�„{Ü˜!“H ¤e¬B¯FªF´2·:²:¸gÓ3FÈÕ3LÓ,MÓ&NÕ NÕO‰	à˜�^×Ñ Ó/ˆØOQÊ~”Uœ2Ÿ:š: b´·
±
Ô;×CÑCÀBÓGÈÕJÔKÜ ›( c¬E´"·&²&¼¿ºÀDÓ9IÈCÕ9OÓ2PÓ,QÕ&QÕRð 	ô �XŠX�q˜3•w  C¥Ð(´·
±
Ô;€FØ!Ð#6Ð8PÐRjÐk€Fð × Ñ Ð!5Ó6€HØ $Ð&×\Ð\¬t°H·L±LÐASÐUZÓ4[Ó/\Ô+\€KØ-/€JØ˜x×(Ñ(ˆØˆÜˆAÜ�Q“ˆAØ—E‘E˜,Ó'ˆEØŠ}Ø—‘˜aÔ ÙÜ—J’J˜u¬B¯J©JÔ7×?Ñ?ÀÓBˆEÛU�Ø—E‘E˜!“H�Ø’9ÙÜ—z’z !¬2¯:©:Ô6¸Õ>ÀÕDÈÏÉÕK�Ø—z‘z¤"§*¡*Ó-��!‘Ø˜–;ÜŸ
š
 3 x¥=°$Ó7�AØ$'¨¥L°9Õ$<¸qÕ$@À6Õ$I×#QÑ#QÔRT×R\ÑR\Ó#]�A�f˜Q•i“Lñ Vð —‘Ð*Ó+ˆBØŠ~Ü—Z’Z ¬"¯*©*Ô5×:Ñ:Ó<�ßØ�v—J $Õ&“JØ�v—J $Õ&“JØ˜5•j 3Õ&¨!¯#©#Õ-�ßØ�v—J $Õ&“JØ�v—J $Õ&“JØ)+¯©´2·:±:Ó)>�Ð%Ñ&Ü Ÿhšh q´·
±
Ô;ˆAˆl‰OÜ "§¢¨¼"¿*¹*Ô EˆAˆnÑØ�M‰M˜!×ñ; ð< 	×Ñ˜&×!ñA )ôB ˆ}Ó
€CØ€Cˆ�MØ€Jr   c                ó²  € V ^8„  d   QhR\         R\        \        P                  ,          R\        \        P                  ,          R\        \        \        P                  ,          ,          R\
        \        \        3,          R\        R\        R\        \        P                  ,          R	\        \        \        \        \        3,          ,          ,          /	# )
r   ÚinnerÚ
frames_rgbÚper_frame_boxesr_   Ú
image_sizeÚinference_typerW   Úcam_intr   )
r
   r   r   r   r   r   r>   r…   r   r   )r   s   "r   r   r   ä   s£   € ÷ \ñ \¤Ið \¼4ÄÇÁÕ;Mð \Ô`dÔej×eqÑeqÕ`rð \Üœd¤5§<¡<Õ0Õ1ð\Ü?DÄSÌ#ÀX½ð\Ü`cð\Ühkð\ä”e—l‘lÕ#ð\ä/3´D¼¼cÄ3¸h½Õ4HÕ/Iñ\r   c           	     óÐ	  € \        V4      pW†,          p	\        P                  ! \        V4       U
Uu. uF$  p
\        V4       F  q²V
,          V,          NK  	  K&  	  upp
^ R7      p\        V4       U
Uu. uF  p
\        V4       F  qÑV
,          NK  	  K  	  pp
pVe¿   . p\        V4       Fn  p
W:,          pVP                  ^ ,          ^8X  d   V^8”  d   VP                  V^ R7      pTP                  \        V4       Uu. uF  pVV,          NK  	  up4       Kp  	  \        P                  ! V^ R7      p\        P                  ! V	\        P                  R7      pMRpRp\        WìVVVVR7      p\        P                  P                  4       pVP                  4        UUu/ uF:  w  ppT\        V\        P                  4      '       d   VP!                  V4      MTbK<  	  pppV P#                  VVVRR7      pVR8X  d
   Vw  ppp pMTpR;ppVR,          P                  4        UUu/ uFB  w  ppVf   K  VR	8w  g   K  VVP%                  4       P'                  4       P)                  4       bKD  	  pppVR
,          ^ ,          P'                  4       P)                  4       pR;ppVR8X  d   Ve   Ve   \+        V4      p\+        V4      p?????. p\        V4       EFé  p
. p\        V4       EFÂ  pW¦,          V,           p / R
VV ,          bRVR,          V ,          bRVR,          V ,          bRVR,          V ,          bRVR,          V ,          bRVR,          V ,          bRVR,          V ,          bRVR,          V ,          bRVR,          V ,          bRVR,          V ,          bRVR,          V ,          bRVR,          V ,          bRVR,          V ,          bRVe=   W:,          P                  ^ ,          ^8”  d   W:,          V,          MW:,          ^ ,          MRbRVR,          V ,          bRVR,          V ,          bR VR ,          V ,          bR!R!V9   d   VR!,          V ,          MRR"R"V9   d   VR",          V ,          MR/Cp!Ve   VV ,          V!R#&   VV ,          V!R$&   VP-                  V!4       EKÅ  	  VP-                  V4       EKì  	  V# u upp
i u upp
i u upi u uppi u uppi )%zBRun a SINGLE chunk of frames through run_inference in one forward.r   Nro   )Ú
input_sizeÚmasksÚmasks_scorerß   gffffffö?)rÞ   Úthresh_wrist_angleÚfullÚmhrÚfacesr9   r›   rœ   r�   r‰   rˆ   Úpred_pose_rawÚ
global_rotÚbody_pose_paramsÚ	body_poseÚhand_pose_paramsÚhandÚscale_paramsÚscaleÚshape_paramsr'   Úexpr_paramsÚfacer   r¢   Úpred_global_rotsÚjoint_global_rotsÚmhr_model_paramsrž   rŸ   Ú
lhand_bboxÚ
rhand_bbox)Úlenr   r)   rQ   r'   Úrepeat_interleaveÚextendÚonesr"   r   rI   rJ   rK   ÚitemsrF   r   r!   Úrun_inferencerM   rP   ÚnumpyÚ_bboxes_from_center_scalerS   )"rÚ   rÛ   rÜ   r_   rÝ   rÞ   rW   rß   rV   Útotalr^   rb   Úboxes_stackedÚ_Úimg_per_cropÚ
flat_masksÚmfÚmasks_stackedrã   Úbatchr   r“   ÚoutputsÚpose_outputÚbatch_lhandÚbatch_rhandr×   Úbatch_bbox_cpuÚlhand_bboxesÚrhand_bboxesÚ
frames_outÚpersonsÚidxr·   s"   &&&&&&&&                          r   Úrun_batched_single_chunkr  ä   sÿ  € ô 	ˆJ‹€AØ�E€Eä—K’KÜ(-¨a¬ÔC© 1¼%À¾(°Q˜Õ	˜A×	Ð	¹(Ñ	©ÒCÈô€Mô ,1°¬8ÔF©8 a¼UÀ1¾X¸˜q—M�M¹X‘M©8€LÑFàÒ"àˆ
Ü�q–ˆAØ Õ#ˆBØ�x‰x˜�{˜aÔ A¨¤EØ×)Ñ)¨!°Ð)Ó3�Ø×Ñ¬e°A¬hÓ7©h¨˜r !Ÿu˜u©hÑ7Ö8ñ	 ô
 Ÿš J°AÔ6ˆÜ—j’j ¬e¯m©mÔ<‰àˆØˆäØØØ¨¸gô€Eô
 ×#Ñ#×4Ñ4Ó6€FØOTÏ{É{Ì}Ô]É}ÁtÀqÈ!ˆQ¤
¨1¬e¯l©l× ;Ò ;�—‘�V”ÀÒBÉ}€EÑ]à×!Ñ!ØØØ%Øð	 "ó €Gð ˜ÔØ6=Ñ3ˆ�[ +¨q±!àˆØ$(Ð(ˆ�kà2=¸eÕ2D×2JÑ2JÔ2Lô .Ñ2L©$¨!¨QØô &Ø ! W¡ô &ˆ1ˆa�g‰g‹i�m‰m‹o×#Ñ#Ó%Ò%Ñ2L€Cñ .ð ˜6•] 1Õ%×)Ñ)Ó+×1Ñ1Ó3€NØ"&Ð&€L�<Ø˜Ô KÒ$;ÀÒ@WÜ0°Ó=ˆÜ0°Ó=ˆà�U˜K¨°gà-/€JÜ�1�XˆØ(*ˆÜ�q—ˆAØ•%˜!•)ˆCð!Ø˜ sÕ+ð!à  NÕ 3°CÕ 8ð!ð $ SÐ)<Õ%=¸cÕ%Bð!ð $ SÐ)<Õ%=¸cÕ%Bð	!ð
    _Õ!5°cÕ!:ð!ð ˜c ,Õ/°Õ4ð!ð    _Õ!5°cÕ!:ð!ð ˜c ,Õ/°Õ4ð!ð # C¨Õ$4°SÕ$9ð!ð # C¨¥K°Õ$4ð!ð   G¥¨SÕ 1ð!ð   G¥¨SÕ 1ð!ð ˜s 6�{¨3Õ/ð!ð Ø*Ò6ð 3BÕ2D×2JÑ2JÈ1Õ2MÐPQÔ2Q˜Õ+¨AÖ.ÐWfÕWiÐjkÖWlØ<@ð!ð  $ SÐ)<Õ%=¸cÕ%Bð!!ð" # CÐ(;Õ$<¸SÕ$Að#!ð$ # CÐ(:Õ$;¸CÕ$@ð%!ð( )ÐPhÐloÔPo¨#Ð.FÕ*GÈÖ*LÐuyØ(ÐPhÐloÔPo¨#Ð.FÕ*GÈÖ*LÐuyñ+!ˆAð. Ò'Ø".¨sÕ"3��,‘Ø".¨sÕ"3��,‘Ø�N‰N˜1×ñ9 ð: 	×Ñ˜'×"ñ? ð@ Ðùói 	DùãFùò 8ùó ^ùó.s*   ²*S
Á4#SÄ S
Æ!A SÈ)	S"È7S"É 1S"c                óü  € V ^8„  d   QhR\         R\        \        P                  ,          R\        \        P                  ,          R\        \        \        P                  ,          ,          R\
        \        \        3,          R\        R\        \        P                  ,          R\        \        P                  P                  ,          R	\        R
\        \        \        \        \        3,          ,          ,          /
# )r   rÚ   rÛ   rÜ   r_   rÝ   rÞ   rß   ÚpbarÚcrops_per_chunkr   )r
   r   r   r   r   r   r>   r…   rI   ÚutilsÚProgressBarr   r   )r   s   "r   r   r   C  s¾   € ÷ )ñ )Üð)ä”U—\‘\Õ"ð)ô œ%Ÿ,™,Õ'ð)ô œd¤5§<¡<Õ0Õ1ð	)ô
 ”cœ3�h•ð)ô ð)ô ”e—l‘lÕ#ð)ô ”5—;‘;×*Ñ*Õ
+ð)ô ð)ô 
Œ$Œt”Cœ�H�~Õ
Õñ)r   c	                óš  € \        V4      p	V	^ 8”  g   Q R4       hV U
u0 uF  p
\        V
4      kK  	  pp
\        V4      ^8X  g   Q RV 24       hVP                  4       pV^8¼  g   Q R4       h\        ^WŒ,          4      p. p\        V	RR7      ;_uu_ 4       p\	        ^ W�4       F„  p\        V	VV,           4      pVVV pVVV pVf   RMVVV p\        V VVVWEVVR7      pVP                  V4       VP                  VV,
          4       Vf   Kl  VP                  VV,
          4       K†  	  RRR4       V# u up
i   + '       g   i     T# ; i)u  Run the clip through chunked batched run_inference calls.

Supports K persons per frame (K must be the same across frames â€” padded
externally). Splits frames into chunks so chunk_frames * K <= budget; each
chunk is one body forward + optional hand forwards over its person-crops
zempty frame listz5batched path requires same bbox count per frame, got z need at least one bbox per framezSAM3D body inference)r   ÚdescN)rß   )	rø   Úpopr—   r   rQ   Úminr  rú   Úupdate)rÚ   rÛ   rÜ   r_   rÝ   rÞ   rß   r  r  rV   rc   ÚK_setrW   Úchunk_framesÚresultsr/   ÚstartÚendÚ
sub_framesÚ	sub_boxesÚ	sub_masksÚchunk_results   &&&&&&&&&             r   Úrun_batched_framesr&  C  sU  € ô" 	ˆJ‹€AØˆqŒ5Ð$Ð$Ó$ˆ5Ù,Ó-™_˜ŒS�ŽV™_€EÐ-Üˆu‹:˜Œ?Ð[ÐSÐTYÐSZÐ[Ó[ˆ?Ø�	‰	‹€AØ�Œ6Ð5Ð5Ó5ˆ6ä�q˜/Õ.Ó/€LØ*,€GÜ	�AÐ2×	3Õ	3°qÜ˜1˜aÖ.ˆEÜ�a˜ Õ-Ó.ˆCØ# E¨#Ð.ˆJØ'¨¨cÐ2ˆIØ /Ò 7™¸_ÈUÐSVÐ=WˆIÜ3Ø�z 9¨iØ¨AØôˆLð
 �N‰N˜<Ô(Ø�H‰H�S˜5•[Ô!ØÔØ—‘˜C %�KÖ(ñ /÷ 
4ð €Nùò- .÷ 
4Ö	3ð €Nús   žD4ÂA4D9ÄD9Ä9E
	c                ó8   € V ^8„  d   QhR\         P                  /# ©r   r   ©rk   rl   )r   s   "r   r   r   o  s   € ÷ bñ b¬¯
©
ñ br   c                 ó  € V R ,          P                  ^ ^4      pV R,          P                  ^ ^4      R,          p\        P                  ! W,
          W,           .^R7      P                  4       P	                  4       P                  4       # )Úbbox_centerÚ
bbox_scaler   r   )Úflattenr   ÚcatrM   rP   rþ   )r  ÚcentersÚhalf_scaless   &  r   rÿ   rÿ   o  sl   € Ø�MÕ"×*Ñ*¨1¨aÓ0€GØ˜Õ%×-Ñ-¨a°Ó3°cÕ9€KÜ�9Š9�gÕ+¨WÕ-BÐCÈÔK×QÑQÓS×WÑWÓY×_Ñ_ÓaÐar   c                óX   € V ^8„  d   QhR\         P                  R\         P                  /# )r   Úimager   r   )r   s   "r   r   r   v  s&   € ÷ Qñ Qœ%Ÿ,™,ð Q¬5¯<©<ñ Qr   c                ór   € V R,          P                  RR4      P                  \        P                  RR7      # )uQ   ComfyUI image tensor (any shape, float 0..1) â†’ uint8 tensor in [0, 255] on CPU.g     ào@r|   rP   )rp   r   )Úclampr!   r   rO   )r2  s   &r   Úimage_to_uint8r5  v  s-   € à�E�M× Ñ   eÓ,×/Ñ/´e·k±kÈ%Ð/ÓPÐPr   c                óZ   € V ^8„  d   QhR\         \        \        P                  3,          /# r(  )r   r…   rk   rl   )r   s   "r   r   r   {  s    € ÷ #ñ #¤t¬C´·±¨OÕ'<ñ #r   c           
     óð  € V P                   P                  4       P                  4       P                  4       P	                  4       pV P                   P                  4       pWR,          ,          pWR,          ,          pWR,          ,          p\        P                  ! WC,
          WS,
          4      P                  \        P                  4      p\        P                  ! V\        P                  R7      p\        P                  P                  WrR,          V4       \        P                  P                  WrR,          V4       \        P                  P                  WrR,          V4       \        P                  P                  V^RR7      pRWˆR8  &   Wx,          pVR,           R,          P                  \        P                  4      p	\        V 4      p
VR,          R8„  \        P                   ! VR,          4      R8  ,          pV P                   P"                  P%                  4       P                  4       P                  4       P	                  4       pR	VP                  \        P                  4      R
V	RV
RVRV/# )z¶Canonical rest-pose data for shader color lookups: positions (Nv,3),
norm (Nv,3 in [0,1]), face_mask, head_mask, and face_region_rgb
(per-region painted color from the .safetensors).ro   T)r‹   Úkeepdimsrn   g:Œ0âŽyE>r   gáz®Gáö?ç)\�Âõ(¼?Ú	positionsr™   Ú	face_maskÚ	head_maskÚface_region_rgbr¤   r¥   r§   )Ú	head_poseÚcanonical_verticesrM   rP   rþ   Úfaces_nprk   r¬   r­   r"   Ú
zeros_likeÚaddÚatr˜   r™   Ú_compute_face_maskÚabsr=  Údetach)ÚmodelÚvertsrç   Úv0Úv1Úv2ÚfnÚvnÚlnÚnorm_mapr;  r<  r=  s   &            r   Úcompute_canonical_colorsrP  {  s¿  € ð �O‰O×.Ñ.Ó0×6Ñ6Ó8×<Ñ<Ó>×DÑDÓF€EØ�O‰O×$Ñ$Ó&€Eà	�T�{Õ	€BØ	�T�{Õ	€BØ	�T�{Õ	€BÜ	�Š�"•'˜2�7Ó	#×	*Ñ	*¬2¯:©:Ó	6€BÜ	�Š�u¤B§J¡JÔ	/€BÜ‡F�F‡I�Iˆb˜•+˜rÔ"Ü‡F�F‡I�Iˆb˜•+˜rÔ"Ü‡F�F‡I�Iˆb˜•+˜rÔ"Ü	�‰�‰˜ ¨TˆÓ	2€BØ€BˆD�y�MØ	�€BØ�c•˜SÕ ×(Ñ(¬¯©Ó4€Hä" 5Ó)€Ið �t•˜tÑ#¬¯ª¨u°T­{Ó(;¸dÑ(BÕC€Ið —o‘o×5Ñ5×<Ñ<Ó>×DÑDÓF×JÑJÓL×RÑRÓT€Oð 	�U—\‘\¤"§*¡*Ó-Ø�Ø�YØ�YØ˜?ðð r   c                óP   € V ^8„  d   QhR\         R\         R\        P                  /# )r   Úhand_radius_mÚweight_thresholdr   rj   )r   s   "r   r   r   ¡  s)   € ÷ ')ñ ')´ð ')ÔQVð ')Ôac×akÑakñ ')r   c                ó.  a€ V P                   pVP                  pVP                  P                  oV3R lpVP	                  V! ^4      V! ^4      V! ^‚4      V! VP
                  ^,          4      V! VP                  4      V! VP                  4      V! VP                  4      RRR7	      pV^ ,          V^,          V^,          r˜pVR,          P                  4       P                  4       pV	^ ,          P                  4       P                  4       p	VR,          P                  ^ R7      p
VR,          P                  ^ R7      p\        P                  P                  Wš,
          ^R7      p\        P                  P                  W›,
          ^R7      pWÁ8  WÑ8  ,          pVP                  P                  4       P                  4       pVP                   P                  4       P                  4       pVP"                  P                  4       P                  4       pVP%                  \        P&                  4      pVP(                  p\        P*                  ! V\        P&                  R7      p\        P,                  P/                  VVVVV,          ,          4       VV8¬  # )	zØ(Nv,) bool mask of hand-region verts. Picks joints within `hand_radius_m`
of the mhr70 hand keypoint clusters (indices 21..62), then sums sparse LBS
weights across them; verts above `weight_threshold` are hand verts.c                  ó8   <€ \         P                  ! ^.V O5RS/ # )r¦   r   ©r   r³   )Úsr   s   *€r   r”   Ú(compute_hand_vert_mask.<locals>.<lambda>©  s   ø€ ”u—{’{ 1Ð8 qÒ8°Ò8r   T)	Úglobal_transré   rê   rì   rî   rð   rñ   Úreturn_keypointsÚreturn_joint_coords:é   é*   NrŠ   :r]  é?   Nro   )r   :NéF   N)r>  ræ   Ú
scale_meanr   Úmhr_forwardÚnum_hand_compsÚnum_scale_compsÚnum_shape_compsÚnum_face_compsrP   rþ   r«   rk   r˜   r™   Úlbs_skin_weightsÚlbs_vert_indicesÚlbs_skin_indicesr­   r"   Ú	NUM_VERTSr³   rB  rC  )rG  rR  rS  Úheadræ   r³   r×   r  ÚkpÚjcoordsÚright_centerÚleft_centerÚj_dist_rÚj_dist_lÚis_hand_jointÚlbs_wÚlbs_vÚlbs_jÚis_hand_joint_fÚn_vertsÚ	hand_massr   s   &&&                  @r   Úcompute_hand_vert_maskrx  ¡  sÿ  ø€ ð �?‰?€DØ
�(‰(€CØ�_‰_×#Ñ#€Fä8€EØ
×
Ñ
Ù˜1“XÙ˜“8Ù˜s›Ù˜t×2Ñ2°QÕ6Ó7Ù˜4×/Ñ/Ó0Ù˜4×/Ñ/Ó0Ù˜$×-Ñ-Ó.ØØ ð ó 
€Cð ˜•V˜S �V S¨¥Vˆ7€AØ	ˆF��‰Ó	×	Ñ	Ó	!€BØ�a�j�n‰nÓ×$Ñ$Ó&€Gà�e•9—>‘> q�>Ó)€LØ�U•)—.‘. a�.Ó(€KÜ�y‰y�~‰~˜gÕ4¸1ˆ~Ó=€HÜ�y‰y�~‰~˜gÕ3¸!ˆ~Ó<€HØÑ-°(Ñ2JÕK€Mà× Ñ ×$Ñ$Ó&×,Ñ,Ó.€EØ× Ñ ×$Ñ$Ó&×,Ñ,Ó.€EØ× Ñ ×$Ñ$Ó&×,Ñ,Ó.€EØ#×*Ñ*¬2¯:©:Ó6€Oà�m‰m€GÜ—’˜¬¯
©
Ô3€IÜ‡F�F‡I�Iˆi˜ ¨¸Õ(>Õ >Ô?ØÐ(Ñ(Ð(r   c                óD   € V ^8„  d   QhR\         R\        P                  /# )r   Údisp_threshold_mr   rj   )r   s   "r   r   r   Ë  s   € ÷ 1ñ 1´ð 1ÄÇÁñ 1r   c           
     ó†  aa	€ V P                   pVP                  P                  o	VP                  pV^,           oVV	3R lp\        P
                  ! SVS	R7      p\        P                  ! VS	R7      VR&   VP                  V! ^4      V! ^4      V! ^‚4      V! VP                  ^,          4      V! VP                  4      V! VP                  4      VR7      P                  4       P                  4       p\        P                  P                  VR,          V^ ,          R,          ,
          ^R7      pWq8„  P!                  ^ R7      # )z½(Nv,) bool mask of verts that move with face expression. Sweeps each of
the 72 expression axes at coef=+1.0 and flags any vert that moves more
than `disp_threshold_m` for at least one axis.c                  ó8   <€ \         P                  ! S.V O5R S/ # r   rV  )rW  r  r   s   *€€r   r”   Ú$_compute_face_mask.<locals>.<lambda>Õ  s   ø€ ”u—{’{ 5Ð<¨1Ò<°VÒ<r   r   :r¦   NN)rY  ré   rê   rì   rî   rð   rñ   NrŠ   )r>  r`  r   re  r   r³   rÉ   ra  rb  rc  rd  rP   rþ   rk   r˜   r™   r&   )
rG  rz  rj  Únum_facer³   ÚexprrH  Údispr  r   s
   &&      @@r   rD  rD  Ë  s  ù€ ð �?‰?€DØ�_‰_×#Ñ#€FØ×"Ñ"€Hð �q�L€EÝ<€EÜ�;Š;�u˜h¨vÔ6€DÜ�yŠy˜¨&Ô1€Dˆ�HØ×ÑÙ˜1“XÙ˜“8Ù˜s›Ù˜t×2Ñ2°QÕ6Ó7Ù˜4×/Ñ/Ó0Ù˜4×/Ñ/Ó0Øð ó ÷ 
�cƒe�E‰E‹Gð 
ô �9‰9�>‰>˜% �) e¨A¥h¨t¥nÕ4¸1ˆ>Ó=€DØÑ#×(Ñ(¨aÐ(Ó0Ð0r   c                óX   € V ^8„  d   QhR\         P                  R\         P                  /# )r   rW  r   r)  )r   s   "r   r   r   æ  s"   € ÷ ;ñ ;”B—J‘Jð ;¤2§:¡:ñ ;r   c                ó„  € \         P                  ! V \         P                  R7      P                  RR4      p \         P                  ! V . RO. RO4      p\         P                  ! V . RO. RO4      p\         P                  ! V . R	O. R
O4      p\         P
                  ! WV.RR7      P                  \         P                  4      # )z4matplotlib jet, (N,) in [0,1] -> (N, 3) float32 RGB.ro   r|   rn   rŠ   )r|   gffffffÖ?g…ëQ¸å?g{®Gázì?rn   )r|   r|   rn   rn   r   )r|   g      À?g      Ø?g{®Gázä?g…ëQ¸í?rn   )r|   r|   rn   rn   r|   r|   )r|   r9  gÃõ(\�ÂÕ?gÍÌÌÌÌÌä?rn   )r   rn   rn   r|   r|   r£   )rk   rª   r"   ÚclipÚinterpr)   r­   )rW  ÚrÚgrc   s   &   r   Újet_colormapr‡  æ  sƒ   € ä
�
Š
�1œBŸJ™JÔ'×,Ñ,¨S°#Ó6€AÜ
�	Š	�!Ò1Ò3LÓM€AÜ
�	Š	�!Ò9Ò;YÓZ€AÜ
�	Š	�!Ò1Ò3LÓM€AÜ�8Š8�Q˜1�I BÔ'×.Ñ.¬r¯z©zÓ:Ð:r   )N)g333333Ã?r   )g-Cëâ6?)&rq   Útypingr   r   r   r   r   r   Útorch.nn.functionalÚnnÚ
functionalr#   rþ   rk   Úcomfy.ldm.sam3d_body.utilsr   Úcomfy.ldm.sam3.trackerr	   Ú comfy.ldm.sam3d_body.model.modelr
   Úcomfy.model_managementrI   Úcomfy.utilsr   r;   rd   ÚBATCHED_CROPS_PER_CHUNKru   r�   rØ   r  r&  rÿ   r5  rP  rx  rD  r‡  © r   r   Ú<module>r“     s�   ðÛ ß 3Õ 3Û ß Ð Û å 4Ý /Ý 6ó Û å õIõ0-ðD Ð õõõy÷x\ðL '+Ø.2Ø2÷)õXbõQõ
#÷L')÷T1÷6;r   