Vehicle Detection Based on Probability Hypothesis Density Filter

Abstract

In the past decade, the developments of vehicle detection have been significantly improved. By utilizing cameras, vehicles can be detected in the Regions of Interest (ROI) in complex environments. However, vision techniques often suffer from false positives and limited field of view. In this paper, a LiDAR based vehicle detection approach is proposed by using the Probability Hypothesis Density (PHD) filter. The proposed approach consists of two phases: the hypothesis generation phase to detect potential objects and the hypothesis verification phase to classify objects. The performance of the proposed approach is evaluated in complex scenarios, compared with the state-of-the-art.

1. Introduction

Traffic accidents are a major cause of death worldwide. A study by the World Health Organization (WHO) reports that an estimated 1.2 million people die in traffic accidents every year, and up to 50 million people are injured [1]. Autonomous driving thus becomes significantly important in order to prevent accidents in traffic scenarios. However, it is still quite challenging for autonomous driving in all scenarios. For automotive manufacturers, the technology behind autonomous driving has been continually refined as a long-term goal, whereas the Advanced Driver Assistance System (ADAS) has been proposed as a short-term development to gradually improve road safety. Numerous ADAS functions have been developed to help drivers avoid accidents, improve driving efficiency, and reduce driver fatigue, in which vehicle detection plays an important role.

Most approaches rely on vision techniques to first detect Regions Of Interest (ROI) and then classify vehicles [2]. Khammari et al. use the Adaboost classification to detect vehicles [3]. Miller et al. and Paragios et al. have also utilized filtering techniques to detect vehicles [4,5]. Meanwhile, vehicle profile symmetry and the corresponding shadows are used in Reference [6]. However, vision techniques suffer from light intensities.

LiDAR is also widely used in vehicle detection. In contrast to vision sensors, LiDAR is robust against light intensities and offers a range of information [7,8,9,10,11]. Teichman et al. use the log odds estimators to recognize objects, where the performance is demonstrated in a large scale environment. Dominguez et al. demonstrate a data fusion platform for tracking vehicles [12]. Compared with vision sensors, LiDAR measurement often suffers from data association issues.

This paper extends our previous work to detect vehicles by using information from LiDAR, where objects are represented by the position and shape parameters (more details would be explained later). In Reference [13], we used the Difference of Normal (DoN) operator and the Random Hypersurface Model (RHM) to cluster the points cloud data and estimate the shape parameters [14,15]. To avoid the data association issue, the Probability Hypothesis Density (PHD) filter is proposed to detect vehicles based on Random Finite Set statistics (RFSs) [16]. In RFSs, several approaches are developed to avoid the data association issue, including the PHD filter, the Cardinalized PHD (CPHD) filter [17] and the Bernoulli filter [18]. The PHD filter propagates the probability hypothesis density function over the single target state space, whereas the CPHD filter also propagates the distribution of the target numbers (cardinality). By using the CPHD filter, the system requires more complex implementations and achieves more reliability in cardinality estimation. As the main goal of this paper is to estimate the states in a speed-critical environment, the PHD filter is thus considered. Unlike the PHD or CPHD filter, the multi-Bernoulli filter propagates the posterior target density. Although it has the same complexity as the PHD filter, the performance is better in highly nonlinear environments (it does not require the additional clustering step for state estimation) [18]. As the proposed RHM could be linearly implemented, the PHD filter is considered as the cheapest solution. The estimated states are then classified by the Support Vector Machine (SVM) to eliminate the non-vehicle objects.

The contributions are summarized as: first and foremost, the proposed solution achieves high performance in the presence of unknown data association environments. Furthermore, the shape parameter is first proposed to classify objects.

This paper is structured as follows: Section 2 describes the random hypersurface model, as well as the probability hypothesis density filter for hypothesis generation. Section 3 introduces the support vector machine for hypothesis verification. Section 4 demonstrates the performance of the experiments in urban environments. Finally, the paper is concluded in Section 5.

2. Hypothesis Generation

