§
    l¬¸j¸m  ã                  ó~  — d dl mZ d dlmZ d dlmZ d dlmZ d dlZ	d dl
Z
d dlmZ ddlmZ d	d
lmZ d	dlmZ d	dlmZ d	dlmZ d	dlmZ d	dlmZmZmZmZ  e	j        g d¢¦  «        Z e	j        g d¢¦  «        Z dZ!dZ"d8d„Z#	 d9d:d"„Z$d;d#„Z%d<d=d*„Z&d>d.„Z'd?d0„Z(d@d2„Z)d;d3„Z* G d4„ d5e¦  «        Z+ G d6„ d7¦  «        Z,dS )Aé    )Úannotations)Údeque)Úwraps)ÚAnyN)Úbbox_ioaé   )ÚLOGGERé   )Ú
TrackState)ÚBOTrack)ÚGMC)ÚKalmanFilterXYWH)Úsmooth_feature)Újoint_stracksÚmerge_track_poolsÚ	multi_gmcÚparse_bboxes)r   r   r   r   )r
   é   r
   r   çffffffî?g
×£p=
ï?Útracks_aúlist[TTSTrack]Útracks_bÚreturnútuple[np.ndarray, np.ndarray]c                óŠ  — t          | ¦  «        t          |¦  «        }}|dk    s|dk    rDt          j        ||ft          j        ¬¦  «        t          j        ||ft          j        ¬¦  «        fS t          j        d„ | D ¦   «         t          j        ¬¦  «        }t          j        d„ |D ¦   «         t          j        ¬¦  «        }t          ||d¬¦  «        }t          j        |dd…dd	…f         |dd…dd	…f         j        ¦  «        t          j	        |dd…d
d…f         |dd…d
d…f         j        ¦  «        z
  }t          j	        |dd…dd	…f         |dd…dd	…f         j        ¦  «        t          j        |dd…d
d…f         |dd…d
d…f         j        ¦  «        z
  }t          j
        ||dz   z  dd
¦  «        }	|d|	|z  z
  fS )zcReturn (iou_sim, 1 - HMIoU) where HMIoU = HIoU * IoU and HIoU is vertical-overlap / vertical-union.r   ©Údtypec                ó   — g | ]	}|j         ‘Œ
S © ©Úxyxy©Ú.0Útracks     úr/root/private/project/pallet_detection_v2/.venv/lib/python3.11/site-packages/ultralytics/trackers/track_tracker.pyú
<listcomp>z#_hmiou_distance.<locals>.<listcomp>#   ó   € Ð#EÐ#EÐ#E°5 E¤JÐ#EÐ#EÐ#Eó    c                ó   — g | ]	}|j         ‘Œ
S r   r    r"   s     r%   r&   z#_hmiou_distance.<locals>.<listcomp>$   r'   r(   T©ÚiouNr   é   r
   r   g•Ö&è.>ç      ð?)ÚlenÚnpÚzerosÚfloat32ÚonesÚascontiguousarrayr   ÚminimumÚTÚmaximumÚclip)
r   r   ÚnÚmÚboxes_aÚboxes_bÚiou_simÚh_overÚh_unionÚh_ious
             r%   Ú_hmiou_distancer@      sÝ  € åˆx‰=Œ=�#˜h™-œ-€q€AØˆA‚v€v��a’�ÝŒx˜˜A˜¥b¤jÐ1Ñ1Ô1µ2´7¸A¸q¸6ÍÌÐ3TÑ3TÔ3TÐTÐTÝÔ"Ð#EÐ#E¸HÐ#EÑ#EÔ#EÍRÌZÐXÑXÔX€GÝÔ"Ð#EÐ#E¸HÐ#EÑ#EÔ#EÍRÌZÐXÑXÔX€GÝ�w ¨TÐ2Ñ2Ô2€GÝŒZ˜    1 Q 3 œ¨°°°°A°a°C°¬Ô):Ñ;Ô;½b¼jÈÐQRÐQRÐQRÐTUÐVWÐTWÐQWÌÐZaÐbcÐbcÐbcÐefÐghÐehÐbhÔZiÔZkÑ>lÔ>lÑl€FÝŒj˜    A a C œ¨'°!°!°!°Q°q°S°&¬/Ô*;Ñ<Ô<½r¼zÈ'ÐRSÐRSÐRSÐUVÐWXÐUXÐRXÌ/Ð[bÐcdÐcdÐcdÐfgÐhiÐfiÐciÔ[jÔ[lÑ?mÔ?mÑm€GÝŒG�F˜g¨™nÑ-¨q°!Ñ4Ô4€EØ�C˜% '™/Ñ)Ð)Ð)r(   r   ÚtracksÚdetsÚframe_idÚintÚpairsÚdelta_tú
np.ndarrayc           	     óÀ  ‡ ‡‡‡— |\  }}t          j        ˆˆˆ fd„|D ¦   «         ¦  «        }t          j        ˆfd„|D ¦   «         ¦  «        }||z
  }	|	dd…t          f         }
|	dd…t          f         }t          j        |
|
z  ||z  z   ¦  «        dz   }|
|z  }
||z  }t          j        ˆ fd„|D ¦   «         ¦  «        }|dd…dd…df         |
z  |dd…dd…df         |z  z   }t          j        t          j        t          j        |dd¦  «        ¦  «        ¦  «                             d¬	¦  «        t           j	        z  }|t          j
        ˆfd
„|D ¦   «         ¦  «        z  S )z»Return angle distance for the IoU-supported `(track, det)` index `pairs` only.

    `_cost_matrix` overwrites unsupported pairs, so a full `(N, M)` grid would compute discarded work.
    c                óH   •— g | ]}‰|                               ‰‰¦  «        ‘ŒS r   )Úget_history_box)r#   ÚirF   rC   rA   s     €€€r%   r&   z#_angle_distance.<locals>.<listcomp>4   s-   ø€ Ð\Ð\Ð\ÈQ˜F 1œI×5Ò5°hÀÑHÔHÐ\Ð\Ð\r(   c                ó*   •— g | ]}‰|         j         ‘ŒS r   r    ©r#   rK   rB   s     €r%   r&   z#_angle_distance.<locals>.<listcomp>5   s   ø€ Ð8Ð8Ð8¨1˜$˜qœ'œ,Ð8Ð8Ð8r(   Nçñhãˆµøä>c                ó*   •— g | ]}‰|         j         ‘ŒS r   )Úvelocity)r#   rK   rA   s     €r%   r&   z#_angle_distance.<locals>.<listcomp><   s    ø€ Ð GÐ GÐ G¸ ¨¤Ô!3Ð GÐ GÐ Gr(   r   r
   éÿÿÿÿ©Úaxisc                ó*   •— g | ]}‰|         j         ‘ŒS r   ©ÚscorerM   s     €r%   r&   z#_angle_distance.<locals>.<listcomp>?   s   ø€ Ð;Ð;Ð;¨a˜D œGœMÐ;Ð;Ð;r(   )r/   ÚstackÚ_CORNER_DX_IDXÚ_CORNER_DY_IDXÚsqrtÚabsÚarccosr7   ÚmeanÚpiÚarray)rA   rB   rC   rE   rF   Ú	track_idxÚdet_idxÚtrack_boxesÚ	det_boxesÚdeltasÚdxÚdyÚnormsÚtrack_velocitiesÚdotÚdists   ``` `           r%   Ú_angle_distancerk   ,   s�  øøøø€ ð Ñ€IˆwÝ”(Ð\Ð\Ð\Ð\Ð\Ð\ÐR[Ð\Ñ\Ô\Ñ]Ô]€KÝ”Ð8Ð8Ð8Ð8°Ð8Ñ8Ô8Ñ9Ô9€IØ˜Ñ$€FØ	���•>Ð!Ô	"€BØ	���•>Ð!Ô	"€BÝŒG�B˜‘G˜b 2™gÑ%Ñ&Ô&¨Ñ-€EØˆ%�K€BØˆ%�K€BÝ”xÐ GÐ GÐ GÐ G¸YÐ GÑ GÔ GÑHÔHÐØ
