§
    l¬¸j¾<  ã                  óž   — d dl mZ d dlmZ d dlZddlmZ ddlm	Z	 ddl
mZmZ dd	lmZ dd
lmZ  G d„ de¦  «        Z G d„ de¦  «        ZdS )é    )Úannotations)ÚAnyNé   )Ú	xyxy2ltwhé   )Ú
TrackState)ÚBYTETrackerÚSTrack)Úmatching)Úparse_bboxesc                  ó|   ‡ — e Zd ZdZd d!ˆ fd„Zd"ˆ fd„Zd#ˆ fd„Zd$d%ˆ fd„Zed&d„¦   «         Z	d'd„Z
d(d„Zd)d„Zˆ xZS )*ÚOCSortTracka!  Track object for OC-SORT with observation-centric state management.

    Extends STrack with storage of real detector observations and velocity computation, enabling the three OC-SORT
    components: ORU, OCM, and OCR.

    Attributes:
        last_observation (np.ndarray): Last real detection in xyxy format.
        observations (dict): Maps frame_id to xyxy observation arrays.
        velocity (np.ndarray | None): Observation-centric velocity direction vector (dx, dy).
        delta_t (int): Temporal window for velocity computation.
    é   Úxywhú
np.ndarrayÚscoreÚfloatÚclsr   Údelta_tÚintc                óâ   •— t          ¦   «                              |||¦  «         t          j        g d¢t          j        ¬¦  «        | _        i | _        d| _        || _        d| _	        d| _
        dS )a‡  Initialize an OCSortTrack with observation storage.

        Args:
            xywh (np.ndarray): Bounding box in `(x, y, w, h, idx)` or `(x, y, w, h, angle, idx)` format.
            score (float): Detection confidence in `[0, 1]`.
            cls (Any): Class label for the detection.
            delta_t (int): Temporal window (in frames) used for velocity direction computation.
        )éÿÿÿÿr   r   r   ©ÚdtypeN)ÚsuperÚ__init__ÚnpÚarrayÚfloat32Úlast_observationÚobservationsÚvelocityr   Ú_saved_meanÚ_saved_covariance)Úselfr   r   r   r   Ú	__class__s        €úl/root/private/project/pallet_detection_v2/.venv/lib/python3.11/site-packages/ultralytics/trackers/oc_sort.pyr   zOCSortTrack.__init__   sm   ø€ õ 	‰Œ×Ò˜˜u cÑ*Ô*Ð*Ý "¤Ð)9Ð)9Ð)9ÅÄÐ LÑ LÔ LˆÔØ35ˆÔØ+/ˆŒØˆŒØ.2ˆÔØ48ˆÔÐÐó    Úframe_idÚreturnÚNonec                ó4  •— t          ¦   «                              ||¦  «         |                      | j                             t
          j        ¦  «        |¦  «         | j                             ¦   «         | _	        | j
                             ¦   «         | _        dS )zâActivate a new tracklet and seed its observation history.

        Args:
            kalman_filter (KalmanFilterXYAH): Shared Kalman filter instance.
            frame_id (int): Frame id at which the track is created.
        N)r   ÚactivateÚ_record_observationÚxyxyÚastyper   r   ÚmeanÚcopyr#   Ú