In the hypothesis generation phase, LiDAR measurements are filtered based on the Random Hypersurface Model (RHM). To further extend RHM in the presence of unknown data association scenarios, the Gaussian Mixture Probability Hypothesis Density (GMPHD) filter is proposed. Notice that objects are tracked and estimated in the 2D Cartesian coordinate system, whereas the depth information is unnecessarily required.

The result of the generation phase is then utilized for the verification phase to eliminate non-vehicles.

2.1. Random Hypersurface Model (RHM)

As illustrated in Figure 1, in a 2D Cartesian coordinate system, a point is considered as a scaled point with the factor within the range $[0,1]$ drawn on the surface. Thus, the RHM is defined as:

$S({\overline{b}}_k)$ denotes the surface which consists of both the shape parameter ${\overline{b}}_k$ and the center $c_k$. Each point that lies on the surface is represented as a scaled boundary when s is drawn from $[0,1]$:

$$c_k+s·\left(S({\overline{b}}_k)-c_k\right)$$

(1)

In Figure 2, $r(\varphi )$ denotes the distance function calculated from the center to boundary on angle φ in the polar coordinate system.

Assuming $r(\varphi )$ consists of the shape parameter ${\overline{b}}_k$ and the center $c_k$, the surface is represented as

$$S({\overline{b}}_k)=\{s·r({\overline{b}}_k,\varphi )·e(\varphi )+c_k|\varphi \in [0,2\pi ],s\in [0,1]\}$$

(2)

where $e(\varphi ):=\left[\begin{array}{c}cos\varphi \\ sin\varphi \end{array}\right]$ and $r({\overline{b}}_k,\varphi )$ denote the unit vector and the radial function in the form of the Fourier series, respectively. Due to its periodic proprieties, the Fourier series expansion of degree $N_F$ becomes

$$r({\overline{b}}_k,\varphi )=a_k^0+\sum _{j=1}^{N_F}\{a_k^{j}cos(j\varphi )+b_k^{j}sin(j\varphi )\}$$

(3)

where ${\overline{b}}_k$ is given by

$${\overline{b}}_k={[a_k^0,a_k^1,b_k^1,\dots ,a_k^{N_F},b_k^{N_F}]}^T$$

(4)

If φ is fixed, Equation (3) is represented as

$$r({\overline{b}}_k,\varphi )=R(\varphi )·{\overline{b}}_k$$

(5)

where

$$R(\varphi )=[1,cos(\varphi ),sin(\varphi ),\dots ,cos(N_F\varphi ),sin(N_F\varphi )]$$

(6)

Notice that a low number of Fourier coefficients encode rough information of the surface, whereas a larger number of coefficients give more details.

Bayes Filter

The RHM represents the shape information by using the Fourier coefficients, and the Bayes filter is utilized to calculate the corresponding parameters.

• Process model

Assuming the state ${\mathbf{x}}_k$ denotes the Fourier descriptors ${\overline{b}}_k$ and does not drift against time, the process model is described as

$${\mathbf{x}}_k=A_k{\mathbf{x}}_{k-1}+w_k$$

(7)

where $A_k$ and $w_k$ denote the identity matrix and the process noise, respectively.

• Measurement model

As illustrated in Figure 1, a single measurement $y_k$ from LiDAR is originated from a surface boundary point $z_k$ with scaled factor s,

$$y_k=f(z_k,s)+v_k,f(z_k,s)\in S({\overline{b}}_k)$$

(8)

where $v_k$ denotes the measurement noise.

Using Equation (2), Equation (8) becomes

$$\begin{array}{cc}\hfill y_k=& f(z_k,s)+v_k\hfill \\ \hfill =& s·r({\overline{b}}_k,\varphi )·e(\varphi )+c_k+v_k\hfill \\ \hfill :=& h({\mathbf{x}}_k,v_k)\hfill \end{array}$$

(9)

which maps the relationship between the state ${\overline{b}}_k$ and the measurement $y_k$.

Based on Equation (5), the measurement model is represented as

$$y_k=s·R(\varphi )·{\overline{b}}_k·e(\varphi )+c_k+v_k$$

(10)

with algebraic manipulations on Equation (10), we get