˜1˜1˜1˜a˜a˜a ˜7Ô
# bÑ
(Ð+;¸A¸A¸A¸q¸q¸qÀ!¸GÔ+DÀrÑ+IÑ
I€CÝŒ6•"”)�BœG C¨¨QÑ/Ô/Ñ0Ô0Ñ1Ô1×6Ò6¸BÐ6Ñ?Ô?Å"Ä%ÑG€DØ•"”(Ð;Ð;Ð;Ð;°7Ð;Ñ;Ô;Ñ<Ô<Ñ<Ð<r(   c                óØ  — t          | ¦  «        dk    st          |¦  «        dk    r<t          j        t          | ¦  «        t          |¦  «        ft          j        ¬¦  «        S t          j        d„ | D ¦   «         ¦  «        }t          j        d„ | D ¦   «         ¦  «        }|||z
  z   }t          j        d„ |D ¦   «         ¦  «        }t          j        |dd…df         |d         z
  ¦  «        S )zYAbsolute difference between each track's projected score and each detection's confidence.r   r   c                ó   — g | ]	}|j         ‘Œ
S r   )Ú
prev_scorer"   s     r%   r&   z(_confidence_distance.<locals>.<listcomp>F   s   € Ð!GÐ!GÐ!G°u %Ô"2Ð!GÐ!GÐ!Gr(   c                ó   — g | ]	}|j         ‘Œ
S r   rU   r"   s     r%   r&   z(_confidence_distance.<locals>.<listcomp>G   s   € Ð!BÐ!BÐ!B°% %¤+Ð!BÐ!BÐ!Br(   c                ó   — g | ]	}|j         ‘Œ
S r   rU   ©r#   Údets     r%   r&   z(_confidence_distance.<locals>.<listcomp>I   s   € Ð5Ð5Ð5¨˜3œ9Ð5Ð5Ð5r(   N)r.   r/   r2   r1   r_   r[   )rA   rB   Útrack_prev_scoresÚtrack_curr_scoresÚtrack_proj_scoresÚ
det_scoress         r%   Ú_confidence_distancerw   B   sß   € å
ˆ6�{„{�aÒÐ�3˜t™9œ9¨š>˜>ÝŒw�˜F™œ¥S¨¡Y¤YÐ/µr´zÐBÑBÔBÐBÝœÐ!GÐ!GÀÐ!GÑ!GÔ!GÑHÔHÐÝœÐ!BÐ!B¸6Ð!BÑ!BÔ!BÑCÔCÐØ)Ð->ÐARÑ-RÑSÐÝ”Ð5Ð5°Ð5Ñ5Ô5Ñ6Ô6€JÝŒ6Ð# A A A t GÔ,¨z¸$Ô/?Ñ?Ñ@Ô@Ð@r(   çš™™™™™©?ÚcostÚ	match_thrÚfloatÚreduce_stepútuple[list]c                óÔ  ‡ ‡‡	‡
‡‡— g }‰                       ¦   «         Š ‰ j        d         dk    rÓ‰ j        d         dk    rÂt          j        ‰ d¬¦  «        Št          j        ‰ d¬¦  «        Šˆ ˆˆˆfd„t	          ‰ j        d         ¦  «        D ¦   «         }|snj|                     |¦  «         |D ]+\  }}t          j        ‰ |dd…f<   t          j        ‰ dd…|f<   Œ,‰|z  Š‰ j        d         dk    r‰ j        d         dk    °Âd„ |D ¦   «         Š
d„ |D ¦   «         Š	ˆ
fd„t	          ‰ j        d         ¦  «        D ¦   «         }ˆ	fd	„t	          ‰ j        d         ¦  «        D ¦   «         }|||fS )
z�Greedy mutually-nearest matching with a threshold that shrinks each iteration.

    Returns (matches, unmatched_tracks, unmatched_dets).
    r   r
   rR   c                óp   •— g | ]2}‰‰|                  |k    r‰|‰|         f         ‰k     ¯(|‰|         g‘Œ3S r   r   )r#   r`   ry   rz   Únearest_detÚnearest_tracks     €€€€r%   r&   z(_iterative_associate.<locals>.<listcomp>W   s_   ø€ ð 
ð 
ð 
àØ˜[¨Ô3Ô4¸	ÒAÐAØ�Y ¨IÔ 6Ð6Ô7¸)ÒCÐCð ˜ IÔ.Ð/ð DÐCÐCr(   Nc                ó   — h | ]\  }}|’ŒS r   r   )r#   r`   Ú_s      r%   ú	<setcomp>z'_iterative_associate.<locals>.<setcomp>d   s   € Ð<Ð<Ð<¡L I¨q�iÐ<Ð<Ð<r(   c                ó   — h | ]\  }}|’ŒS r   r   )r#   rƒ   ra   s      r%   r„   z'_iterative_associate.<locals>.<setcomp>e   s   € Ð6Ð6Ð6¡
  7�GÐ6Ð6Ð6r(   c                ó   •— g | ]}|‰v¯|‘Œ	S r   r   )r#   rK   Úmatched_trackss     €r%   r&   z(_iterative_associate.<locals>.<listcomp>f   s#   ø€ ÐSÐSÐS˜a¸1ÀNÐ;RÐ;R˜Ð;RÐ;RÐ;Rr(   c                ó   •— g | ]}|‰v¯|‘Œ	S r   r   )r#   rK   Úmatched_detss     €r%   r&   z(_iterative_associate.<locals>.<listcomp>g   s#   ø€ ÐOÐOÐO˜A¸À,Ð9NÐ9N�aÐ9NÐ9NÐ9Nr(   )ÚcopyÚshaper/   ÚargminÚrangeÚextendÚinf)ry   rz   r|   ÚmatchesÚnew_matchesr`   ra   Úunmatched_tracksÚunmatched_detsr‰   r‡   r€   r�   s   ``       @@@@r%   Ú_iterative_associater”   M   sº  øøøøøø€ ð
 €GØ�9Š9‰;Œ;€DØ
Œ*�QŒ-˜!Ò
Ð
 ¤