covariancer$   )r%   Úkalman_filterr)   r&   s      €r'   r-   zOCSortTrack.activate.   sw   ø€ õ 	‰Œ×Ò˜¨Ñ1Ô1Ð1Ø× Ò  ¤×!1Ò!1µ"´*Ñ!=Ô!=¸xÑHÔHÐHØœ9Ÿ>š>Ñ+Ô+ˆÔØ!%¤×!5Ò!5Ñ!7Ô!7ˆÔÐÐr(   Ú	new_trackr
   c                óP  •— |                       |j                             ¦   «         |¦  «         t          ¦   «                              ||¦  «         | j                             ¦   «         | _        | j                             ¦   «         | _        |  	                    ¦   «         | _
        dS )zÍUpdate the track with a matched detection and record the observation.

        Args:
            new_track (STrack): Matched detection for this frame.
            frame_id (int): Current frame id.
        N)r.   r/   r2   r   Úupdater1   r#   r3   r$   Ú_compute_velocityr"   )r%   r5   r)   r&   s      €r'   r7   zOCSortTrack.update:   s‚   ø€ ð 	× Ò  ¤×!4Ò!4Ñ!6Ô!6¸ÑAÔAÐAÝ‰Œ�Š�y (Ñ+Ô+Ð+Øœ9Ÿ>š>Ñ+Ô+ˆÔØ!%¤×!5Ò!5Ñ!7Ô!7ˆÔØ×.Ò.Ñ0Ô0ˆŒˆˆr(   FÚnew_idÚboolc                óR  •— |                       |j                             ¦   «         |¦  «         t          ¦   «                              |||¦  «         | j                             ¦   «         | _        | j                             ¦   «         | _        |  	                    ¦   «         | _
        dS )a   Re-activate a previously lost track with a new detection.

        Args:
            new_track (STrack): Detection used to revive this track.
            frame_id (int): Current frame id.
            new_id (bool): If True, assign a fresh track id instead of reusing the old one.
        N)r.   r/   r2   r   Úre_activater1   r#   r3   r$   r8   r"   )r%   r5   r)   r9   r&   s       €r'   r<   zOCSortTrack.re_activateG   s†   ø€ ð 	× Ò  ¤×!4Ò!4Ñ!6Ô!6¸ÑAÔAÐAÝ‰Œ×Ò˜I x°Ñ8Ô8Ð8Øœ9Ÿ>š>Ñ+Ô+ˆÔØ!%¤×!5Ò!5Ñ!7Ô!7ˆÔØ×.Ò.Ñ0Ô0ˆŒˆˆr(   r/   c                óv   — t          j        | d         | d         z   dz  | d         | d         z   dz  g¦  «        S )z1Return `(cx, cy)` center of an xyxy bounding box.r   r   r   r   )r   r   ©r/   s    r'   Ú_xyxy_centerzOCSortTrack._xyxy_centerU   s=   € õ Œx˜$˜qœ' D¨¤GÑ+¨qÑ0°4¸´7¸TÀ!¼WÑ3DÈÑ2IÐJÑKÔKÐKr(   Úobsc                óÀ   — || _         || j        |<   | j        dz   }t          | j        ¦  «        |k    r(t	          | j        ¦  «        d| …         D ]}| j        |= ŒdS dS )a  Store `obs` for `frame_id`, dropping history beyond `delta_t + 2` to bound memory.

        The retained window always covers the frame `_compute_velocity` reaches back to, since at most `delta_t`
        distinct frames fall inside `(frame_id - delta_t, frame_id]`.
        r   N)r    r!   r   ÚlenÚsorted)r%   r@   r)   Úmax_keepÚframes        r'   r.   zOCSortTrack._record_observationZ   s€   € ð !$ˆÔØ&)ˆÔ˜(Ñ#Ø”< !Ñ#ˆÝˆtÔ Ñ!Ô! HÒ,Ð,Ý Ô 1Ñ2Ô2°:°X°I°:Ô>ð -ð -�ØÔ% eÐ,Ð,ð -Ð,ð-ð -r(   únp.ndarray | Nonec                óÔ  — t          | j        ¦  «        dk     rdS t          | j                             ¦   «         ¦  «        }|                      | j        |         ¦  «        }d}t          | j                             ¦   «         d¬¦  «        D ]"}||| j        z
  dz   k     r| j        |         } nŒ#|€;t          | j                             ¦   «         ¦  «        }||k    rdS | j        |         }||                      |¦  «        z
  }t          j	         
                    |¦  «        }|dk     r t          j        dt          j        ¬¦  «        S ||z                       t          j        ¦  «        S )zùCompute the observation-centric velocity direction from stored observations.

        Returns:
            (np.ndarray | None): Normalized `(dx, dy)` direction vector, or None if there are fewer than two usable
                observations.
        r   NT)Úreverser   ç�íµ ÷Æ°>r   )rB   r!   ÚmaxÚkeysr?   rC   r   Úminr   ÚlinalgÚnormÚzerosr   r0   )r%   Úcurrent_frameÚcurrent_centerÚprev_obsrE   Úearliest_frameÚ	directionrN   s           r'   r8   zOCSortTrack._compute_velocityg   s]  € õ ˆtÔ Ñ!Ô! AÒ%Ð%Ø�4å˜DÔ-×2Ò2Ñ4Ô4Ñ5Ô5ˆØ×*Ò*¨4Ô+<¸]Ô+KÑLÔLˆð ˆÝ˜DÔ-×2Ò2Ñ4Ô4¸dÐCÑCÔCð 	ð 	ˆEØ�} t¤|Ñ3°aÑ7Ò7Ð7ØÔ,¨UÔ3�Ø�ð 8ð
 ÐÝ  Ô!2×!7Ò!7Ñ!9Ô!9Ñ:Ô:ˆNØ Ò.Ð.Ø�tØÔ(¨Ô8ˆHà" T×%6Ò%6°xÑ%@Ô%@Ñ@ˆ	ÝŒy�~Š~˜iÑ(Ô(ˆØ�$Š;ˆ;Ý”8˜A¥R¤ZÐ0Ñ0Ô0Ð0Ø˜DÑ ×(Ò(­¬Ñ4Ô4Ð4r(   Únew_observation_xyxyÚcurrent_frame_idc                óÜ  — | j         �| j        sdS t          | j                             ¦   «         ¦  «        }||z
  }|dk    rdS | j                              ¦   «         | _        | j                             ¦   «         | _        | j        |         }t          d|¦  «        D ]œ}||z  }d|z
  |z  ||z  z   }|  	                    t          |¦  «        ¦  «        }	| j                             | j        | j        ¦  «        \  | _        | _        | j                             | j        | j        |	¦  «        \  | _        | _        Œ�| j                             | j        | j        ¦  «        \  | _        | _        dS )zaRepair Kalman state across an occlusion gap by replaying predict-updates on virtual observations.Nr   )r#   r!   rJ   rK   r2   r1   r$   r3   ÚrangeÚtlwh_to_xyahr   r4   Úpredictr7   )
