+
    …°ñj~   ã            	      ó¦   € R t ^ RIHt ^ RIt^ RIHtHtHt ^ RIt	^RI
HtHtHtHtHtHt R R ltRR R lltR	 R
 ltRRRRRRRRR/R R llltR# )aa  BVH export for SAM 3D Body pose_data.

BVH stores explicit bone OFFSETs per joint, so standard importers reconstruct
anatomical bone orientations directly (unlike glTF). We skip the rig's joint 0
(static world anchor) and use joint 1 as the ROOT (6 channels: XYZ pos + ZXY
rot); other joints get 3 channels. Rotations are intrinsic Z-X-Y Euler degrees.
)ÚannotationsN)ÚAnyÚDictÚList)ÚRigÚbone_locals_from_globalsÚcollect_tracksÚ global_skel_state_from_pose_dataÚquat_sign_fix_per_jointÚunflipc               ó    € V ^8„  d   QhRRRR/# )é   Úquatú
np.ndarrayÚreturn© )Úformats   "ÚFC:\Ai_Coding\apps\studio\ComfyUI\comfy_extras\sam3d_body\export\bvh.pyÚ__annotate__r      s   € ÷ "ñ " ð "°
ñ "ó    c                óp  € \         P                  ! V \         P                  R7      pVR,          VR,          VR,          VR,          3w  r#rE\         P                  ! RW4,          W%,          ,           ,          R	R4      pRW#,          WE,          ,
          ,          pRRW",          WD,          ,           ,          ,
          pRW$,          W5,          ,
          ,          p	RRW",          W3,          ,           ,          ,
          p
\         P                  ! V4      p\         P
                  ! V) V4      p\         P
                  ! V	) V
4      p\         P                  ! \         P                  ! V4      \         P                  ! V4      \         P                  ! V4      .R
R7      pVP                  \         P                  4      # )u�   xyzw quat â†’ intrinsic Z-X-Y Euler degrees, returned as (..., 3) in
(z, x, y) order to match BVH's `CHANNELS Zrotation Xrotation Yrotation`.©Údtypeg       @ç      ð?©Úaxis).é    ).é   ).r   ).é   g      ð¿éÿÿÿÿ)
ÚnpÚasarrayÚfloat64ÚclipÚarcsinÚarctan2ÚstackÚrad2degÚastypeÚfloat32)r   ÚqÚxÚyÚzÚwÚM21ÚM01ÚM11ÚM20ÚM22ÚaÚcÚbÚouts   &              r   Ú_quat_to_zxy_euler_degr8      s   € ô 	�
Š
�4œrŸz™zÔ*€AØ�6•˜A˜f�I q¨¥y°!°Fµ)Ð;�J€Aˆ!ô �'Š'�#˜� ¥�Õ'¨¨sÓ
3€CØ
�•˜�•Õ
€CØ
��q•u˜q�u•}Õ%Õ
%€CØ
�•˜�•Õ
€CØ
��q•u˜q�u•}Õ%Õ
%€CÜ
�	Š	�#‹€AÜ
�
Š
�C�4˜Ó€AÜ
�
Š
�C�4˜Ó€AÜ
�(Š(”B—J’J˜q“M¤2§:¢:¨a£=´"·*²*¸Q³-Ð@ÀrÔ
J€CØ�:‰:”b—j‘jÓ!Ð!r   c               ó$   € V ^8„  d   QhRRRRRR/# )r   Úparentsr   Úis_externalÚboolr   Úintr   )r   s   "r   r   r   1   s!   € ÷ ñ ˜Jð °Tð Àcñ r   c                óh  € V P                   ^ ,          p\        V4       Uu. uF>  p^ \        W,          4      u;8:  d   V8  d   M M\        W,          4      V8w  d   K<  VNK@  	  ppV'       g   ^ # \        V4       Uu. uF  p. NK  	  pp\        V4       FH  p\        W,          4      p^ Tu;8:  d
   V8  g   K%  M K)  Ws8w  g   K1  Wg,          P                  V4       KJ  	  V^ ,          pWh,          '       d0   V'       d   \	        Wh,          4      ^8”  d   V# Wh,          ^ ,          # V# u upi u upi )u  First child of the rig's world anchor, dropping the originâ†’body stick.
Falls back to the first root joint. External rigs whose root is already the
articulated body root with multiple child chains keep the root â€” descending
into one child would drop the sibling limbs.)ÚshapeÚranger=   ÚappendÚlen)	r:   r;   ÚNJÚjÚworld_anchorsÚ_ÚchildrenÚpÚwas	   &&       r   Ú_find_bvh_rootrJ   1   sò   € ð
 