¨1¤°Ò 1Ð 1Ý”i ¨1Ð-Ñ-Ô-ˆÝœ	 $¨QÐ/Ñ/Ô/ˆð
ð 
ð 
ð 
ð 
ð 
ð 
å" 4¤:¨a¤=Ñ1Ô1ð
ñ 
ô 
ˆð ð 	ØØ�Š�{Ñ#Ô#Ð#Ø"-ð 	&ð 	&ÑˆI�wÝ!#¤ˆD�˜A˜A˜A�ÑÝ!œvˆD����G�ÑÐØ�[Ñ ˆ	ð Œ*�QŒ-˜!Ò
Ð
 ¤
¨1¤°Ò 1Ð 1ð  =Ð<°GÐ<Ñ<Ô<€NØ6Ð6¨gÐ6Ñ6Ô6€LØSÐSÐSÐS¥5¨¬°A¬Ñ#7Ô#7ÐSÑSÔSÐØOÐOÐOÐO¥ t¤z°!¤}Ñ!5Ô!5ÐOÑOÔO€NØÐ$ nÐ4Ð4r(   Útai_thrÚnew_track_threshú
list[bool]c                ób  — |sg S t          j        d„ |D ¦   «         ¦  «        }||k    }t          | ¦  «        t          |¦  «        }}||z   dk     r|                     ¦   «         S t          j        d„ | |z   D ¦   «         t           j        ¬¦  «        }t          ||d¬¦  «        }	|r)||	|d…d|…f                              d¬	¦  «        |k    z  }|	|d…|d…f         }
|                     ¦   «         ddd
…         }|D ]!}||         sŒ|
|         |k    }d||<   d||<   Œ"|                     ¦   «         S )z\TAI NMS: suppress detections that heavily overlap an existing track or a stronger detection.c                ó   — g | ]	}|j         ‘Œ
S r   rU   rq   s     r%   r&   z$_track_aware_nms.<locals>.<listcomp>q   s   € Ð1Ð1Ð1 S�s”yÐ1Ð1Ð1r(   r   c                ó   — g | ]	}|j         ‘Œ
S r   r    )r#   Úobjs     r%   r&   z$_track_aware_nms.<locals>.<listcomp>v   s   € Ð!DÐ!DÐ!D¨s #¤(Ð!DÐ!DÐ!Dr(   r   Tr*   Nr
   rR   rQ   F)	r/   r_   r.   Útolistr3   r1   r   ÚmaxÚargsort)rA   rB   r•   r–   ÚscoresÚallowÚn_tracksÚn_detsÚboxesr+   Údet_iouÚorderrK   Úsuppresss                 r%   Ú_track_aware_nmsr§   k   se  € ð ð Øˆ	ÝŒXÐ1Ð1¨DÐ1Ñ1Ô1Ñ2Ô2€FØÐ%Ò%€EÝ˜6‘{”{¥C¨¡I¤Iˆf€HØ�&Ñ˜1ÒÐØ�|Š|‰~Œ~ÐÝÔ Ð!DÐ!D°f¸t±mÐ!DÑ!DÔ!DÍBÌJÐWÑWÔW€EÝ
�5˜% TÐ
*Ñ
*Ô
*€Càð BØ��X�Y�Y 	  	Ð)Ô*×.Ò.°AÐ.Ñ6Ô6¸'ÒAÑAˆà�(�)�)˜X˜Y˜YÐ&Ô'€GØ�NŠNÑÔ˜T˜T˜r˜TÔ"€EØð  ð  ˆØ�QŒxð 	ØØ˜1”: Ò'ˆØˆ�‰Øˆˆh‰ˆà�<Š<‰>Œ>Ðr(   ÚNonec                óŽ   ‡ ‡— t          ‰ d¦  «        rdS ‰ j        Št          ‰¦  «        ˆˆ fd„¦   «         }‰‰ _        |‰ _        dS )zXWrap `predictor.postprocess` to capture raw pre-NMS predictions and inputs (idempotent).Ú_orig_postprocessNc                ó  •— t          | t          t          f¦  «        r| d         n| }t          |t          j        ¦  «        r&|                     ¦   «                              ¦   «         n|‰_        |‰_        |‰_	         ‰| ||g|¢R i |¤ŽS ©Nr   )
Ú
isinstanceÚlistÚtupleÚtorchÚTensorÚdetachÚcloneÚ
_raw_predsÚ_postprocess_imÚ_postprocess_im0s)ÚpredsÚimgÚ	orig_imgsÚargsÚkwargsÚrawÚorigÚ	predictors         €€r%   Ú_wrappedz'attach_raw_preds_hook.<locals>._wrappedŽ   sŠ   ø€ å$ U­Tµ5¨MÑ:Ô:ÐEˆe�AŒhˆhÀˆå7AÀ#ÅuÄ|Ñ7TÔ7TÐ]˜sŸzšz™|œ|×1Ò1Ñ3Ô3Ð3ÐZ]ˆ	ÔØ$'ˆ	Ô!Ø&/ˆ	Ô#Øˆt�E˜3 	Ð;¨DÐ;Ð;Ð;°FÐ;Ð;Ð;r(   )ÚhasattrÚpostprocessr   rª   )r¾   r¿   r½   s   ` @r%   Úattach_raw_preds_hookrÂ   ˆ   sj   øø€ åˆyÐ-Ñ.Ô.ð ØˆØÔ €Då
ˆ4�[„[ð<ð <ð <ð <ð <ñ „[ð<ð #'€IÔØ$€IÔÐÐr(   úlist | Nonec                óä  — t          | dd¦  «        }|�t          |t          j        ¦  «        sdS ddlm} ddlm} |                      || j	        | j
        t          ¬¦  «        }| j        j        dk    }g }t          || j        ¦  «        D �]Ü\  }}|r|j        n|j        }	|r|j        n|j        }
t%          |
¦  «        dk    st%          |	¦  «        dk    r|                     d¦  «         Œb ||
j        |	j        ¦  «                             d¬	¦  «        j        }|t.          k     }|                     ¦   «         s|                     d¦  «         ŒÆ|
j        |                              ¦   «         }|rr|dd…dd
…f                              ¦   «         }|                     ||dd…d
f                              ¦   «         |dd…df                              ¦   «         f¦  «         �ŒY|                     |dd…dd…f         ¦  «                             ¦   «         }|                     ||dd…df                              ¦   «         |dd…d
f                              ¦   «         f¦  «         �ŒÞd| _        |S )ziReturn per-batch `(xywh, conf, cls)` tuples for detections the tight NMS dropped, or None if unavailable.r´   Nr   )Úops)Úbox_iour*   Úobbr
   )Údimé   é   r,   )Úgetattrr­   r°   r±   Úultralytics.utilsrÅ   Úultralytics.utils.metricsrÆ   rª   rµ   r¶   Ú_LOOSE_NMS_IOUrº   ÚtaskÚzipÚresultsrÇ   r£   r.   Úappendr!   r�   ÚvaluesÚ_LOOSE_NMS_DEDUP_IOUÚanyÚdataÚcpuÚnumpyÚ	xyxy2xywhr´   )r¾   r¼   rÅ   rÆ   Úloose_resultsÚis_obbÚoutÚlooseÚtightÚtight_boxesÚloose_boxesÚmax_iouÚmaskÚdelsÚxywhs                  r%   Úcompute_dets_delrå   ›   s€  € å
�)˜\¨4Ñ
0Ô
0€CØ
€{�* S­%¬,Ñ7Ô7€{ØˆtØ%Ð%Ð%Ð%Ð%Ð%Ø1Ð1Ð1Ð1Ð1Ð1à×/Ò/ØˆYÔ&¨	Ô(CÍð 0ñ ô €Mð Œ^Ô  EÒ)€FØ
€CÝ˜M¨9Ô+<Ñ=Ô=ð Gñ G‰ˆˆuØ#)Ð:�e”i�i¨u¬{ˆØ#)Ð:�e”i�i¨u¬{ˆÝˆ{ÑÔ˜qÒ Ð ¥C¨Ñ$4Ô$4¸Ò$9Ð$9Ø�JŠJ�tÑÔÐØØ�'˜+Ô*¨KÔ,<Ñ=Ô=×AÒAÀaÐAÑHÔHÔOˆØÕ-Ò-ˆØ�xŠx‰zŒzð 	Ø�JŠJ�tÑÔÐØØÔ Ô%×)Ò)Ñ+Ô+ˆØð 	GØ˜˜˜˜2˜A˜2˜”;×$Ò$Ñ&Ô&ˆDØ�JŠJ˜˜d 1 1 1 a 4œj×.Ò.Ñ0Ô0°$°q°q°q¸!°t´*×2BÒ2BÑ2DÔ2DÐEÑFÔFÐFÑFà—=’=  a a a¨¨!¨ e¤Ñ-Ô-×3Ò3Ñ5Ô5ˆDØ�JŠJ˜˜d 1 1 1 a 4œj×.Ò.Ñ0Ô0°$°q°q°q¸!°t´*×2BÒ2BÑ2DÔ2DÐEÑFÔFÐFÑFà€IÔØ€Jr(   c                ó<  ‡— | r|s<t          j        t          | ¦  «        t          |¦  «        ft           j        ¬¦  «        S d„ | D ¦   «         }d„ |D ¦   «         }t	          d„ g |¢|¢R D ¦   «         d¦  «        }t          j        |t           j        ¬¦  «        Št          j        ˆfd„|D ¦   «         t           j        ¬¦  «        }t          j        ˆfd„|D ¦   «         t           j        ¬¦  «        }t          j        d„ |D ¦   «         ¦  «        d	d	…d	f         t          j        d
„ |D ¦   «         ¦  «        d	d	d	…f         z  }t          j        |t          j	        d||j
        z  z
  dd¦  «        t           j        ¦  «                             t           j        ¦  «        S )aP  Cosine distance in `[0, 1]` between track and detection embeddings; NaN where either side has no feature.

    A NaN entry signals "no appearance evidence for this pair" so the caller falls back to motion rather than treating a
    missing/occlusion-suppressed embedding as maximally dissimilar (which would penalize true matches).
    r   c                ó8   — g | ]}|j         �|j         n|j        ‘ŒS ©N)Úsmooth_featÚ	curr_feat)r#   Úts     r%   r&   z$_cosine_distance.<locals>.<listcomp>È   s'   € ÐYÐYÐYÈQ˜aœmÐ7ˆQŒ]ˆ]¸Q¼[ÐYÐYÐYr(   c                ó   — g | ]	}|j         ‘Œ