r%   rU   rV   Ú
last_frameÚgapÚlast_obsÚtÚalphaÚvirtual_xyxyÚvirtual_xyahs
             r'   Ú	apply_oruzOCSortTrack.apply_oruˆ   sY  € àÔÐ#¨4Ô+<Ð#ØˆFå˜Ô*×/Ò/Ñ1Ô1Ñ2Ô2ˆ
Ø Ñ+ˆØ�!Š8ˆ8ØˆFð Ô$×)Ò)Ñ+Ô+ˆŒ	ØÔ0×5Ò5Ñ7Ô7ˆŒàÔ$ ZÔ0ˆõ �q˜#‘”ð 	mð 	mˆAØ˜‘GˆEØ ™I¨Ñ1°EÐ<PÑ4PÑPˆLà×,Ò,­Y°|Ñ-DÔ-DÑEÔEˆLØ)-Ô);×)CÒ)CÀDÄIÈtÌÑ)_Ô)_Ñ&ˆDŒI�t”Ø)-Ô);×)BÒ)BÀ4Ä9ÈdÌoÐ_kÑ)lÔ)lÑ&ˆDŒI�t”�ð &*Ô%7×%?Ò%?ÀÄ	È4Ì?Ñ%[Ô%[Ñ"ˆŒ	�4”?�?�?r(   )r   )r   r   r   r   r   r   r   r   )r)   r   r*   r+   )r5   r
   r)   r   r*   r+   )F)r5   r
   r)   r   r9   r:   r*   r+   )r/   r   r*   r   )r@   r   r)   r   r*   r+   )r*   rF   )rU   r   rV   r   r*   r+   )Ú__name__Ú
