
    FPhF                     ^    d dl 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	      Z
y)
    N   )	BaseTrack
TrackState)matchingKalmanFilterXYAHc                       e Zd ZdZ e       Zd Zd Zed        Z	e e
j                  dd      fd       Zd Zdd	Zd
 Zd Zed        Zed        Zed        Zed        Zed        Zd Zy)STracka  
    Single object tracking representation that uses Kalman filtering for state estimation.

    This class is responsible for storing all the information regarding individual tracklets and performs state updates
    and predictions based on Kalman filter.

    Attributes:
        shared_kalman (KalmanFilterXYAH): Shared Kalman filter that is used across all STrack instances for prediction.
        _tlwh (np.ndarray): Private attribute to store top-left corner coordinates and width and height of bounding box.
        kalman_filter (KalmanFilterXYAH): Instance of Kalman filter used for this particular object track.
        mean (np.ndarray): Mean state estimate vector.
        covariance (np.ndarray): Covariance of state estimate.
        is_activated (bool): Boolean flag indicating if the track has been activated.
        score (float): Confidence score of the track.
        tracklet_len (int): Length of the tracklet.
        cls (any): Class label for the object.
        idx (int): Index or identifier for the object.
        frame_id (int): Current frame ID.
        start_frame (int): Frame where the object was first detected.

    Methods:
        predict(): Predict the next state of the object using Kalman filter.
        multi_predict(stracks): Predict the next states for multiple tracks.
        multi_gmc(stracks, H): Update multiple track states using a homography matrix.
        activate(kalman_filter, frame_id): Activate a new tracklet.
        re_activate(new_track, frame_id, new_id): Reactivate a previously lost tracklet.
        update(new_track, frame_id): Update the state of a matched track.
        convert_coords(tlwh): Convert bounding box to x-y-angle-height format.
        tlwh_to_xyah(tlwh): Convert tlwh bounding box to xyah format.
        tlbr_to_tlwh(tlbr): Convert tlbr bounding box to tlwh format.
        tlwh_to_tlbr(tlwh): Convert tlwh bounding box to tlbr format.
    c                     t        j                  | j                  |dd       t         j                        | _        d| _        d\  | _        | _        d| _        || _	        d| _
        || _        |d   | _        y)zInitialize new STrack instance.Ndtype)NNFr   )npasarraytlbr_to_tlwhfloat32_tlwhkalman_filtermean
covarianceis_activatedscoretracklet_lenclsidx)selftlwhr   r   s       lC:\Users\daisl\Desktop\realtime-object-detection\venv\Lib\site-packages\ultralytics/trackers/byte_tracker.py__init__zSTrack.__init__.   sh    ZZ 1 1$s) <BJJO
!%/"	4?!
8    c                     | j                   j                         }| j                  t        j                  k7  rd|d<   | j
                  j                  || j                        \  | _         | _        y)z1Predicts mean and covariance using Kalman filter.r      N)r   copystater   Trackedr   predictr   )r   
mean_states     r   r&   zSTrack.predict:   sR    YY^^%
::+++JqM%)%7%7%?%?
DOO%\"	4?r    c                 &   t        |       dk  ryt        j                  | D cg c]  }|j                  j	                          c}      }t        j                  | D cg c]  }|j
                   c}      }t        |       D ]+  \  }}|j                  t        j                  k7  s$d||   d<   - t        j                  j                  ||      \  }}t        t        ||            D ]  \  }\  }}|| |   _        || |   _         yc c}w c c}w )zOPerform multi-object predictive tracking using Kalman filter for given stracks.r   Nr"   )lenr   r   r   r#   r   	enumerater$   r   r%   r
   shared_kalmanmulti_predictzip)stracksst