S r   )rê   )r#   Úds     r%   r&   z$_cosine_distance.<locals>.<listcomp>É   s   € Ð'Ð'Ð'˜QˆQŒ[Ð'Ð'Ð'r(   c              3  ó4   K  — | ]}|®|j         d         V — Œd S r¬   )r‹   ©r#   Úfs     r%   ú	<genexpr>z#_cosine_distance.<locals>.<genexpr>Ê   s(   è è € ÐFÐF˜q¸¸�”˜”
¸¸¸¸ÐFÐFr(   é€   c                ó   •— g | ]}|�|n‰‘Œ	S rè   r   ©r#   rð   r0   s     €r%   r&   z$_cosine_distance.<locals>.<listcomp>Î   ó!   ø€ ÐAÐAÐA°a˜˜�A�A¨EÐAÐAÐAr(   c                ó   •— g | ]}|�|n‰‘Œ	S rè   r   rô   s     €r%   r&   z$_cosine_distance.<locals>.<listcomp>Ï   rõ   r(   c                ó   — g | ]}|d u‘ŒS rè   r   rï   s     r%   r&   z$_cosine_distance.<locals>.<listcomp>Ð   s   € Ð3Ð3Ð3¨�a˜t�mÐ3Ð3Ð3r(   Nc                ó   — g | ]}|d u‘ŒS rè   r   rï   s     r%   r&   z$_cosine_distance.<locals>.<listcomp>Ð   s   € ÐIgÐIgÐIgÐ\]È!ÐSWÈ-ÐIgÐIgÐIgr(   r
   r   )r/   r2   r.   r1   Únextr0   Úasarrayr_   Úwherer7   r5   ÚnanÚastype)	rA   rB   ÚtfeatÚdfeatrÈ   r5   ÚDÚvalidr0   s	           @r%   Ú_cosine_distancer  À   s™  ø€ ð ð C˜ð CÝŒw�˜F™œ¥S¨¡Y¤YÐ/µr´zÐBÑBÔBÐBØYÐYÐRXÐYÑYÔY€EØ'Ð' $Ð'Ñ'Ô'€EÝ
ÐFÐFÐ$4 eÐ$4¨eÐ$4Ð$4ÐFÑFÔFÈÑ
LÔ
L€CÝŒH�S¥¤
Ð+Ñ+Ô+€Eõ 	Œ
ÐAÐAÐAÐA¸5ÐAÑAÔAÍÌÐTÑTÔT€AÝ
Œ
ÐAÐAÐAÐA¸5ÐAÑAÔAÍÌÐTÑTÔT€AÝŒHÐ3Ð3¨UÐ3Ñ3Ô3Ñ4Ô4°Q°Q°Q¸°WÔ=ÅÄÐIgÐIgÐafÐIgÑIgÔIgÑ@hÔ@hÐimÐopÐopÐopÐipÔ@qÑq€EÝŒ8�E�2œ7 1 q¨1¬3¡w¡;°°1Ñ5Ô5µr´vÑ>Ô>×EÒEÅbÄjÑQÔQÐQr(   c                  ód   ‡ — e Zd ZdZdZdZdZdd ˆ fd„Zd!d„Zd"d„Z	d#d„Z
d$d%d„Zd&d„Zd'd„Zˆ xZS )(ÚTTSTracka”  Single-object track for TrackTrack with corner velocity, score history, and ReID features.

    Extends `BOTrack` (XYWH Kalman state and EMA ReID smoothing), adding corner-velocity motion, score history, and
    score-adaptive feature smoothing.

    Attributes:
        min_track_len (int): Class-level default; overridden by TRACKTRACK from config.
        kalman_filter (KalmanFilterXYWH): Per-track Kalman filter used after activation.
        mean (np.ndarray): Mean state vector.
        covariance (np.ndarray): Covariance matrix.
        score (float): Current detection confidence.
        prev_score (float): Confidence from the previous update (for score projection).
        tracklet_len (int): Successful updates since activation.
        velocity (np.ndarray): Per-corner (4,2) unit velocity vectors.
        smooth_feat (np.ndarray | None): EMA-smoothed ReID embedding.
        curr_feat (np.ndarray | None): Raw ReID embedding from the current frame.

    Examples:
        Create and activate a new track
        >>> track = TTSTrack(np.array([100, 200, 50, 80, 0]), score=0.9, cls="person")
        >>> track.activate(KalmanFilterXYWH(), frame_id=1)
    r   r   Nrä   rG   rV   r{   Úclsr   Úfeatúnp.ndarray | Nonec                ó  •— t          ¦   «                              |||¦  «         || _        t          j        dt          j        ¬¦  «        | _        t          | j        dz   ¬¦  «        | _	        |�|  
                    |¦  «         dS dS )aZ  Initialize a TTSTrack from a detection bounding box.

        Args:
            xywh (np.ndarray): `(x, y, w, h, idx)` or `(x, y, w, h, angle, idx)`, center-based with detection index.
            score (float): Detection confidence.
            cls (Any): Class label.
            feat (np.ndarray | None): Optional ReID feature vector.
        ©r,   r   r   r
   )ÚmaxlenN)ÚsuperÚ__init__rn   r/   r0   r1   rP   r   Ú_delta_tÚ_historyÚupdate_features)Úselfrä   rV   r  r  Ú	__class__s        €r%   r  zTTSTrack.__init__ð   s‚   ø€ õ 	‰Œ×Ò˜˜u cÑ*Ô*Ð*ØˆŒÝœ ­r¬zÐ:Ñ:Ô:ˆŒÝ7<ÀDÄMÐTUÑDUÐ7VÑ7VÔ7VˆŒØÐØ× Ò  Ñ&Ô&Ð&Ð&Ð&ð Ðr(   r   r¨   c                ó˜   — | j         d| j         z
  d| j        z
  z  z   }t          || j        |¦  «        \  }}|�||c| _        | _        dS dS )zHNormalize `feat` and blend it into `smooth_feat` via score-adaptive EMA.r
   N)Ú_alpharV   r   ré   rê   )r  r  ÚbetaÚcurrÚsmooths        r%   r  zTTSTrack.update_features   s\   € àŒ{˜a $¤+™o°!°d´j±.ÑAÑAˆÝ% d¨DÔ,<¸dÑCÔC‰ˆˆfØÐØ/3°VÐ,ˆDŒN˜DÔ,Ð,Ð,ð Ðr(   rC   rD   Údtc                óÄ   — ||z
  }| j         D ]!\  }}||k    r|                     ¦   «         c S Œ"| j         r%| j         d         d                              ¦   «         S | j        S )zQReturn the box from `dt` frames back, or the most recent box, or the current box.rQ   r
   )r  rŠ   r!   )r  rC   r  ÚtargetÚfidÚboxs         r%   rJ   zTTSTrack.get_history_box  sr   € à˜B‘ˆØœð 	"ð 	"‰HˆC�Ø�fŠ}ˆ}Ø—x’x‘z”zÐ!Ð!Ð!ð àŒ=ð 	/Ø”= Ô$ QÔ'×,Ò,Ñ.Ô.Ð.ØŒyÐr(   Úkalman_filterr   c                ó¶  — || _         |                      ¦   «         | _        |                     |                      | j        ¦  «        ¦  «        \  | _        | _        | j         	                    || j
        f¦  «         d| _        | j        dk    rt          j        nt          j        | _        |dk    p| j        t          j        k    | _        |x| _        | _        dS )z1Initialize Kalman state and promote to New state.r   r
   N)r  Únext_idÚtrack_idÚinitiateÚconvert_coordsÚ_tlwhr]   Ú