�‰�qÕ	€BÜ % b¤	ó R¡	˜1Ø¤# g¥j£/Ö6°B×6¼3¸w½z»?ÈaÑ;O÷ �Q¡	€Mð RçÙÜ-2°2¬YÓ 7©Y¨£©Y€HÐ 7Ü�2ŽYˆÜ�•
‹OˆØ�Ž;�B�;Š;˜1ž6Ø�K×Ñ˜qÖ!ñ ð 
�qÕ	€BØ‡|„|ßœ3˜x�|Ó,¨qÔ0ØˆIØ�|˜A�ÐØ€IùòRùò !8s   ¡9D*ÁD*Á>D/c               ó    € V ^8„  d   QhRRRR/# )r   r:   r   r   zList[List[int]]r   )r   s   "r   r   r   H   s   € ÷ ñ  ð °ñ r   c                ó  € V P                   ^ ,          p\        V4       Uu. uF  p. NK  	  pp\        V4       FH  p\        W,          4      p^ Tu;8:  d
   V8  g   K%  M K)  WT8w  g   K1  W5,          P                  V4       KJ  	  V# u upi )r   )r?   r@   r=   rA   )r:   rC   rF   r7   rD   rH   s   &     r   Ú_build_children_maprM   H   sl   € Ø	�‰�qÕ	€BÜ(-¨b¬	Ó2©	 1›B©	€CÐ2Ü�2ŽYˆÜ�•
‹OˆØ�Ž;�B�;Š;˜1ž6Ø�F�M‰M˜!Öñ ð €Jùò 3s   ¡BÚfpsg      8@Úcamera_translationÚoffÚtrack_indexÚunitsÚcmc               ó4   € V ^8„  d   QhRRRRRRRRR	R
RRRR/# )r   Ú	pose_datazDict[str, Any]Úmodelr   rN   ÚfloatrO   ÚstrrQ   r=   rR   r   Úbytesr   )r   s   "r   r   r   R   sW   € ÷ }5ñ }5Øð}5àð}5ð 
ð	}5ð
 ð}5ð ð}5ð ð}5ð ñ}5r   c               ó6  aaaaaa a!a"€ VR 9  d   \        RV: 24      hVR8X  d   RMRo"\        P                  ! W4      pVP                  '       * pVP                  pVP
                  p	V R,          p
\        W4      pV'       g   \        R4      hV^ ,          w  rÍ\        V4      pV^ 8X  d   \        R4      h\        W—4      p\        V	4      oVP                  pVR!,          P                  \        P                  4      R	,          oVP                  P                  \        P                  4      R	,          o!. oR
 VVV3R lloS! V4       \        WWÈVP                   R7      p\#        VR",          4      VR"&   V	P%                  4       pR#VV&   \'        VV4      p\#        VR",          4      VR"&   \)        VR",          4      pVR$9   d·   \        P*                  ! V Uu. uFG  p\-        \        P.                  ! V
V,          V,          R,          \        P0                  R7      4      NKI  	  up^ R7      P                  \        P                  4      pVR8X  d   VVR,          ,
          pSV,          R%,          V,           pM \        P2                  ! SV,          V^34      pR.o R VVVV V!V"3R lloS! V^ RR7       S P5                  R4       S P5                  RV 24       S P5                  RR\7        V4      ,          R 24       \        P.                  ! SR,          \        P8                  R7      p\        P:                  ! VS",          VRV3,          P                  \        P                  4      VRVR3,          P=                  VR#4      .^R7      p\>        P@                  ! 4       p\        PB                  ! VVRR7       S P5                  VPE                  4       PG                  R4      4       RPI                  S 4      R,           PK                  R4      # u upi )&u  Build a BVH file from pose_data. Returns UTF-8 text bytes.