multi_meanmulti_covarianceir   covs          r   r,   zSTrack.multi_predictA   s     w<1ZZ' B'B' BC
::w&Gwr}}w&GHw'EArxx:---#$
1a  ( (.';';'I'I*Vf'g$
$'J8H(IJNA{c"GAJO$'GAJ! K !C&Gs   !D	D      c                    t        |       dkD  r-t        j                  | D cg c]  }|j                  j	                          c}      }t        j                  | D cg c]  }|j
                   c}      }|ddddf   }t        j                  t        j                  dt              |      }|dddf   }t        t        ||            D ]i  \  }\  }	}
|j                  |	      }	|	ddxxx |z  ccc |j                  |
      j                  |j                               }
|	| |   _        |
| |   _        k yyc c}w c c}w )zHUpdate state tracks positions and covariances using a homography matrix.r   Nr4      r   )r)   r   r   r   r#   r   kroneyefloatr*   r-   dot	transpose)r.   Hr/   r0   r1   RR8x8tr2   r   r3   s              r   	multi_gmczSTrack.multi_gmcP   s    w<!g$FgRWW\\^g$FGJ!zz7*K7R2==7*KL"1"bqb&	A77266!5115D"1"a%A"+C
<L,M"N;D#xx~RaAhhsm''(89"&
(+
% #O $F*Ks   !D>Ec                 *   || _         | j                         | _        | j                   j                  | j	                  | j
                              \  | _        | _        d| _        t        j                  | _        |dk(  rd| _        || _        || _        y)zStart a new tracklet.r   r   TN)r   next_idtrack_idinitiateconvert_coordsr   r   r   r   r   r%   r$   r   frame_idstart_frame)r   r   rG   s      r   activatezSTrack.activatec   s{    *%)%7%7%@%@ATATUYU_U_A`%a"	4?''
q= $D #r    c                    | j                   j                  | j                  | j                  | j	                  |j
                              \  | _        | _        d| _        t        j                  | _	        d| _
        || _        |r| j                         | _        |j                  | _        |j                  | _        |j                   | _        y)z9Reactivates a previously lost track with a new detection.r   TN)r   updater   r   rF   r   r   r   r%   r$   r   rG   rC   rD   r   r   r   )r   	new_trackrG   new_ids       r   re_activatezSTrack.re_activatep   s    %)%7%7%>%>tyy$//?C?R?RS\SaSa?b&d"	4?''
   LLNDM__
====r    c                    || _         | xj                  dz  c_        |j                  }| j                  j	                  | j
                  | j                  | j                  |            \  | _        | _        t        j                  | _
        d| _        |j                  | _        |j                  | _        |j                  | _        y)z
        Update the state of a matched track.

        Args:
            new_track (STrack): The new track containing updated information.
            frame_id (int): The ID of the current frame.
        r   TN)rG   r   r   r   rK   r   r   rF   r   r%   r$   r   r   r   r   )r   rL   rG   new_tlwhs       r   rK   zSTrack.update~   s     !Q>>%)%7%7%>%>tyy$//?C?R?RS[?\&^"	4?''
 __
====r    c                 $    | j                  |      S )zYConvert a bounding box's top-left-width-height format to its x-y-angle-height equivalent.)tlwh_to_xyah)r   r   s     r   rF   zSTrack.convert_coords   s      &&r    c                     | j                   | j                  j                         S | j                   dd j                         }|dxx   |d   z  cc<   |ddxxx |dd dz  z  ccc |S )zTGet current position in bounding box format (top left x, top left y, width, height).Nr7   r4   r5   )r   r   r#   r   rets     r   r   zSTrack.tlwh   sh     99::??$$iim  "A#a&BQ3qr7Q;
r    c                 \    | j                   j                         }|ddxxx |dd z  ccc |S )z\Convert bounding box to format (min x, min y, max x, max y), i.e., (top left, bottom right).r4   N)r   r#   rT   s     r   tlbrzSTrack.tlbr   s/     iinnAB3r7
r    c                     t        j                  |       j                         }|ddxxx |dd dz  z  ccc |dxx   |d   z  cc<   |S )zConvert bounding box to format (center x, center y, aspect ratio, height), where the aspect ratio is width /
        height.
        Nr4   r5   r   r   r#   r   rU   s     r   rR   zSTrack.tlwh_to_xyah   sL    
 jj##%BQ3qr7Q;A#a&
r    c                 n    t        j                  |       j                         }|ddxxx |dd z  ccc |S )zFConverts top-left bottom-right format to top-left width height format.r4   NrY   )rW   rU   s     r   r   zSTrack.tlbr_to_tlwh   6     jj##%AB3r7
r    c                 n    t        j                  |       j                         }|ddxxx |dd z  ccc |S )z1Converts tlwh bounding box format to tlbr format.r4   NrY   rZ   s     r   tlwh_to_tlbrzSTrack.tlwh_to_tlbr   r\   r    c                 V    d| j                    d| j                   d| j                   dS )z`Return a string representation of the BYTETracker object with start and end frames and track ID.OT_z_(-))rD   rH   	end_framer   s    r   __repr__zSTrack.__repr__   s-    T]]O2d&6&6%7q8HJJr    N)F)__name__
__module____qualname____doc__r   r+   r   r&   staticmethodr,   r   r9   rA   rI   rN   rK   rF   propertyr   rW   rR   r   r^   re    r    r   r
   r
   
   s    B %&M
] ( ( #RVVAq\ , ,$$!!*'          Kr    r
   c                   p    e Zd ZdZddZddZd ZddZd Zd Z	d	 Z
ed
        Zed        Zed        Zy)BYTETrackeraR  
    BYTETracker: A tracking algorithm built on top of YOLOv8 for object detection and tracking.

    The class is responsible for initializing, updating, and managing the tracks for detected objects in a video
    sequence. It maintains the state of tracked, lost, and removed tracks over frames, utilizes Kalman filtering for
    predicting the new object locations, and performs data association.

    Attributes:
        tracked_stracks (list[STrack]): List of successfully activated tracks.
        lost_stracks (list[STrack]): List of lost tracks.
        removed_stracks (list[STrack]): List of removed tracks.
        frame_id (int): The current frame ID.
        args (namespace): Command-line arguments.
        max_time_lost (int): The maximum frames for a track to be considered as 'lost'.
        kalman_filter (object): Kalman Filter object.

    Methods:
        update(results, img=None): Updates object tracker with new detections.
        get_kalmanfilter(): Returns a Kalman filter object for tracking bounding boxes.
        init_track(dets, scores, cls, img=None): Initialize object tracking with detections.
        get_dists(tracks, detections): Calculates the distance between tracks and detections.
        multi_predict(tracks): Predicts the location of tracks.
        reset_id(): Resets the ID counter of STrack.
        joint_stracks(tlista, tlistb): Combines two lists of stracks.
        sub_stracks(tlista, tlistb): Filters out the stracks present in the second list from the first list.
        remove_duplicate_stracks(stracksa, stracksb): Removes duplicate stracks based on IOU.
    c                     g | _         g | _        g | _        d| _        || _        t        |dz  |j                  z        | _        | j                         | _	        | j                          y)zPInitialize a YOLOv8 object to track objects with given arguments and frame rate.r   g      >@N)tracked_strackslost_stracksremoved_stracksrG   argsinttrack_buffermax_time_lostget_kalmanfilterr   reset_id)r   rs   