covariancer  rÒ   r!   Útracklet_lenÚmin_track_lenr   ÚTrackedÚNewÚstateÚis_activatedrC   Ústart_frame)r  r  rC   s      r%   ÚactivatezTTSTrack.activate  sº   € à*ˆÔØŸš™œˆŒØ%2×%;Ò%;¸D×<OÒ<OÐPTÔPZÑ<[Ô<[Ñ%\Ô%\Ñ"ˆŒ	�4”?ØŒ×Ò˜h¨¬	Ð2Ñ3Ô3Ð3ØˆÔØ+/Ô+=ÀÒ+BÐ+B•ZÔ'Ð'Í
ÌˆŒ
Ø$¨šMÐM¨T¬Z½:Ô;MÒ-MˆÔØ+3Ð3ˆŒ˜Ô(Ð(Ð(r(   FÚnew_idÚboolc                ó*  — | j         | _        | j                             | j        | j        |                      |j        ¦  «        |j         ¬¦  «        \  | _        | _        | j         	                    || j
        f¦  «         |j         | _         |j        �|                      |j        ¦  «         d| _        t          j        | _        d| _        || _        |r|                      ¦   «         | _        |j        |j        |j        c| _        | _        | _        dS )z8Rebind a lost track to a fresh detection via NSA-Kalman.©Ú
confidenceNr   T)rV   rn   r  Úupdater]   r#  r!  Útlwhr  rÒ   r!   rê   r  r$  r   r&  r(  r)  rC   r  r  r  ÚangleÚidx)r  Ú	new_trackrC   r,  s       r%   Úre_activatezTTSTrack.re_activate  sò   € àœ*ˆŒØ%)Ô%7×%>Ò%>ØŒI�t”¨×(;Ò(;¸I¼NÑ(KÔ(KÐXaÔXgð &?ñ &
ô &
Ñ"ˆŒ	�4”?ð 	Œ×Ò˜h¨¬	Ð2Ñ3Ô3Ð3Ø”_ˆŒ
ØÔÐ*Ø× Ò  Ô!4Ñ5Ô5Ð5ØˆÔÝÔ'ˆŒ
Ø ˆÔØ ˆŒØð 	+Ø ŸLšL™NœNˆDŒMØ)2¬¸	¼ÈÌÐ&ˆŒ�$”*˜dœh˜h˜hr(   c                óæ  — || _         | xj        dz  c_        | j        | _        | j                             | j        | j        |                      |j	        ¦  «        |j        ¬¦  «        \  | _        | _        | j
                             ||j        f¦  «         t          j        dt          j        ¬¦  «        }|j        }t!          d| j        dz   ¦  «        D ]y}||                      ||¦  «        z
  }|t&                   |t(                   }}t          j        ||z  ||z  z   ¦  «        dz   }	|t          j        ||	z  ||	z  gd¬¦  «        |z  z  }Œz|| j        z  | _        |j        | _        |j        �|                      |j        ¦  «         | j        t6          j        k    s| j        dz   | j        k    rt6          j        | _        d	| _        |j        |j         |j!        c| _        | _         | _!        dS )
zTUpdate a matched track with a new detection; promote to Tracked after min_track_len.r
   r/  r	  r   rN   rQ   rR   NT)"rC   r$  rV   rn   r  r1  r]   r#  r!  r2  r  rÒ   r!   r/   r0   r1   r�   r  rJ   rX   rY   rZ   rW   rP   rê   r  r(  r   r&  r%  r)  r  r3  r4  )
r  r5  rC   rP   Úcurr_boxr  Údeltare   rf   Únorms
             r%   r1  zTTSTrack.update.  sÔ  € à ˆŒØÐÔ˜QÑÐÔØœ*ˆŒØ%)Ô%7×%>Ò%>ØŒI�t”¨×(;Ò(;¸I¼NÑ(KÔ(KÐXaÔXgð &?ñ &
ô &
Ñ"ˆŒ	�4”?ð 	Œ×Ò˜h¨	¬Ð7Ñ8Ô8Ð8å”8˜F­"¬*Ð5Ñ5Ô5ˆØ”>ˆÝ˜˜4œ=¨1Ñ,Ñ-Ô-ð 	Gð 	GˆBØ˜t×3Ò3°H¸bÑAÔAÑAˆEØ�>Ô*¨Eµ.Ô,A�ˆBÝ”7˜2 ™7 R¨"¡WÑ,Ñ-Ô-°Ñ4ˆDØ�œ " t¡)¨R°$©YÐ!7¸bÐAÑAÔAÀBÑFÑFˆHˆHØ  4¤=Ñ0ˆŒà”_ˆŒ
ØÔÐ*Ø× Ò  Ô!4Ñ5Ô5Ð5àŒ:�Ô+Ò+Ð+¨tÔ/@À1Ñ/DÈÔHZÒ/ZÐ/ZÝ#Ô+ˆDŒJØ $ˆDÔØ)2¬¸	¼ÈÌÐ&ˆŒ�$”*˜dœh˜h˜hr(   Ústrc                ó8   — d| j         › d| j        › d| j        › d�S )z)Short string representation of the track.ÚTT_z_(ú-ú))r  r*  Ú	end_frame©r  s    r%   Ú__repr__zTTSTrack.__repr__J  s*   € àJ�T”]ÐJÐJ dÔ&6ÐJÐJ¸¼ÐJÐJÐJÐJr(   rè   )rä   rG   rV   r{   r  r   r  r  )r  rG   r   r¨   )rC   rD   r  rD   r   rG   )r  r   rC   rD   r   r¨   )F)rC   rD   r,  r-  r   r¨   )rC   rD   r   r¨   )r   r;  )Ú__name__Ú
__module__Ú__qualname__Ú__doc__r%  r  r  r  r  rJ   r+  r6  r1  rB  Ú__classcell__)r  s   @r%   r  r  Ô   së   ø€ € € € € ðð ð. €MØ€FØ€Hð'ð 'ð 'ð 'ð 'ð 'ð 'ð <ð <ð <ð <ðð ð ð ð	4ð 	4ð 	4ð 	4ðWð Wð Wð Wð Wð$Wð Wð Wð Wð8Kð Kð Kð Kð Kð Kð Kð Kr(   r  c                  óf   — e Zd ZdZd„ Zed„ ¦   «         Zed„ ¦   «         Zdd
„Zdd„Z	ddd„Z
dd„ZdS )Ú
TRACKTRACKay  Multi-object tracker implementing Track-Perspective Association and Track-Aware Initialization.

    Detections are partitioned into high, low, and deleted (loose-NMS recovered) sets, then matched against the union of
    tracked and lost tracks using a multi-cue cost (HMIoU + cosine ReID + confidence + angle distance) solved with
    iterative assignment. Unmatched still-Lost tracks may optionally be re-associated against leftover detections in a
    relaxed second pass, and surviving leftover detections spawn new tracks via track-aware NMS.

    Attributes:
        tracked_stracks (list[TTSTrack]): Currently tracked tracks.
        lost_stracks (list[TTSTrack]): Tracks that lost their detection but remain within the buffer window.
        frame_id (int): Current frame index.
        args (Any): Parsed tracker configuration.
        max_time_lost (int): Frame budget before a lost track is removed (scaled to source frame rate).
        kalman_filter (KalmanFilterXYWH): Kalman filter for new-track initialization.
        match_thr (float): Cost gate for the main iterative assignment.
        lost_match_thr (float): Cost gate for the optional relaxed lost-rebind pass; 0 disables it.
        gmc (GMC): Global motion compensation for camera-motion warping.
        encoder (Any): ReID encoder, or None when ReID is disabled.

    Methods:
        update: Advance the tracker by one frame and return per-object tracking results.
        reset: Clear all tracker state.

    Examples:
        Initialize and run on a single frame
        >>> tracker = TRACKTRACK(args)
        >>> tracked_objects = tracker.update(yolo_results, img=image)
    c           	     ól  — g | _         g | _        g | _        d| _        || _        |j        | _        t          ¦   «         | _        t          |dd¦  «        | _
        t          |dd¦  «        | _        t          |dd¦  «        | _        t          |dd	¦  «        | _        t          |d
d¦  «        | _        t          |dd¦  «        | _        t          |dd¦  «        | _        t          |dd¦  «        | _        t          |dd¦  «        | _        t          |dd¦  «        | _        t          |dd¦  «        | _        t          |dd¦  «        | _        t-          t          |dd¦  «        ¬¦  «        | _        ddlm}  |t          |dd¦  «        t          |dd¦  «        t          |d d!¦  «        ¦  «        | _        d!S )"a#  Initialize TRACKTRACK from a tracker config (see `ultralytics/cfg/trackers/tracktrack.yaml`).

        Args:
            args (Any): Parsed tracker configuration. All knobs are read with `getattr(..., default)` so legacy YAMLs
                missing recently added keys still load.
        r   Úmatch_threshgffffffæ?Úlost_match_thrg        Ú	penalty_pgš™™™™™É?Ú	penalty_qgš™™™™™Ù?r|   rx   Ú