$$\left|\right|y_k-c_k{\left|\right|}^2=s^2·\left|\right|R(\varphi )·{\overline{b}}_k{\left|\right|}^2+2sR(\varphi ){\overline{b}}_{k}e{(\varphi )}^T{v}_k+\left|\right|v_k{\left|\right|}^2$$

(11)

The measurement model is thus acquired as:

$$\begin{array}{c}\hfill \mathbf{0}=s^2·\left|\right|R(\varphi )·{\overline{b}}_k{\left|\right|}^2+2sR(\varphi ){\overline{b}}_{k}e{(\varphi )}^T{v}_k+\left|\right|v_k{\left|\right|}^2-\left|\right|y_k-c_k{\left|\right|}^2\end{array}$$

(12)

where a pseudo measurement $\mathbf{0}$ is used to model the relationship between the state, the scaled factor, the measurement and its noise. The state ${\mathbf{x}}_k$ convergences to the true Fourier descriptor ${\overline{b}}_k$ by updating with a large number of measurements.

Notice that the proposed measurement model is implemented in the 2D Cartesian coordinate system and is only effective on the backside of the target. In addition, the depth information from LiDAR measurement is unrequested.

Figure 3 exhibits the estimated result with a cross target, in which the state $\mathbf{x}$ and measurement y are represented by 13 Fourier coefficients and 2D Cartesian coordinates, respectively.

2.2. Probability Hypothesis Density (PHD) Filter

As illustrated in Figure 3, the RHM estimates the shape information by using the Bayes filter. The key challenge for practice implementation is data association. A traditional estimator operates in measurement-to-target known scenarios, where all assignments are confirmed. However, LiDAR provides a large number of measurements without any association information. In previous work, the Difference of Normal (DoN) operator is utilized as a preprocessing procedure to cluster measurements. The miss detection is quite high since the clustering process may also eliminate objects. Hence, the PHD filter is proposed to track objects in presence of unknown data association scenarios.

2.2.1. Overview

The PHD filter is represented with the set-valued state and observation for multiple-object Bayesian filtering. All targets and observations are collected and represented in the set space, whereas the data association problem in traditional filtering domain is avoided. Figure 4 is a basic introduction of the RFS statistic. Compared to the single target filtering, the PHD filter relies on the random finite set statistics to process data in the set space level.

2.2.2. Mathematic Background

Considering the survived targets $S_{k|k-1}$, the spontaneous targets ${\mathsf{\sigma }}_k$ and the spawned targets $B_{k|k-1}$, the set-valued state is described as:

$${\mathbf{X}}_k=[\bigcup _{\mathsf{\zeta }\in {\mathbf{X}}_{k-1}}{S}_{k|k-1}(\mathsf{\zeta })]\cup [\bigcup _{\mathsf{\zeta }\in {\mathbf{X}}_{k-1}}{B}_{k|k-1}(\mathsf{\zeta })]\cup {\mathsf{\sigma }}_k$$

(13)

In addition, the set observation ${\mathbf{Z}}_k$ consists of the reflections from both the targets ${\theta }_k(\mathbf{x})$ and the clutters ${\kappa }_k$.

$${\mathbf{Z}}_k=[\bigcup _{\mathbf{x}\in {\mathbf{X}}_k}{\theta }_k(\mathbf{x})]\cup {\kappa }_k$$

(14)

Similar to Bayesian estimator, the PHD filter is also divided into prediction and update processes. Notice that D and $f_{k|k-1}(\mathbf{x}|\mathsf{\zeta })$ denote the posterior density and the transition function, respectively. $\mathsf{\zeta }$ is the previous state.

Thus, the prediction is represented as:

$$D_{k|k-1}(\mathbf{x})=[\int [P_S(\mathsf{\zeta })f_{k|k-1}(\mathbf{x}|\mathsf{\zeta })+\beta (\mathbf{x}|\mathsf{\zeta })]D_{k-1}(\mathsf{\zeta })d\mathsf{\zeta }]+{\gamma }_k$$

(15)

The intensity function is updated based on the measurement set ${\mathbf{Z}}_k$:

$$\begin{array}{c}\hfill D_k(\mathbf{x})=(1-P_D)D_{k|k-1}(\mathbf{x})+{\sum }_{z\in {\mathbf{Z}}_k}\frac{P_D{g}_k({\mathbf{z}}_{\mathbf{i}}|\mathbf{x})D_{k|k-1}(\mathbf{x})}{\kappa ({\mathbf{z}}_{\mathbf{i}})+\int P_D{g}_k({\mathbf{z}}_{\mathbf{i}}|\mathsf{\zeta })D_{k|k-1}(\mathsf{\zeta })d\mathsf{\zeta }}\end{array}$$

(16)

where $g_k({\mathbf{z}}_{\mathbf{i}}|\mathbf{x})$ and $P_D$ denote the likelihood function and the detection probability, respectively.

Notice that the predict function in Equation (15) are affected by targets, which enter the scene (${\gamma }_k$), and survive from the previous time step $P_S$ and the spawn targets ($\beta (\mathbf{x}|\mathsf{\zeta })$).

The update function in Equation (16) corrects the prediction by using innovations from the observations. Notice that the clutter rate is also considered in the update function.

$$N(k)={\int }_{\Psi }{D}_{k|k}(\mathbf{x})d\mathbf{x}$$

(17)

Equation (17) exhibits that the integration of the intensity function represents the number of targets. Meanwhile, the intensity is not a probability density and thus unnecessarily sums up to 1 [19].

The PHD recursions have multiple integrals with no closed form representation. Thus, the most common approach is to use Gaussian Mixture (GM)-PHD approximations [20]:

$$f_{k|k-1}(\mathbf{x}|\mathsf{\zeta })=\mathcal{N}(\mathbf{x};F_{k-1}\mathsf{\zeta },Q_{k-1})$$

(18)

$$g_k(\mathbf{z}|\mathbf{x})=\mathcal{N}(\mathbf{z};H_k\mathbf{x},R_k)$$

(19)

where $\mathbf{z}$ and $\mathbf{x}$ denote the current measurement and state, whereas $\mathsf{\zeta }$ denotes the previous state. A Gaussian distribution is represented as $\mathcal{N}(·;\mathbf{m},P)$ with mean $\mathbf{m}$ and covariance P. $F_{k-1}$ and $Q_{k-1}$ denote the transition matrix and process covariance, respectively. $H_k$ and $R_k$ denote the observation matrix and observation noise covariance. Notice that the detection and survival probabilities are constant values:

$$P_{S,k}(\mathbf{x})=P_S,P_{D,k}(\mathbf{x})=P_D$$

(20)

Birth targets ${\gamma }_k$ are modeled as:

$${\gamma }_k(\mathbf{x})=\sum _{i=1}^{J_{\gamma ,k}}{\omega }_{\gamma ,k}^{(i)}\mathcal{N}(\mathbf{x};{\mathbf{m}}_{\gamma ,k}^{(i)},P_{\gamma ,k}^{(i)})$$

(21)

where ${\omega }_{\gamma ,k}^{(i)}$, $P_{\gamma ,k}^{(i)}$, ${\mathbf{m}}_{\gamma ,k}^{(i)}$ and $J_{\gamma ,k}$ denote the weight, covariance, mean and amount of the Gaussians.

Assuming the posterior intensity at time $k-1$ is a Gaussian mixture:

$$D_{k-1}(\mathbf{x})=\sum _{i=1}^{J_{k-1}}{\omega }_{k-1}^{(i)}\mathcal{N}(\mathbf{x};{\mathbf{m}}_{k-1}^{(i)},P_{k-1}^{(i)})$$

(22)

Equation (15) to time k is also a Gaussian mixture

$$D_{k|k-1}(\mathbf{x})=P_S\sum _{i=1}^{J_{k-1}}{\omega }_{k-1}^{(i)}\mathcal{N}(\mathbf{x};{\mathbf{m}}_{S,k|k-1}^{(i)},P_{S,k|k-1}^{(i)})+{\gamma }_k(\mathbf{x})$$

$$\begin{array}{cc}& {\mathbf{m}}_{S,k|k-1}^{(i)}=F_{k-1}{\mathbf{m}}_{k-1}^{(i)},P_{S,k|k-1}^{(i)}=Q_{k-1}+F_{k-1}{P}_{k-1}^{(i)}{F}_{k-1}^T\hfill \end{array}$$