__module__Ú__qualname__Ú__doc__r   r-   r7   r<   Ústaticmethodr?   r.   r8   rb   Ú__classcell__©r&   s   @r'   r   r      s  ø€ € € € € ð
ð 
ð9ð 9ð 9ð 9ð 9ð 9ð 9ð"
8ð 
8ð 
8ð 
8ð 
8ð 
8ð1ð 1ð 1ð 1ð 1ð 1ð1ð 1ð 1ð 1ð 1ð 1ð 1ð ðLð Lð Lñ „\ðLð-ð -ð -ð -ð5ð 5ð 5ð 5ðB\ð \ð \ð \ð \ð \ð \ð \r(   r   c                  ór   ‡ — e Zd ZdZeZd"ˆ fd„Zd#d$d
„Z	 d#d%d„Zd&d„Z	d'd„Z
d(d„Zd)ˆ fd„Zd&d „Zd&d!„Zˆ xZS )*ÚOCSORTaw  OC-SORT multi-object tracker with observation-centric association.

    Implements three key components on top of BYTETracker:
    - Observation-Centric Re-Update (ORU): repairs Kalman state after occlusion
    - Observation-Centric Momentum (OCM): velocity direction consistency cost
    - Observation-Centric Recovery (OCR): re-association using last observation position

    Attributes:
        delta_t (int): Temporal window for velocity direction computation.
        inertia (float): Weight of velocity consistency cost in association.
        use_byte (bool): Whether to use ByteTrack-style low-confidence second pass.
    Úargsr   c                óÎ   •— t          ¦   «                              |¦  «         t          |dd¦  «        | _        t          |dd¦  «        | _        t          |dd¦  «        | _        dS )zÔInitialize OC-SORT tracker.

        Args:
            args (Namespace | IterableSimpleNamespace): Parsed tracker config providing the BYTE keys plus `delta_t`,
                `inertia`, and `use_byte`.
        r   r   Úinertiagš™™™™™É?Úuse_byteFN)r   r   Úgetattrr   rn   ro   )r%   rl   r&   s     €r'   r   zOCSORT.__init__µ   sZ   ø€ õ 	‰Œ×Ò˜ÑÔÐÝ˜t Y°Ñ2Ô2ˆŒÝ˜t Y°Ñ4Ô4ˆŒÝ  j°%Ñ8Ô8ˆŒˆˆr(   NÚimgrF   r*   úlist[OCSortTrack]c                óš   ‡ — t          |¦  «        dk    rg S t          |¦  «        }ˆ fd„t          ||j        |j        ¦  «        D ¦   «         S )z;Build `OCSortTrack` instances from a `Results`-like object.r   c                óF   •— g | ]\  }}}t          |||‰j        ¦  «        ‘ŒS © )r   r   )Ú.0r   ÚsÚcr%   s       €r'   ú