frame_rates      r   r   zBYTETracker.__init__   s_    !!	 d!2T5F5F!FG!224r    Nc           
         | xj                   dz  c_         g }g }g }g }|j                  }|j                  }t        j                  |t        j
                  t        |            j                  dd      gd      }|j                  }	|| j                  j                  kD  }
|| j                  j                  kD  }|| j                  j                  k  }t        j                  ||      }||   }||
   }||
   }||   }|	|
   }|	|   }| j                  ||||      }g }g }| j                  D ]1  }|j                  s|j!                  |       !|j!                  |       3 | j#                  || j$                        }| j'                  |       t)        | d      rJ|H| j*                  j-                  ||      }t.        j1                  ||       t.        j1                  ||       | j3                  ||      }t5        j6                  || j                  j8                        \  }}}|D ]  \  }}||   }||   } |j:                  t<        j>                  k(  r.|jA                  | | j                          |j!                  |       [|jC                  | | j                   d       |j!                  |        | j                  ||||      }!|D "cg c](  }"||"   j:                  t<        j>                  k(  s$||"   * }#}"t5        jD                  |#|!      }t5        j6                  |d	      \  }}}$|D ]  \  }}|#|   }|!|   } |j:                  t<        j>                  k(  r.|jA                  | | j                          |j!                  |       [|jC                  | | j                   d       |j!                  |        |D ]F  }%|#|%   }|j:                  t<        jF                  k7  s&|jI                          |j!                  |       H |D "cg c]  }"||"   	 }}"| j3                  ||      }t5        j6                  |d
      \  }}&}|D ];  \  }}||   jA                  ||   | j                          |j!                  ||          = |&D ](  }%||%   }|jK                          |j!                  |       * |D ]b  }'||'   }|jL                  | j                  jN                  k  r,|jQ                  | jR                  | j                          |j!                  |       d | j$                  D ]J  }| j                   |jT                  z
  | jV                  kD  s*|jK                          |j!                  |       L | j                  D (cg c]"  }(|(j:                  t<        j>                  k(  s!|($ c}(| _        | j#                  | j                  |      | _        | j#                  | j                  |      | _        | jY                  | j$                  | j                        | _        | j$                  j[                  |       | jY                  | j$                  | j\                        | _        | j_                  | j                  | j$                        \  | _        | _        | j\                  j[                  |       t        | j\                        dkD  r| j\                  dd | _.        t        j`                  | j                  D )cg c]X  })|)j                  s|)jb                  je                         |)jf                  |)jL                  |)j                  |)jh                  gz   Z c})t        jj                        S c c}"w c c}"w c c}(w c c})w )zUUpdates object tracker with new detections and returns tracked object bounding boxes.r   r   )axisgmcN)threshF)rM   g      ?gffffff?i  ir   )6rG   confxyxyr   concatenatearanger)   reshaper   rs   track_high_threshtrack_low_threshlogical_and