and the Equation (16) at time k is calculated as

$$D_k(\mathbf{x})=(1-P_D)D_{k|k-1}(\mathbf{x})+\sum _{z\in Z_k}{D}_{D,k}(\mathbf{x};\mathbf{z})$$

(23)

where

$$D_{D,k}(\mathbf{x};\mathbf{z})=\sum _{j=1}^{J_{k|k-1}}{\omega }_k^{(j)}(\mathbf{z})\mathcal{N}(\mathbf{x};{\mathbf{m}}_{k|k}^{(j)}(\mathbf{z}),P_{k|k}^{(j)})$$

$${\omega }_k^j(\mathbf{z})=\frac{P_D{w}_{k|k-1}^{(j)}{q}_k^{(j)}(\mathbf{z})}{{\kappa }_k(\mathbf{z})+P_D{\sum }_{l=1}^{J_{k|k-1}}{w}_{k|k-1}^{(l)}{q}_k^{(l)}(\mathbf{z})}$$

$$q_k^{(j)}(\mathbf{z})=\mathcal{N}(\mathbf{z};H_k{\mathbf{m}}_{k|k-1}^{(j)},H_k{P}_{k|k-1}^{(j)}{H}_k^T+R_k)$$

$${\mathbf{m}}_k^{(j)}(\mathbf{z})={\mathbf{m}}_{k|k-1}^{(j)}+K_k^{(j)}(\mathbf{z}-H_k{\mathbf{m}}_{k|k-1}^{(j)})$$

$$P_k^{(j)}=[I-K_k^{(j)}{H}_k]P_{k|k-1}^{(j)}$$

$$K_k^{(j)}=P_{k|k-1}^{(j)}{H}_k^T{[H_k{P}_{k|k-1}^{(j)}{H}_k^T+R_k]}^{-1}$$

The GMPHD filter addresses the data association challenge in contrast to the standard Bayes filter. The process model Equation (18) and measurement model Equation (19) are equal to the RHM Bayes filter in Equations (7) and (8), whereas the implementation process is different.

2.3. RHM–GM–PHD Filter

In Section 2.2, the GMPHD filter is introduced for dealing with unknown data association issues. Notice that the standard GMPHD filter operates in condition that one reflection is received for each target per frame, called “Point Target (PT) tracking”. In the vehicle detection scenario, a large number of measurements would be collected from the surface of a single object, called “Extended Target (ET) tracking”. Therefore, the GMPHD filter should be redesigned for dealing with extended targets solely relying on LiDAR measurement.

The process model and measurement model are similar to the RHM Bayes filter in Equations (7) and (8). The prediction equation of the ET–GM–PHD filter are also the same as the standard GMPHD filter. The measurement update formulas for the ET–GM–PHD filter is introduced as:

$$\begin{array}{c}\hfill D_{k|k}(\mathbf{x})=L_{Z_k}(\mathbf{x})D_{k|k-1}(\mathbf{x}|Z)\end{array}$$

(24)

and the pseudo-likelihood function $L_{Z_k}(\mathbf{x})$ is defined as

$$\begin{array}{c}\hfill L_{Z_k}(\mathbf{x})=1-(1-e^{-\gamma (\mathbf{x})})P_D(\mathbf{x})+e^{-\gamma (\mathbf{x})}{P}_D(\mathbf{x})\sum _{p\angle Z_k}{w}_p\sum _{W\in p}\frac{\gamma {(\mathbf{x})}^{\left|W\right|}}{d_W}\prod _{z\in W}\frac{{\varphi }_{\mathbf{z}}(\mathbf{x})}{{\lambda }_k{c}_k(\mathbf{z})}\end{array}$$

(25)

where ${\lambda }_k{c}_k(\mathbf{z})$ is the mean number of clutter measurements, $c_k(\mathbf{z})$ is the spatial distribution of the clutter, notation $p\angle Z_k$ denotes that p partitions the measurement set $Z_k$ into non-empty cells W, notation $W\in p$ denotes that W is a cell in the partition p, $w_p$ and $d_W$ denote the non-negative coefficients for each partition and cell, and $\varphi (\mathbf{x})$ denotes the same likelihood function for a single measurement in Equation (12).