<listcomp>z%OCSORT.init_track.<locals>.<listcomp>Æ   s/   ø€ ÐqÐqÐq¹,¸4ÀÀA•˜D ! Q¨¬Ñ5Ô5ÐqÐqÐqr(   )rB   r   ÚzipÚconfr   )r%   Úresultsrq   Úbboxess   `   r'   Ú
init_trackzOCSORT.init_trackÁ   sT   ø€ åˆw‰<Œ<˜1ÒÐØˆIÝ˜gÑ&Ô&ˆØqÐqÐqÐqÍ#ÈfÐV]ÔVbÐdkÔdoÑJpÔJpÐqÑqÔqÐqr(   Údistsr   ÚtracksÚ
detectionsÚ	iou_distsc                ó   — |S )zQHook combining motion cost with appearance cost. Default: pass-through (no ReID).ru   )r%   r   r€   r�   r‚   s        r'   Ú_fuse_appearancezOCSORT._fuse_appearanceÈ   s	   € ð ˆr(   c                ó
  — t          j        ||¦  «        }| j        j        rt          j        ||¦  «        n|                     ¦   «         }|| j        |                      ||¦  «        z  z   }|                      ||||¬¦  «        S )uQ   Cost matrix = IoU (+score-fuse) + inertiaÂ·OCM (+ optional appearance, via hook).©r‚   )r   Úiou_distancerl   Ú
fuse_scorer2   rn   Ú_velocity_direction_costr„   )r%   r€   r�   r‚   r   s        r'   Ú	get_distszOCSORT.get_distsÒ   s€   € åÔ)¨&°*Ñ=Ô=ˆ	Ø>B¼iÔ>RÐh•Ô# I¨zÑ:Ô:Ð:ÐXa×XfÒXfÑXhÔXhˆØ˜œ t×'DÒ'DÀVÈZÑ'XÔ'XÑXÑXˆØ×$Ò$ U¨F°JÈ)Ð$ÑTÔTÐTr(   ÚdetsÚ	activatedÚrefindútuple[list[int], list[int]]c                ó6  — |r|sRt          t          t          |¦  «        ¦  «        ¦  «        t          t          t          |¦  «        ¦  «        ¦  «        fS |                      ||¦  «        }| j        j        rt          j        ||¦  «        n|}|                      ||||¬¦  «        }t          j        || j        j	        ¬¦  «        \  }}}	|D ]­\  }
}||
         ||         }}|j
        t          j        k    r1|                     || j        ¦  «         |                     |¦  «         Œ[|                     |j        | j        ¦  «         |                     || j        d¬¦  «         |                     |¦  «         Œ®t          |¦  «        t          |	¦  «        fS )zÇRun one OCR (last-observation IoU) pass, applying matches in place.

        Returns:
            (tuple[list[int], list[int]]): Local indices of unmatched ``tracks`` and unmatched ``dets``.
        r†   )ÚthreshF)r9   )ÚlistrX   rB   Ú_ocr_distancerl   rˆ   r   r„   Úlinear_assignmentÚmatch_threshÚstater   ÚTrackedr7   r)   Úappendrb   r/   r<   )r%   r€   r‹   rŒ   r�   r‚   Ú	ocr_distsÚmatchesÚu_trackÚu_detÚitrackedÚidetÚtrackÚdets                 r'   Ú_ocr_associatezOCSORT._ocr_associateÙ   sƒ  € ð ð 	D˜Tð 	DÝ��c &™kœkÑ*Ô*Ñ+Ô+­Tµ%½¸D¹	¼	Ñ2BÔ2BÑ-CÔ-CÐCÐCØ×&Ò& v¨tÑ4Ô4ˆ	Ø<@¼IÔ<PÐ_•HÔ'¨	°4Ñ8Ô8Ð8ÐV_ˆ	Ø×)Ò)¨)°V¸TÈYÐ)ÑWÔWˆ	Ý"*Ô"<¸YÈtÌyÔOeÐ"fÑ"fÔ"fÑˆ�˜%Ø%ð 	%ð 	%‰NˆH�dØ Ô)¨4°¬:�3ˆEØŒ{�jÔ0Ò0Ð0Ø—’˜S $¤-Ñ0Ô0Ð0Ø× Ò  Ñ'Ô'Ð'Ð'à—’ ¤¨$¬-Ñ8Ô8Ð8Ø×!Ò! # t¤}¸UÐ!ÑCÔCÐCØ—’˜eÑ$Ô$Ð$Ð$Ý�G‰}Œ}�d 5™kœkÐ)Ð)r(   Ústrack_poolrš   ú	list[int]Úu_detectionc                óˆ  ‡‡‡‡‡‡‡— ˆfd„‰D ¦   «         Š‰s|‰fS ˆfd„|D ¦   «         Šˆfd„|D ¦   «         Š|                       ˆfd„‰D ¦   «         ‰||¦  «        \  }Šˆfd„‰D ¦   «         }|                       ˆfd„‰D ¦   «         |||¦  «        \  }	}
ˆfd„|D ¦   «         ˆfd„|	D ¦   «         z   }ˆˆfd	„|
D ¦   «         Š|‰fS )
a,  Observation-Centric Recovery (OCR) pass after first-stage association.

        Runs OCR for still-Tracked unmatched tracks first to preserve active-track matching priority, then for
        Lost tracks on the detections still unmatched, so a recently-lost track cannot outbid an active one.
        c                ó    •— g | ]
}‰|         ‘ŒS ru   ru   )rv   Úir�   s     €r'   ry   z2OCSORT._post_first_association.<locals>.<listcomp>  s   ø€ Ð7Ð7Ð7 a�J˜q”MÐ7Ð7Ð7r(   c                óJ   •— g | ]}‰|         j         t          j        k    ¯|‘Œ S ru   ©r•   r   r–   ©rv   r¦   r¡   s     €r'   ry   z2OCSORT._post_first_association.<locals>.<listcomp>  s-   ø€ ÐTÐTÐT˜¨°Q¬Ô)=ÅÔASÒ)SÐ)S�1Ð)SÐ)SÐ)Sr(   c                óJ   •— g | ]}‰|         j         t          j        k    ¯|‘Œ S ru   r¨   r©   s     €r'   ry   z2OCSORT._post_first_association.<locals>.<listcomp>	  s-   ø€ ÐRÐRÐR�q {°1¤~Ô';½zÔ?QÒ'QÐ'Q�Ð'QÐ'QÐ'Qr(   c                ó    •— g | ]
}‰|         ‘ŒS ru   ru   r©   s     €r'   ry   z2OCSORT._post_first_association.<locals>.<listcomp>  s   ø€ Ð)JÐ)JÐ)J¸Q¨+°a¬.Ð)JÐ)JÐ)Jr(   c                ó    •— g | ]
}‰|         ‘ŒS ru   ru   )rv   ÚjÚocr_detss     €r'   ry   z2OCSORT._post_first_association.<locals>.<listcomp>  s   ø€ Ð/Ð/Ð/ Q�X˜a”[Ð/Ð/Ð/r(   c                ó    •— g | ]
}‰|         ‘ŒS ru   ru   r©   s     €r'   ry   z2OCSORT._post_first_association.<locals>.<listcomp>  s   ø€ Ð)HÐ)HÐ)H¸Q¨+°a¬.Ð)HÐ)HÐ)Hr(   c                ó    •— g | ]
}‰|         ‘ŒS ru   ru   )rv   r¦   Útrackeds     €r'   ry   z2OCSORT._post_first_association.<locals>.<listcomp>  s   ø€ Ð,Ð,Ð, !�7˜1”:Ð,Ð,Ð,r(   c                ó    •— g | ]
}‰|         ‘ŒS ru   ru   )rv   r¦   Úothers     €r'   ry   z2OCSORT._post_first_association.<locals>.<listcomp>  s   ø€ Ð/GÐ/GÐ/G¸Q°°a´Ð/GÐ/GÐ/Gr(   c                ó,   •— g | ]}‰‰|                  ‘ŒS ru   ru   )rv   r­   Úu_d1r£   s     €€r'   ry   z2OCSORT._post_first_association.<locals>.<listcomp>  s"   ø€ Ð:Ð:Ð:°�{ 4¨¤7Ô+Ð:Ð:Ð:r(   )r    )r%   r¡   r�   rš   r£   rŒ   r�   Úu_t1Ú	remainingÚu_t2Úu_d2r®   r³   r±   rµ   s    `` `      @@@@r'   Ú_post_first_associationzOCSORT._post_first_associationö   sD  øøøøøøø€ ð 8Ð7Ð7Ð7¨;Ð7Ñ7Ô7ˆØð 	(Ø˜KÐ'Ð'àTÐTÐTÐT˜gÐTÑTÔTˆØRÐRÐRÐR˜GÐRÑRÔRˆà×(Ò(Ð)JÐ)JÐ)JÐ)JÀ'Ð)JÑ)JÔ)JÈHÐV_ÐagÑhÔh‰
ˆˆdØ/Ð/Ð/Ð/¨$Ð/Ñ/Ô/ˆ	Ø×(Ò(Ð)HÐ)HÐ)HÐ)HÀ%Ð)HÑ)HÔ)HÈ)ÐU^Ð`fÑgÔg‰
ˆˆdà,Ð,Ð,Ð, tÐ,Ñ,Ô,Ð/GÐ/GÐ/GÐ/GÀ$Ð/GÑ/GÔ/GÑGˆØ:Ð:Ð:Ð:Ð:°TÐ:Ñ:Ô:ˆØ˜Ð#Ð#r(   Údetections_secondÚlostr+   c                óü   •— | j         sM|D ]H}||         }|j        t          j        k    r)|                     ¦   «          |                     |¦  «         ŒIdS t          ¦   «                              ||||||¦  «         dS )zBRun ByteTrack-style second pass only when ``use_byte`` is enabled.N)ro   r•   r   r–   Ú	mark_lostr—   r   Ú_second_association)
r%   r¡   rš   r»   rŒ   r�   r¼   r¦   rž   r&   s
            €r'   r¿   zOCSORT._second_association  sŠ   ø€ ð Œ}ð 	Øð 'ð '�Ø# Aœ�Ø”;¥*Ô"4Ò4Ð4Ø—O’OÑ%Ô%Ð%Ø—K’K Ñ&Ô&Ð&øØˆFÝ‰Œ×#Ò# K°Ð:KÈYÐX^Ð`dÑeÔeÐeÐeÐer(   c                óÌ  — t          j        t          |¦  «        t          |¦  «        ft           j        ¬¦  «        }|j        dk    r|S t          j        d„ |D ¦   «         t           j        ¬¦  «        }t          |¦  «        D ]à\  }}|j        �|j        d         dk     rŒt           
                    |j        ¦  «        }||z
  }t           j                             |d¬¦  «        }	|	dk    }