iou_weightg      à?Úreid_weightÚconf_weightçš™™™™™¹?Úangle_weightr•   gš™™™™™á?r–   r%  r   Ú
gmc_methodÚsparseOptFlow)Úmethodr
   )Úbuild_encoderÚ	with_reidFÚmodelÚautoÚdeviceN)Útracked_stracksÚlost_stracksÚremoved_stracksrC   rº   Útrack_bufferÚmax_time_lostr   r  rË   rz   rL  rM  rN  r|   rO  rP  rQ  rS  r•   r–   r%  r   ÚgmcÚ
utils.reidrW  Úencoder)r  rº   rW  s      r%   r  zTRACKTRACK.__init__m  s¥  € ð 02ˆÔØ,.ˆÔØ/1ˆÔØˆŒØˆŒ	Ø!Ô.ˆÔÝ-Ñ/Ô/ˆÔå   ~°sÑ;Ô;ˆŒÝ% dÐ,<¸cÑBÔBˆÔÝ   {°CÑ8Ô8ˆŒÝ   {°CÑ8Ô8ˆŒÝ" 4¨¸Ñ=Ô=ˆÔÝ! $¨°cÑ:Ô:ˆŒÝ" 4¨¸Ñ<Ô<ˆÔÝ" 4¨¸Ñ<Ô<ˆÔÝ# D¨.¸$Ñ?Ô?ˆÔÝ˜t Y°Ñ5Ô5ˆŒÝ '¨Ð.@À#Ñ FÔ FˆÔÝ$ T¨?¸AÑ>Ô>ˆÔå�g d¨L¸/ÑJÔJÐKÑKÔKˆŒà-Ð-Ð-Ð-Ð-Ð-à$�}Ý�D˜+ uÑ-Ô-­w°t¸WÀfÑ/MÔ/MÍwÐW[Ð]eÐgkÑOlÔOlñ
ô 
ˆŒˆˆr(   c                ót   — ddl m} |j        j        dv r!t	          ||¦  «        rt          |¦  «         dS dS dS )a¡  Attach the raw-predictions hook for Track-Aware Initialization (detect/obb only).

        Recovered (loose-NMS) detections are box-only and have no row in the post-NMS Results, so on segment/pose
        tasks they cannot carry mask/keypoint data and would mis-index downstream; skip recovery (and its
        per-frame overhead) for those tasks and RT-DETR predictors, which do not suppress boxes with NMS.
        r   )ÚDetectionPredictor>   rÇ   ÚdetectN)Úultralytics.models.yolo.detectre  rº   rÏ   r­   rÂ   )r  r¾   re  s      r%   Úsetup_predictorzTRACKTRACK.setup_predictor‘  sZ   € ð 	FÐEÐEÐEÐEÐEàŒ>ÔÐ"3Ð3Ð3½
À9ÐN`Ñ8aÔ8aÐ3Ý! )Ñ,Ô,Ð,Ð,Ð,ð 4Ð3Ð3Ð3r(   c                ó    — t          |¦  «        S )zRReturn per-batch ``(xywh, conf, cls)`` tuples for detections dropped by tight NMS.)rå   )r  r¾   s     r%   Úcompute_frame_extraszTRACKTRACK.compute_frame_extrasž  s   € õ   	Ñ*Ô*Ð*r(   rA   r   rB   r   rG   c           
     ó  — t          ||¦  «        \  }}| j        �Lt          ||¦  «        }t          j        t          j        |¦  «        || j        |z  | j        |z  z   ¦  «        }n|}|| j        t          ||¦  «        z  z  }|j
        dk    rb|dk    }t          j        |¦  «        }t          |d         ¦  «        r-||xx         | j        t          ||| j        |¦  «        z  z  cc<   d|| <   t          j        |dd¦  «        S )z[Return the multi-cue cost matrix (HMIoU + ReID + confidence + angle), gated by IoU support.Nr   rR  r-   r
   )r@   rc  r  r/   rû   ÚisnanrO  rP  rQ  rw   ÚsizeÚnonzeror.   rS  rk   rC   r7   )	r  rA   rB   r<   Ú
hmiou_distÚcosry   Ú	supportedrE   s	            r%   Ú_cost_matrixzTRACKTRACK._cost_matrix£  s  € å-¨f°dÑ;Ô;Ñˆ�ØŒ<Ð#Ý" 6¨4Ñ0Ô0ˆCõ ”8�BœH S™MœM¨:°t´ÈÑ7SÐVZÔVfÐilÑVlÑ7lÑmÔmˆDˆDàˆDØ�Ô Õ#7¸ÀÑ#EÔ#EÑEÑEˆØŒ<˜!ÒÐØ $šˆIÝ”J˜yÑ)Ô)ˆEÝ�5˜”8‰}Œ}ð gØ�U��”˜tÔ0µ?À6È4ÐQUÔQ^Ð`eÑ3fÔ3fÑfÑf��‘Ø"ˆD�)�ÑÝŒw�t˜Q Ñ"Ô"Ð"r(   r¸   Ú
detectionsr®   Úpoolsúlist[list[TTSTrack]]r¨   c                ó  — 	 | j                              |d„ |D ¦   «         ¦  «        }nC# t          $ r6}t          j        d|› �¦  «         t          j        dd¦  «        }Y d}~nd}~ww xY w|D ]}t          ||¦  «         ŒdS )z0Warp `pools` in place by the current GMC affine.c                ó   — g | ]	}|j         ‘Œ
S r   r    rq   s     r%   r&   z)TRACKTRACK._apply_gmc.<locals>.<listcomp>¹  s   € Ð'GÐ'GÐ'G°S¨¬Ð'GÐ'GÐ'Gr(   z&GMC failed, falling back to identity: r   r   N)ra  ÚapplyÚ	Exceptionr	   Úwarningr/   Úeyer   )r  r¸   rs  rt  ÚwarpÚeÚpools          r%   Ú
_apply_gmczTRACKTRACK._apply_gmc¶  s¬   € ð	 Ø”8—>’> #Ð'GÐ'G¸JÐ'GÑ'GÔ'GÑHÔHˆDˆDøÝð 	 ð 	 ð 	 ÝŒNÐGÀAÐGÐGÑHÔHÐHÝ”6˜!˜Q‘<”<ˆDˆDˆDˆDˆDˆDøøøøð	 øøøð ð 	"ð 	"ˆDÝ�d˜DÑ!Ô!Ð!Ð!ð	"ð 	"s   ‚%( ¨
A(²,A#Á#A(Nr  c           	     óh  ‡ ‡2‡3‡4‡5‡6— ‰ xj         dz  c_         g g g g f\  }}Š5}t          j        |j        ¦  «        }t	          |¦  «        }	|‰ j        j        k    }
|‰ j        j        k    |‰ j        j        k     z  }dˆ fd„	Š2|	|
         ||
         |j        |
         }}}| 	                    d¦  «        }t          ‰ j        dd¦  «        dk    }d}‰ j        �5t          |¦  «        dk    r"|r|�t          |¦  «        r||
         nd}n|�|}|�5‰                      ||¦  «        }ˆ2fd„t          ||||¦  «        D ¦   «         }nˆ2fd	„t          |||¦  «        D ¦   «         }ˆ2fd