Here,

$$\begin{array}{c}\hfill w_p=\frac{{\displaystyle \prod _{W\in p}}{d}_W}{{\displaystyle \sum _{p^{{}^{\prime }}\angle Z_k}}{\displaystyle \prod _{W^{{}^{\prime }}\in p^{{}^{\prime }}}}{d}_{W^{{}^{\prime }}}}\end{array}$$

(26)

and

$$\begin{array}{c}\hfill d_W={\delta }_{\left|W\right|,1}+D_{k|k-1}[e^{-\gamma }{\gamma }^{\left|W\right|}{P}_D\prod _{\mathbf{z}\in W}\frac{{\varphi }_{\mathbf{z}}}{{\lambda }_k{c}_k(\mathbf{z})}]\end{array}$$

(27)

where ${\delta }_{i,j}$ is the Kronecker delta function and $\left|W\right|$ is the number of measurements in cell W. More details of the implementation process could be found in [21,22].

Hence, the ET–GM–PHD filter tracks the potential objects by solely relying on LiDAR without any association or cluster process. The estimated states represent the potential objects and would be filtered again by the support vector machine to eliminate non-vehicle objects.

3. Hypothesis Verification

To eliminate the outliers, the support vector machine is utilized to classify the vehicle and non-vehicle Fourier coefficients.

3.1. Support Vector Machine (SVM)

As exhibited in Figure 5, the SVM is proposed to obtain classifiers with good generalization [23]. The mathematical background is introduced as follows:

For ${\mathbf{x}}_i\in {\mathbb{R}}^n$ with respect to the classification $y_i\in \{-1,+1\},i=1,\cdots ,k$, the hyperplane is defined as:

$$f(\mathbf{x})=w^T\mathbf{x}+b$$

(28)

to linearly separate each data. Notice that $\mathbf{x}$, w and b denote the input vector, weight vector and the bias, respectively. Hence a maximum margin is found to separate positive class from negative class based on

$$f(\mathbf{x})=\mathrm{sgn}(w^T\mathbf{x}+b)$$

(29)

The calculation of the hyperplane is subjected to the following constraints:

$$\mathrm{Minimize}\frac{1}{2}{\left|\right|w\left|\right|}^2$$

$$\mathrm{Subject}\mathrm{to}{y}_i(w_i{x}_i+b)\ge 0$$

and the classification performance relies on the optimization as:

$$\mathrm{Maximize}\sum _{i=1}^k{\alpha }_i-\frac{1}{2}\sum _{i,j=0}^k{\alpha }_i{\alpha }_j{y}_i{y}_{j}K(x_i,x_j)$$

$$\mathrm{Subject}\mathrm{to}\sum _{i=1}^k{y}_i{\alpha }_i=0,{\alpha }_i\ge 0fori=1,\dots ,k$$

where $K(x_i,x_j)$ and ${\alpha }_i$ denote the Kernel function and Lagrange multiplier, respectively. Notice that if the data can not be separated linearly, the kernel function changes according to

$$K(x_i,x_j)=K(x_i,x_j)+\frac{1}{C}{\delta }_{ij}$$

(30)

where C denotes the penalize parameter.

3.2. Implementation Detail

During the implementation, there are still issues in both the generation and verification phases.

• ET–GM–PHD Implementation

To track objects in multiple frames, the alignment issue should also be considered. Thus the state to be tracked in the ET–GM–PHD filter is ${\mathbf{x}}_k=[v_x,v_y,x,y,({\overline{b}}_k{)}^T{]}^T$, where ${[v_x,v_y,x,y,]}^T$ is the normal state of the object centroid in the 2D Cartesian coordinate system and $({\overline{b}}_k)$ is the shape parameter by using 13 Fourier descriptors. Although a higher number of Fourier descriptors returns more details of the surface, the computation performance and robustness is unsatisfied. In this paper, 13 Fourier descriptors are selected based on the experience during the experiment.