|
                     ¦   «         sŒ~||
xx         |	|
df         z  cc<   t          j        ||
         |j        z  dd	¦  «        }t          j        |¦  «        t           j        z  |||
f<   Œá|S )
aã  Compute OCM velocity direction consistency cost matrix (vectorized).

        For each track-detection pair, measures the angular difference between
        the track's historical motion direction and the direction to the candidate detection.

        Args:
            tracks (list[OCSortTrack]): List of tracks.
            detections (list[OCSortTrack]): List of detections.

        Returns:
            (np.ndarray): Cost matrix of shape (len(tracks), len(detections)).
        r   r   c                óL   — g | ]!}t                                |j        ¦  «        ‘Œ"S ru   )r   r?   r/   )rv   rŸ   s     r'   ry   z3OCSORT._velocity_direction_cost.<locals>.<listcomp>8  s(   € ÐYÐYÐYÀs¥× 8Ò 8¸¼Ñ BÔ BÐYÐYÐYr(   Nr   )ÚaxisrI   g      ð¿g      ð?)r   rO   rB   r   Úsizer   Ú	enumerater"   r    r   r?   rM   rN   ÚanyÚclipÚarccosÚpi)r%   r€   r�   ÚcostÚdet_centersr¦   rž   Útrack_centerÚ