„t          |	|         ||         |j        |         ¦  «        D ¦   «         }g }|�˜|\  }}}|‰ j        j        k    }|                     ¦   «         rnt          j        ||         t          j        |                     ¦   «         df¦  «         gd¬¦  «        }ˆ2fd„t          |||         ||         ¦  «        D ¦   «         }g g }}‰ j        D ].}|j        t(          j        k    r|n|                     |¦  «         Œ/t/          |‰ j        ¦  «        }|�%‰ j        j        �‰                      ||||g¦  «         t8                               |¦  «         t8                               |¦  «         ||z   |z   Š3t          |¦  «        t          |¦  «        cŠ6}‰                      |‰3¦  «        } | j        d         ‰6k    r| dd…‰6‰6|z   …fxx         ‰ j         z  cc<   |r| dd…‰6|z   d…fxx         ‰ j!        z  cc<   t          j"        | dd¦  «        } tG          | ‰ j$        ‰ j%        ¦  «        \  }!}"}#|!D ]�\  }$}%||$         ‰3|%         }&}|j        t(          j        k    r1| &                    |&‰ j         ¦  «         |                     |¦  «         Œ[| '                    |&‰ j         d¬¦  «         |                     |¦  «         ŒŽ|"D ]H}$||$         }|j        t(          j(        k    r)| )                    ¦   «          ‰5                     |¦  «         ŒIˆ3ˆ6fd„|#D ¦   «         Š4|rÊ‰4rÈ‰                      |‰4¦  «        }'tG          |'‰ j$        ‰ j%        ¦  «        \  }(})}*|(D ]G\  }$}%||$          &                    ‰4|%         ‰ j         ¦  «         |                     ||$         ¦  «         ŒH|)D ]7}$||$          *                    ¦   «          |                     ||$         ¦  «         Œ8ˆ4fd„|*D ¦   «         Š4n.|D ]+}| *                    ¦   «          |                     |¦  «         Œ,‰ j+        dk    r¡‰4rŸˆ5fd„|D ¦   «         }+|+r�‰                      |+‰4¦  «        },tG          |,‰ j+        ‰ j%        ¦  «        \  }-}.}/|-D ]I\  }$}%|+|$          '                    ‰4|%         ‰ j         d¬¦  «         |                     |+|$         ¦  «         ŒJˆ4fd„|/D ¦   «         Š4d„ ‰ j        D ¦   «         |z   }0t          ‰4tY          |0‰4‰ j-        ‰ j.        ¦  «        ¦  «        D ]<\  }&}1|1r5|& /                    ‰ j0        ‰ j         ¦  «         |                     |&¦  «         Œ=‰ j        D ]C}‰ j         |j1        z
  ‰ j2        k    r)| *                    ¦   «          |                     |¦  «         ŒDtg          ‰ ||‰5|¦  «         t          j        ˆ fd„‰ j        D ¦   «         t          j4        ¬¦  «        S )ziAdvance the tracker by one frame and return an `(N, 8)` array of `[x1, y1, x2, y2, id, score, cls, idx]`.r
   Nc                ój   •— |�t          | |||¦  «        nt          | ||¦  «        }‰j        |_        |S rè   )r  r%  )r  rV   r  r  r$   r  s        €r%   Ú
_new_trackz%TRACKTRACK.update.<locals>._new_trackÊ  s?   ø€ Ø7;Ð7G•H˜S %¨¨dÑ3Ô3Ð3ÍXÐVYÐ[`ÐbeÑMfÔMfˆEØ"&Ô"4ˆEÔØˆLr(   ÚfeatsrY  rZ  r   c                ó6   •— g | ]\  }}}} ‰||||¦  «        ‘ŒS r   r   )r#   ÚbÚsÚcrð   r‚  s        €r%   r&   z%TRACKTRACK.update.<locals>.<listcomp>Û  s1   ø€ ÐsÐsÐs±J°A°q¸!¸Q˜˜ A q¨!¨QÑ/Ô/ÐsÐsÐsr(   c                ó2   •— g | ]\  }}} ‰|||¦  «        ‘ŒS r   r   ©r#   r…  r†  r‡  r‚  s       €r%   r&   z%TRACKTRACK.update.<locals>.<listcomp>Ý  s-   ø€ ÐcÐcÐc±°°A°q˜˜ A q¨!Ñ,Ô,ÐcÐcÐcr(   c                ó2   •— g | ]\  }}} ‰|||¦  «        ‘ŒS r   r   r‰  s       €r%   r&   z%TRACKTRACK.update.<locals>.<listcomp>Þ  s-   ø€ ÐuÐuÐu©G¨A¨q°!�J�J˜q ! QÑ'Ô'ÐuÐuÐur(   rQ   rR   c                ó2   •— g | ]\  }}} ‰|||¦  «        ‘ŒS r   r   r‰  s       €r%   r&   z%TRACKTRACK.update.<locals>.<listcomp>æ  s-   ø€ Ð!sÐ!sÐ!s¹'¸!¸QÀ * *¨Q°°1Ñ"5Ô"5Ð!sÐ!sÐ!sr(   F)r,  c                ó,   •— g | ]}|‰k     ¯‰|         ‘ŒS r   r   )r#   rK   Úall_detsÚn_highs     €€r%   r&   z%TRACKTRACK.update.<locals>.<listcomp>  s"   ø€ ÐFÐFÐF A¸1¸vº:¸:�H˜Q”K¸:¸:¸:r(   c                ó    •— g | ]
}‰|         ‘ŒS r   r   ©r#   rK   Úleftovers     €r%   r&   z%TRACKTRACK.update.<locals>.<listcomp>  s   ø€ Ð?Ð?Ð?¨˜ œÐ?Ð?Ð?r(   c                óF   •— g | ]}|j         t          j        k    ¯|‰v¯|‘ŒS r   )r(  r   ÚLost)r#   rë   Úlosts     €r%   r&   z%TRACKTRACK.update.<locals>.<listcomp>!  s3   ø€ Ð^Ð^Ð^ A°´½J¼OÒ1KÐ1KÐPQÐY]ÐP]ÐP]˜aÐP]ÐP]ÐP]r(   c                ó    •— g | ]
}‰|         ‘ŒS r   r   r�  s     €r%   r&   z%TRACKTRACK.update.<locals>.<listcomp>(  s   ø€ Ð@Ð@Ð@¨A˜H QœKÐ@Ð@Ð@r(   c                ó<   — g | ]}|j         t          j        k    ¯|‘ŒS r   )r(  r   r&  r"   s     r%   r&   z%TRACKTRACK.update.<locals>.<listcomp>+  s'   € Ð_Ð_Ð_˜E¸U¼[ÍJÔL^Ò=^Ð=^�%Ð=^Ð=^Ð=^r(   c                óL   •— g | ] }|j         ¯	|j        ‰j        k    ¯|j        ‘Œ!S r   )r)  rC   Úresult)r#   r$   r  s     €r%   r&   z%TRACKTRACK.update.<locals>.<listcomp>8  s5   ø€ ÐvÐvÐv˜e¸uÔ?QÐvÐV[ÔVdÐhlÔhuÒVuÐVuˆUŒ\ÐVuÐVuÐVur(   r   rè   )5rC   r/   rú   Úconfr   rº   Útrack_high_threshÚtrack_low_threshr  ÚgetrË   rc  r.   rÐ   rÕ   Úconcatenater2   Úsumr\  r(  r   r&  rÒ   r   r]  ra  rV  r  r  Úmulti_predictrr  r‹   rM  rN  r7   r”   rz   r|   r1  r6  r“  Ú	mark_lostÚmark_removedrL  r§   r•   r–   r+  r  r@  r`  r   r1   )7r  rÑ   r¸   Údets_delr»   Ú	activatedÚrefindÚremovedrŸ   r£   Ú	high_maskÚlow_maskÚ
high_boxesÚhigh_scoresÚhigh_clsrƒ  Ú
use_nativeÚencoder_inputÚfeaturesÚ	dets_highÚdets_lowÚdets_recoveredÚdel_xywhÚdel_confÚdel_clsrâ   Ú	del_boxesÚunconfirmedÚtrackedr$   r~  Ún_lowry   r�   r’   r“   r`   ra   rr   Úuc_costÚ
uc_matchesÚuc_unmatched_tracksÚuc_unmatched_detsÚunmatched_lostÚ	lost_costÚlost_matchesrƒ   Úlost_unmatchedÚactiveÚokr‚  r�  r‘  r”  rŽ  s7   `                                                 @@@@@r%   r1  zTRACKTRACK.updateÀ  s<  øøøøøø€ àˆŒ˜ÑˆŒØ+-¨r°2°r¨>Ñ(ˆ	�6˜4 å”˜GœLÑ)Ô)ˆÝ˜WÑ%Ô%ˆØ˜dœiÔ9Ò9ˆ	Ø˜TœYÔ7Ò7¸FÀTÄYÔE`Ò<`Ñaˆð	ð 	ð 	ð 	ð 	ð 	ð
 -2°)Ô,<¸fÀYÔ>OÐQXÔQ\Ð]fÔQg �Kˆ