Each object follows the liner Gaussian dynamic Equation (18) with the following configurations:

$$F_k=\text{diag}(A_k,{\mathbf{I}}_{13}),A_k=\left[\begin{array}{cc}{\mathbf{I}}_2& {\mathbf{0}}_2\\ {\mathbf{I}}_2& {\mathbf{I}}_2\end{array}\right]$$

(31)

$$Q_k=\text{diag}(C_k,0.03{\mathbf{I}}_{13}),C_k=\left[\begin{array}{cc}{\mathbf{I}}_2& \frac{{\mathbf{0}}_2}{2}\\ \frac{{\mathbf{0}}_2}{2}& \frac{1}{4}\end{array}\right]$$

(32)

where ${\mathbf{I}}_n$ and ${\mathbf{0}}_n$ denote the $n\times n$ identity and zero matrix, respectively. The measurement covariance is given using parameters $\mathrm{diag}[0.5,\dots ,0.5]$.

Regarding the measurement model, it follows the non-linear Gaussian dynamic Equation (19) and is described as:

$$\begin{array}{c}\hfill \mathbf{0}=s^2·\left|\right|R(\varphi )·{\overline{b}}_k{\left|\right|}^2+2sR(\varphi ){\overline{b}}_{k}e{(\varphi )}^T{v}_k+\left|\right|v_k{\left|\right|}^2-\left|\right|y_k-m_k{\left|\right|}^2\end{array}$$

where s is a Gaussian function with mean 0.5 and variance 0.03. The birth intensity of the PHD filter is given according to the geometry information. To reduce the computation complexity, measurements which fall into the road regions are utilized to initialize the vehicles. The birth intensity is thus given by

$${\gamma }_k(\mathbf{x})=0.1\mathcal{N}(\mathbf{x};{\mathbf{m}}_{\gamma ,k}^1,P_{\gamma ,k}^1)+0.1\mathcal{N}(\mathbf{x};{\mathbf{m}}_{\gamma ,k}^2,P_{\gamma ,k}^2)+0.1\mathcal{N}(\mathbf{x};{\mathbf{m}}_{\gamma ,k}^3,P_{\gamma ,k}^3)$$

(33)

where ${\mathbf{m}}_{\gamma ,k}^1=[0,0,0,1,2,0,\dots ,0]$, ${\mathbf{m}}_{\gamma ,k}^2=[0,0,-5,1,2,0,\dots ,0]$ and ${\mathbf{m}}_{\gamma ,k}^3=[0,0,5,1,2,0,\dots ,0]$ represents the vehicles in the middle (0,1), left (−5,1) and right (5,1), respectively. $P_{\gamma ,k}^1=P_{\gamma ,k}^2=P_{\gamma ,k}^3=\mathrm{diag}[2,2,2,2,0.3,\dots ,0.3]$.

• SVM Implementation

The KITTI dataset is utilized for training the classifier, which provides a set of 5000 training frames with 1893 manually labeled objects (car, van, tram, misc, pedestrian, cyclist, trunk and so on). For each object, the original measurements (all objects are labeled with a 2D box, where measurement-to-target association is confirmed) are projected to the 2D Cartesian coordinate system around its original point. The 13 Fourier coefficients are then calculated by using the standard nonlinear Kalman filter [15]. Instead of multiple categories, objects are only considered as vehicles and non-vehicles (actually it is divided by cars and non-cars). Then, the SVM is trained by collecting Fourier coefficients from all calculated objects. In further evaluation, another 2000 frames of test data is utilized to guarantee the performance both quantitatively and qualitatively. The SVM is implemented in both the training and test phases without cross-validation.

• Key Parameters and Open Issues