directionsÚnormsÚvalidÚdotss               r'   r‰   zOCSORT._velocity_direction_cost&  sV  € õ Œx�˜V™œ¥c¨*¡o¤oÐ6½b¼jÐIÑIÔIˆØŒ9˜Š>ˆ>ØˆKõ ”hÐYÐYÈjÐYÑYÔYÕacÔakÐlÑlÔlˆå! &Ñ)Ô)ð 	5ð 	5‰HˆAˆuØŒ~Ð%¨Ô)?ÀÔ)BÀQÒ)FÐ)FØÝ&×3Ò3°EÔ4JÑKÔKˆLØ$ |Ñ3ˆJÝ”I—N’N :°A�NÑ6Ô6ˆEØ˜D’LˆEØ—9’9‘;”;ð ØØ�uÐÐÔ  u¨d {Ô!3Ñ3ÐÐÑÝ”7˜: eÔ,¨u¬~Ñ=¸tÀSÑIÔIˆDÝœY t™_œ_­r¬uÑ4ˆD��E�‰NˆNàˆr(   c                ó¬   — |r&|d         j         �d„ |D ¦   «         }d„ |D ¦   «         }nd„ |D ¦   «         }d„ |D ¦   «         }t          j        ||¦  «        S )aá  Compute IoU distance using tracks' last observation positions instead of Kalman predictions.

        Args:
            tracks (list[OCSortTrack]): List of tracks with last_observation attributes.
            detections (list[OCSortTrack]): List of detections.

        Returns:
            (np.ndarray): Cost matrix based on IoU with last observations (or xywha for OBB).

        Notes:
            `last_observation` is stored in xyxy form. For oriented (OBB) tracks no oriented
            last-observation is kept, so this method falls back to the Kalman-predicted `xywha`
            and the OCR pass degenerates to standard IoU on the predicted box. Standard
            (axis-aligned) tracking gets the full OCR benefit.
        r   Nc                ó   — g | ]	}|j         ‘Œ