Ø—
’
˜7Ñ#Ô#ˆÝ˜TœY¨°Ñ8Ô8¸FÒBˆ
ØˆØŒ<Ð#­¨J©¬¸!Ò(;Ð(;Øð $Ø5:Ð5FÍ3ÈuÉ:Ì:Ð5F  iÔ 0Ð 0Ð\`��Ø�Ø #�àÐ$Ø—|’| M°:Ñ>Ô>ˆHØsÐsÐsÐsÅ#ÀjÐR]Ð_gÐiqÑBrÔBrÐsÑsÔsˆIˆIàcÐcÐcÐc½CÀ
ÈKÐYaÑ<bÔ<bÐcÑcÔcˆIØuÐuÐuÐuµs¸5À¼?ÈFÐS[ÔL\Ð^eÔ^iÐjrÔ^sÑ7tÔ7tÐuÑuÔuˆà)+ˆØÐØ*2Ñ'ˆH�h Ø˜dœiÔ9Ò9ˆDØ�xŠx‰zŒzð tÝœN¨H°T¬N½R¼WÀdÇhÂhÁjÄjÐRSÀ_Ñ=UÔ=UÐ<UÐ+VÐ]_Ð`Ñ`Ô`�	Ø!sÐ!sÐ!sÐ!sÅSÈÐT\Ð]aÔTbÐdkÐlpÔdqÑErÔErÐ!sÑ!sÔ!s�ð  " 2�WˆØÔ)ð 	Zð 	ZˆEØœ¥zÔ'9Ò9Ð9ˆWˆW¸{×RÒRÐSXÑYÔYÐYÐYÝ˜W dÔ&7Ñ8Ô8ˆàˆ?˜tœxœÐ:Ø�OŠO˜C ¨T°;Ð,?Ñ@Ô@Ð@Ý×Ò˜tÑ$Ô$Ð$Ý×Ò˜{Ñ+Ô+Ð+ð ˜xÑ'¨.Ñ8ˆÝ˜I™œ­¨H©¬ˆˆ�Ø× Ò   xÑ0Ô0ˆØŒ:�aŒ=˜6Ò!Ð!Ø����F˜V e™^Ð+Ð+Ð,Ð,Ô,°´Ñ>Ð,Ð,Ñ,Øð 	8Ø����F˜U‘NÐ$Ð$Ð$Ð%Ð%Ô%¨¬Ñ7Ð%Ð%Ñ%ÝŒw�t˜Q Ñ"Ô"ˆå4HÈÈtÌ~Ð_cÔ_oÑ4pÔ4pÑ1ˆÐ! >Ø")ð 	%ð 	%ÑˆI�wØ˜iœ¨(°7Ô*;�3ˆEØŒ{�jÔ0Ò0Ð0Ø—’˜S $¤-Ñ0Ô0Ð0Ø× Ò  Ñ'Ô'Ð'Ð'à×!Ò! # t¤}¸UÐ!ÑCÔCÐCØ—’˜eÑ$Ô$Ð$Ð$Ø)ð 	#ð 	#ˆIØ˜”OˆEØŒ{�jœoÒ-Ð-Ø—’Ñ!Ô!Ð!Ø—’˜EÑ"Ô"Ð"øð GÐFÐFÐFÐF¨ÐFÑFÔFˆØð 	&˜8ð 	&Ø×'Ò'¨°XÑ>Ô>ˆGÝAUØ˜œ¨Ô)9ñBô BÑ>ˆJÐ+Ð->ð '1ð 9ð 9Ñ"�	˜7Ø˜IÔ&×-Ò-¨h°wÔ.?ÀÄÑOÔOÐOØ× Ò  ¨YÔ!7Ñ8Ô8Ð8Ð8Ø0ð 7ð 7�	Ø˜IÔ&×3Ò3Ñ5Ô5Ð5Ø—’˜{¨9Ô5Ñ6Ô6Ð6Ð6Ø?Ð?Ð?Ð?Ð->Ð?Ñ?Ô?ˆHˆHà$ð &ð &�Ø×"Ò"Ñ$Ô$Ð$Ø—’˜uÑ%Ô%Ð%Ð%ð Ô Ò"Ð" xÐ"Ø^Ð^Ð^Ð^¨Ð^Ñ^Ô^ˆNØð AØ ×-Ò-¨n¸hÑGÔG�	Ý2FÀyÐRVÔReÐgkÔgwÑ2xÔ2xÑ/�˜a Ø*6ð =ð =Ñ&�I˜wØ" 9Ô-×9Ò9¸(À7Ô:KÈTÌ]ÐchÐ9ÑiÔiÐiØ—M’M .°Ô";Ñ<Ô<Ð<Ð<Ø@Ð@Ð@Ð@°Ð@Ñ@Ô@�ð `Ð_ TÔ%9Ð_Ñ_Ô_ÐbkÑkˆÝ˜8Õ%5°f¸hÈÌÐVZÔVkÑ%lÔ%lÑmÔmð 	&ð 	&‰GˆC�Øð &Ø—’˜TÔ/°´Ñ?Ô?Ð?Ø× Ò  Ñ%Ô%Ð%øàÔ&ð 	&ð 	&ˆEØŒ}˜uœÑ.°Ô1CÒCÐCØ×"Ò"Ñ$Ô$Ð$Ø—’˜uÑ%Ô%Ð%øå˜$ 	¨6°4¸ÑAÔAÐAÝŒzØvÐvÐvÐv tÔ';ÐvÑvÔvÝ”*ð
ñ 
ô 
ð 	
r(   c                óÈ   — g | _         g | _        g | _        d| _        t	          ¦   «         | _        t                               ¦   «          | j         	                    ¦   «          dS )zMClear all tracker state including GMC warp history and the global ID counter.r   N)
r\  r]  r^  rC   r   r  r  Úreset_idra  Úreset_paramsrA  s    r%   ÚresetzTRACKTRACK.reset<  s[   € à!ˆÔØˆÔØ!ˆÔØˆŒÝ-Ñ/Ô/ˆÔÝ×ÒÑÔÐØŒ×ÒÑÔÐÐÐr(   ©rA   r   rB   r   r   rG   )r¸   rG   rs  r®   rt  ru  r   r¨   )NN)r¸   r  r   rG   ©r   r¨   )rC  rD  rE  rF  r  Úclassmethodrh  rj  rr  r  r1  rÅ  r   r(   r%   rI  rI  O  s¿   € € € € € ðð ð:"
ð "
ð "
ðH ð
-ð 
-ñ „[ð
-ð ð+ð +ñ „[ð+ð#ð #ð #ð #ð&"ð "ð "ð "ðz
ð z
ð z
ð z
ð z
ðx ð  ð  ð  ð  ð  r(   rI  )r   r   r   r   r   r   )r   )rA   r   rB   r   rC   rD   rE   r   rF   rD   r   rG   rÆ  )rx   )ry   rG   rz   r{   r|   r{   r   r}   )
rA   r   rB   r   r•   r{   r–   r{   r   r—   rÇ  )r   rÃ   )-Ú
__future__r   Úcollectionsr   Ú	functoolsr   Útypingr   rØ   r/   r°   rÍ   r   Úutilsr	   Ú	basetrackr   Úbot_sortr   Ú	utils.gmcr   Úutils.kalman_filterr   rb  r   Úutils.stracksr   r   r   r   r_   rX   rY   rÎ   rÔ   r@   rk   rw   r”   r§   rÂ   rå   r  r  rI  r   r(   r%   ú<module>rÓ     sn  ðð #Ð "Ð "Ð "Ð "Ð "à Ð Ð Ð Ð Ð Ø Ð Ð Ð Ð Ð Ø Ð Ð Ð Ð Ð à Ð Ð Ð Ø €€€à .Ð .Ð .Ð .Ð .Ð .à Ð Ð Ð Ð Ð Ø !Ð !Ð !Ð !Ð !Ð !Ø Ð Ð Ð Ð Ð Ø Ð Ð Ð Ð Ð Ø 1Ð 1Ð 1Ð 1Ð 1Ð 1Ø &Ð &Ð &Ð &Ð &Ð &Ø TÐ TÐ TÐ TÐ TÐ TÐ TÐ TÐ TÐ TÐ TÐ Tð �”˜,˜,˜,Ñ'Ô'€Ø�”˜,˜,˜,Ñ'Ô'€à€ØÐ ð*ð *ð *ð *ð wxð=ð =ð =ð =ð =ð,Að Að Að Að5ð 5ð 5ð 5ð 5ð<ð ð ð ð:%ð %ð %ð %ð&"ð "ð "ð "ðJRð Rð Rð Rð(xKð xKð xKð xKð xKˆwñ xKô xKð xKðvu ð u ð u ð u ð u ñ u ô u ð u ð u ð u r(   