`model` may be None when pose_data carries a `_skeleton_override` (external
rigs); the rig hierarchy/offsets/bind come from the override. `units` is
"cm" (default) or "m" â€” affects OFFSET/root-position, not rotations.
rS   z*build_bvh: units must be 'cm' or 'm', got g      Y@r   Úframesz'build_bvh: no valid tracks in pose_dataz build_bvh: track has zero framesºNNNç{®Gáz„?c               ó    € V ^8„  d   QhRRRR/# )r   rD   r=   r   ÚNoner   )r   s   "r   r   Úbuild_bvh.<locals>.__annotate__~   s   € ÷ ñ �#ð ˜$ñ r   c                óZ   <€ SP                  V 4       SV ,           F  pS! V4       K  	  R # ©N)rA   )rD   r5   Ú_visitÚ	bvh_orderÚchildren_maps   & €€€r   rc   Úbuild_bvh.<locals>._visit~   s(   ø€ Ø×Ñ˜ÔØ˜a—�ˆAÙ�1ŽIó !r   )Újoint_coords_y_downÚcenteredÚ
pred_cam_tr   r   :r   r   NÚ	HIERARCHYc               ó(   € V ^8„  d   QhRRRRRRRR/# )r   rD   r=   ÚdepthÚis_rootr<   r   r_   r   )r   s   "r   r   r`       s(   € ÷  ñ  �sð   3ð  °ð  ¸$ñ  r   c           
     óX  <€ R V,          pV'       d   RMRpV'       d   RMRV R 2pSP                  V V RV 24       SP                  VR,           4       V'       d
   SV ,          MSV ,          S,          pSP                  V RV^ ,          R	 RV^,          R	 RV^,          R	 24       V'       d   SP                  VR
,           4       MSP                  VR,           4       SV ,          pV'       d   V F  pS! W�^,           RR7       K  	  EM SP                  VR,           4       SP                  VR,           4       SV ,          S,          R,          p	\        \        P                  P	                  V	4      4      p
V
RS,          R,          8  d1   \        P
                  ! RRS,          R.\        P                  R7      p	SP                  V RV	^ ,          R	 RV	^,          R	 RV	^,          R	 24       SP                  VR,           4       SP                  VR,           4       R# )z  ÚROOTÚJOINTÚHipsÚjoint_Ú03dÚ Ú{z	  OFFSET ú.6fzH  CHANNELS 6 Xposition Yposition Zposition Zrotation Xrotation Yrotationz*  CHANNELS 3 Zrotation Xrotation YrotationF©rm   z
  End Sitez  {g333333Ó?g      à?r]   g        gš™™™™™©?r   z    OFFSET z  }Ú}N)rA   rW   r    ÚlinalgÚnormÚarrayr"   )rD   rl   rm   ÚindÚkeywordÚnameÚoÚkidsr5   ÚtipÚtip_normÚ_emit_jointÚ
bind_pos_mre   ÚlinesÚoffset_mÚ
unit_scales   &&&        €€€€€€r   rƒ   Úbuild_bvh.<locals>._emit_joint    sÄ  ø€ Ø�U�lˆß#‘&¨ˆß ‰v¨¨q°¨gÐ&6ˆØ�‰˜�u˜W˜I Q t fÐ-Ô.Ø�‰�S˜3•YÔß%ˆZ˜Ž]¨8°A­;¸*ÕDˆØ�‰˜�u˜I a¨¥d¨3 Z¨q°°1µ°c°
¸!¸A¸a½DÀ¸:ÐFÔGßØ�L‰L˜ð  9õ 9õ :ð �L‰L˜ÐKÕKÔLØ˜A�ˆßÛ�Ù˜A q�y°%×8ó ð �L‰L˜˜|Õ+Ô,Ø�L‰L˜˜u�Ô%Ø˜A•; Õ+¨sÕ2ˆCÜœRŸY™YŸ^™^¨CÓ0Ó1ˆHØ˜# 
Õ*¨TÕ1Ô1Ü—h’h  T¨JÕ%6¸Ð<ÄBÇJÁJÔO�Ø�L‰L˜C˜5 ¨C°­F°3¨<°q¸¸Q½À¸ÀAÀcÈ!ÅfÈSÀ\ÐRÔSØ�L‰L˜˜u�Ô%Ø�‰�S˜3•YÖr   Trw   ÚMOTIONzFrames: zFrame Time: rv   :r   NNz%.6f)ÚfmtÚ
zutf-8)rS   Úm)r\   :Nr   N).:r   é   Nr   )Úabsoluterh   )Nr\   )&Ú
ValueErrorr   Úfrom_pose_dataÚcan_rerun_fkÚ
num_jointsr:   r   rB   rJ   rM   Úbind_global_cmr(   r    r"   Újoint_offsets_cmr	   Úper_frame_y_downr
   Úcopyr   r8   r&   r   r!   r)   ÚtilerA   rW   Úint64ÚconcatenateÚreshapeÚioÚStringIOÚsavetxtÚgetvalueÚrstripÚjoinÚencode)#rU   rV   rN   rO   rQ   rR   Úrigr;   rC   r:   r[   ÚtracksÚperson_kÚframe_indicesÚn_framesÚ	body_rootÚbind_globalÚrig_global_mÚbvh_parentsÚ