S ru   ©Úxywha©rv   r^   s     r'   ry   z(OCSORT._ocr_distance.<locals>.<listcomp>Z  s   € Ð.Ð.Ð. !�a”gÐ.Ð.Ð.r(   c                ó   — g | ]	}|j         ‘Œ
S ru   rÒ   ©rv   Úds     r'   ry   z(OCSORT._ocr_distance.<locals>.<listcomp>[  s   € Ð2Ð2Ð2 !�a”gÐ2Ð2Ð2r(   c                óL   — g | ]!}|j         d          d k    r|j         n|j        ‘Œ"S )r   )r    r/   rÔ   s     r'   ry   z(OCSORT._ocr_distance.<locals>.<listcomp>]  s5   € ÐcÐcÐcÐWX¨AÔ,>¸qÔ,AÀQÒ,FÐ,F�aÔ(Ð(ÈAÌFÐcÐcÐcr(   c                ó   — g | ]	}|j         ‘Œ
S ru   r>   rÖ   s     r'   ry   z(OCSORT._ocr_distance.<locals>.<listcomp>^  s   € Ð1Ð1Ð1 �a”fÐ1Ð1Ð1r(   )Úangler   r‡   )r%   r€   r�   ÚatlbrsÚbtlbrss        r'   r’   zOCSORT._ocr_distanceI  sy   € ð  ð 	2�f˜Q”i”oÐ1Ø.Ð. vÐ.Ñ.Ô.ˆFØ2Ð2 zÐ2Ñ2Ô2ˆFˆFàcÐcÐ\bÐcÑcÔcˆFØ1Ð1 jÐ1Ñ1Ô1ˆFÝÔ$ V¨VÑ4Ô4Ð4r(   )rl   r   )N)rq   rF   r*   rr   )
r   r   r€   rr   r�   rr   r‚   rF   r*   r   )r€   rr   r�   rr   r*   r   )
r€   rr   r‹   rr   rŒ   rr   r�   rr   r*   rŽ   )r¡   rr   r�   rr   rš   r¢   r£   r¢   rŒ   rr   r�   rr   r*   rŽ   )r¡   rr   rš   r¢   r»   rr   rŒ   rr   r�   rr   r¼   rr   r*   r+   )rc   rd   re   rf   r   Útrack_classr   r~   r„   rŠ   r    rº   r¿   r‰   r’   rh   ri   s   @r'   rk   rk   ¥   s  ø€ € € € € ðð ð €Kð
9ð 
9ð 
9ð 
9ð 
9ð 
9ðrð rð rð rð rð (,ðð ð ð ð ðUð Uð Uð Uð*ð *ð *ð *ð:$ð $ð $ð $ð:fð fð fð fð fð fð&!ð !ð !ð !ðF5ð 5ð 5ð 5ð 5ð 5ð 5ð 5r(   rk   )Ú
__future__r   Útypingr   Únumpyr   Ú	utils.opsr   Ú	basetrackr   Úbyte_trackerr	   r
   Úutilsr   Úutils.stracksr   r   rk   ru   r(   r'   ú<module>ræ      s  ðð #Ð "Ð "Ð "Ð "Ð "à Ð Ð Ð Ð Ð à Ð Ð Ð à !Ð !Ð !Ð !Ð !Ð !Ø !Ð !Ð !Ð !Ð !Ð !Ø -Ð -Ð -Ð -Ð -Ð -Ð -Ð -Ø Ð Ð Ð Ð Ð Ø 'Ð 'Ð 'Ð 'Ð 'Ð 'ðR\ð R\ð R\ð R\ð R\�&ñ R\ô R\ð R\ðjz5ð z5ð z5ð z5ð z5ˆ[ñ z5ô z5ð z5ð z5ð z5r(   