During the ET–GM–PHD process, potential objects are collected in the set-valued state. The Fourier coefficients describe the shape information, and the position vector represents the location. The estimated objects are also shown by using bounding boxes, where the mean point uses the position and the width/height are calculated based on the Fourier coefficients (the Fourier coefficients represent the rough shapes in polar coordinate systems, in which the width and height of the boundary box are calculated by setting the φ equals to 0 and $\frac{\pi }{2}$). Since the PHD filter addresses the data association issue, the points cloud data is directly utilized to estimate the set-valued states. No further cluster process is required. Meanwhile, for each single measurement, the probabilities of both detection and survival are constant and no more than 1. In addition, the PHD filter may estimate close objects as single objects mainly due to the scale factor s. For the RHM model, measurements are considered as random draws from boundaries with different scaling factors in the range $[0,1]$. When objects are close to each other, it is quite challenging to distinguish them.

During the SVM process, the calculated coefficients from objects are utilized to eliminate the outliers. Since most cars have a similar width/length rate, the car-labeled objects are treated as vehicles and the rest are non-vehicles. Furthermore, the 13 Fourier coefficients have been found to be quite challenging for linearly separating vehicles and non-vehicles. To better train the SVM, the radial based kernel function is utilized as:

$$K(x_i,x_j)=\exp (\frac{-\left|\right|x_i-x_j{\left|\right|}^2}{2{\sigma }^2})$$

(34)

where σ affects distributing complexity in the feature space.

4. Experiment Evaluation

To evaluate the approach quantitatively and qualitatively, the KIT dataset is utilized and compared with the state-of-the-art [24]. During the experiment, the proposed approach is implemented in Matlab with 2 Cores@3 GHz, and the average time is 5 s per frame.

Figure 6, Figure 7 and Figure 8 demonstrate the detection performance based on the proposed approach in one scenario. In Figure 6, a bicycle is fully observed in the middle of the road. On the left side, a parking car is observed with partial occlusion. On the right side, both car and pedestrian are fully observed. As illustrated in Figure 7, potential objects are detected based on the RHM–ET–PHD filter. It is observed that the proposed approach extracts the potential objects based on the geometry of the road, where the birth model plays an important role. The extracted objects are drawn by boundary boxes calculated by the set-valued state (the center point is based on the position, and the width/height are based on the Fourier coefficients). Afterwards, the SVM is utilized to eliminate the non-vehicle objects. Figure 8 shows the results of the verification phase. Due to the occluded issues, it is observed that the left vehicle is also eliminated.

Table 1. Performance of the vehicle detection approach compared with the state-of-the-art.

Method	Ours	Vote3D [25]	CSoR [26]	mBoW [27]
Easy	75%	57%	35%	36%
Moderate	15%	48%	26%	24%
Hard	3%	43%	23%	18%
Average time	5 s	0.5 s	3.5 s	10 s

demonstrates the overall performance, in contrast to the state-of-the-art, in all scenarios from the KITTI dataset. Although there are also approaches using cameras, the evaluation focuses on the algorithms which only use LiDAR measurements.

As illustrated in Table 1, moderate, easy and hard denote the occlusion level of vehicles, with respect to partly occluded, fully visible and difficult to see. Among the references, the proposed approach achieves a high performance for the easy category and poor performance for both moderate and hard categories. In easy scenarios, all vehicles are fully observed and the corresponding reflections on surfaces are uniformly distributed. Hence, the proposed approach can track and estimate the states successfully, and the final classification process has high performance. In moderate and hard scenarios, the corresponding performance drops significantly in both the generation and verification processes. For PHD filter, although it detects the potential objects, the calculated Fourier coefficients are strongly influenced by the invisible measurements. For SVM classification, the training process mainly relies on the visible measurements to calculate Fourier coefficients.

Nevertheless, compared with the overall performance in easy scenarios, the proposed approach still improves almost $20\%$–$40\%$.

As a summary, the contributions are concluded as follows: first and foremost, the proposed framework solely relies on LiDAR measurements for vehicle detection in the presence of unknown data association environments. Furthermore, the Fourier coefficient is first proposed for object classification and concluded with high performance for fully visible vehicles.

5. Conclusions

Vehicle detection is important for developing driver assistance systems. To address the data association problem that suffers from points cloud data, the Probability Hypothesis Density (PHD) filter is proposed in this paper. The proposed scheme utilizes contour information for classification. The evaluation results illustrate a high performance in contrast to the state-of-the-art techniques.

Future work focuses on the improvement of detecting occluded vehicles.