Skip to main content
. 2014 Feb 12;14(2):2911–2943. doi: 10.3390/s140202911

Algorithm 3 Single Robot Object Tracking Algorithm.

Require: Input object list with nin objects.
Require: Local object list with nloc objects.
Ensure: nin > 0 ∨ nloc > 0.
1: for iLin do
2: for jLloc do
3:   Δt = tintdet(j).
4:   Temporal Kalman filter prediction with object j and Δt.
5:   Mahalanobis distance according to Equation (10)
6:   Possible pairs distance matrix PD[i, j] = DM(i, j).
7: end for
8: end for
9: Create selected pairs list.
10: while Size(Selected Pairs)< min(nin, nloc) do
11:  Select minimum valid value of PD
12: if PD[i, j] < DMmax then
13:   Include pair (i, j) in selected pairs.
14:   Mark row i and column j with invalid values.
15: else
16:   Stop selecting pairs.
17: end if
18: end while
19: KF iteration for objects in selected pairs.
20: Eliminate objects from Lloc. ▹ Not fulfilling elimination conditions
21: Add new objects not paired to Lloc.
22: Filter reduction to detect duplicates.
23: Update objects scoring.