init_trackrp   r   appendjoint_stracksrq   r,   hasattrr|   applyr
   rA   	get_distsr   linear_assignmentmatch_threshr$   r   r%   rK   rN   iou_distanceLost	mark_lostmark_removedr   new_track_threshrI   r   rc   rv   sub_stracksextendrr   remove_duplicate_stracksr   rW   tolistrD   r   r   )*r   resultsimgactivated_stracksrefind_stracksrq   rr   scoresbboxesr   remain_indsinds_low	inds_highinds_seconddets_seconddetsscores_keepscores_secondcls_keep
cls_second
detectionsunconfirmedrp   trackstrack_poolwarpdistsmatchesu_tracku_detectionitrackedidetdetdetections_secondr2   r_tracked_stracksu_detection_seconditu_unconfirmedinewr@   xs*                                             r   rK   zBYTETracker.update   s   3v;)?)G)GA)N OVXYkktyy:::DII666TYY888	nnXy9[)k"[){+{#%
__T;#F
))E%%""5)&&u-	 * (($:K:KL;'4CO88>>#t,D[$/[$/{J7(0(B(B5QUQZQZQgQg(h%+%NHd)ET"C{{j000S$--0!((/!!#t}}U!C%%e, & !OOK
TWX5<kWA@T@TXbXjXj@j[^Wk%%&79JK/7/I/I%X[/\,,%NHd%h/E#D)C{{j000S$--0!((/!!#t}}U!C%%e, & B%b)E{{joo-!##E*	  .99[jm[
9{J7.6.H.HWZ.[+%NHd!((D)94==I$$[%:; &  BOE ""5)  
  Dt$E{{TYY777NN4--t}}=$$U+   &&E}}u.1C1CC""$&&u- '
 ,0+?+?a+?a177jN`N`C`+?a#11$2F2FHYZ#11$2F2FW ,,T->->@T@TU  . ,,T->->@T@TU262O2OPTPdPdfjfwfw2x/d/##O4t##$t+#'#7#7#>D zzLPL`L`sL`qdedrdrQVV]]_

AGGQUUAEEBBL`s** 	k l( :.  b ts+   %](.](]-;"]2]24]7A]7c                     t               S )z;Returns a Kalman filter object for tracking bounding boxes.r   rd   s    r   rw   zBYTETracker.get_kalmanfiltera  s    !!r    c           
          t        |      r.t        |||      D cg c]  \  }}}t        |||       c}}}S g S c c}}}w )zMInitialize object tracking with detections and scores using STrack algorithm.)r)   r-   r
   )r   r   r   r   r   r   scs           r   r   zBYTETracker.init_tracke  sB    RUVZR[s47MN7M|atQ"7MNcaccNs   <c                 ^    t        j                  ||      }t        j                  ||      }|S )zQCalculates the distance between tracks and detections using IOU and fuses scores.)r   r   
fuse_score)r   tracksr   r   s       r   r   zBYTETracker.get_distsi  s-    %%fj9 ##E:6r    c                 .    t         j                  |       y)z6Returns the predicted tracks using the YOLOv8 network.N)r
   r,   )r   r   s     r   r,   zBYTETracker.multi_predictq  s    V$r    c                 ,    t         j                          y)z Resets the ID counter of STrack.N)r
   rx   rd   s    r   rx   zBYTETracker.reset_idu  s    r    c                     i }g }| D ]"  }d||j                   <   |j                  |       $ |D ]7  }|j                   }|j                  |d      r"d||<   |j                  |       9 |S )z/Combine two lists of stracks into a single one.r   r   )rD   r   get)tlistatlistbexistsresr@   tids         r   r   zBYTETracker.joint_stracksy  so     A!"F1::JJqM  A**C::c1%s

1	 
 
r    c                     |D ch c]  }|j                    }}| D cg c]  }|j                   |vs| c}S c c}w c c}w )a$  DEPRECATED CODE in https://github.com/ultralytics/ultralytics/pull/1890/
        stracks = {t.track_id: t for t in tlista}
        for t in tlistb:
            tid = t.track_id
            if stracks.get(tid, 0):
                del stracks[tid]
        return list(stracks.values())
        )rD   )r   r   r@   track_ids_bs       r   r   zBYTETracker.sub_stracks  sD     ,226aqzz62!C6aQZZ{%B6CC 3Cs   9>>c                    t        j                  | |      }t        j                  |dk        }g g }}t	        | D ]k  \  }}| |   j
                  | |   j                  z
  }||   j
                  ||   j                  z
  }	||	kD  r|j                  |       [|j                  |       m t        |       D 
cg c]  \  }
}|
|vs| }}
}t        |      D 
cg c]  \  }
}|
|vs| }}
}||fS c c}}
w c c}}
w )z7Remove duplicate stracks with non-maximum IOU distance.g333333?)	r   r   r   wherer-   rG   rH   r   r*   )stracksastracksbpdistpairsdupadupbpqtimeptimeqr2   r@   resaresbs                 r   r   z$BYTETracker.remove_duplicate_stracks  s     %%h9&dKDAqQK((8A;+B+BBEQK((8A;+B+BBEu}AA   (1C1daQd]1C'1C1daQd]1CTz DCs   7C1C1C7&C7)   )N)rf   rg   rh   ri   r   rK   rw   r   r   r,   rx   rj   r   r   r   rl   r    r   rn   rn      sk    8
qf"d%   
D 
D  r    rn   )numpyr   	basetrackr   r   utilsr   utils.kalman_filterr   r
   rn   rl   r    r   <module>r      s0     ,  1xKY xKv_ _r    