bone_localÚ
eulers_degÚtÚcam_tÚ
root_pos_mÚnon_root_idxÚmotionÚbufrƒ   rc   r„   rd   re   r…   r†   r‡   s#   &&$$$$                     @@@@@@@@r   Ú	build_bvhr³   R   st  ÿ€ ð �KÔÜÐEÀeÁYÐOÓPÐPØ 4œ-‘¨S€Jä
×
Ò
˜YÓ
.€CØ×&Ñ&Ô&€KØ	�‰€BØ�k‰k€GØ�xÕ €Fä˜IÓ3€FßÜÐBÓCÐCØ$ Q�iÑ€HÜ�=Ó!€HØ�1„}ÜÐ;Ó<Ð<ä˜wÓ4€IÜ& wÓ/€Lð ×$Ñ$€KØ˜UÕ#×*Ñ*¬2¯:©:Ó6¸Õ=€JØ×#Ñ#×*Ñ*¬2¯:©:Ó6¸Õ=€Hð €I÷ò ñ ˆ9Ôô 4Ø (Ø×0Ñ0ô€Lô 5°\À(Õ5KÓL€L�ÑØ—,‘,“.€KØ€K�	ÑÜ)¨,¸ÓD€Jä2°:¸hÕ3GÓH€JˆxÑä'¨
°8Õ(<Ó=€JàÐ5Ô5Ü—’á"ó
á"�ô ”2—:’:˜f Q�i¨Õ1°,Õ?ÄrÇzÁzÔRÖSÙ"ñ
ð ô÷ ‘6œ"Ÿ*™*Ó%ð 	ð  Ô+Ø˜E #�JÕ&ˆEØ 	Õ*¨7Õ3°eÕ;‰
ä—W’W˜Z¨	Õ2°X¸q°MÓBˆ
à#�}€E÷ õ  ñ: �	˜1 dÕ+à	‡L�L�ÔØ	‡L�L�8˜H˜:Ð&Ô'Ø	‡L�L�< ¤e¨C£jÕ 0°Ð5Ð6Ô7ô —:’:˜i¨�m´2·8±8Ô<€LÜ�^Š^Ø�ZÕØ�1�i�<Õ ×'Ñ'¬¯
©
Ó3Ø�1�l AÐ%Õ&×.Ñ.¨x¸Ó<ðð ô	€Fô
 �+Š+‹-€CÜ‡J‚Jˆs�F Õ'Ø	‡L�L�—‘“×&Ñ& tÓ,Ô-à�I‰I�eÓ˜tÕ#×+Ñ+¨GÓ4Ð4ùòw
s   ÇAP)Frb   r   )Ú__doc__Ú
__future__r   r›   Útypingr   r   r   Únumpyr    Ú
glb_sharedr   r   r   r	   r
   r   r8   rJ   rM   r³   r   r   r   Ú<module>r¹      sl   ðñõ #ã 	ß "Ñ "ã ÷÷ õ"÷.õ.ñ}5ð ð	}5ð
 $ð}5ð ð}5ð ÷}5ò }5r   