In this section, we give a brief review of deriving the theory for detecting object dynamics in ALS. We refer to the dimension perpendicular to the sensor heading synonymously as across-track. The dimension along the sensor path will be denoted by a along-track.
3.1 Artifacts Effect of Vehicle Motion in ALS Data
In order to assess the feasibility of extracting information on traffic dynamics from airborne LiDAR sensors installed on the airborne platform, the main characteristics of the sensor, including the data formation method, should be considered first. In most airborne LiDAR scanning processes, exclusive of flash LiDAR which are predominantly based on mechanical scanning, a rotating laser pointer rapidly scans the Earth’s surface with continuous scan angles during flight. While the sensor is moving it transmits laser pulses at constant intervals given by the pulse repetition frequency (PRF) and receives the echoes. With respect to moving objects, the fundamental difference between scanning and the frame camera model is the presence of motion artifacts in the scanner data. Due to short sampling time (camera exposure), the imagery preserves the shape of moving objects; if the relative speed between the sensor and the object is significant then increased motion blurring may occur. In contrast, scanning will always produce motion artifacts, since the distance between sensor and target is usually calculated based on the stationary-world assumption; fast-moving objects violate this assumption and therefore image the target incorrectly depending on the relative motion between the sensor and the object. The dependency can be seen by adding the temporal component into the range equation of the LiDAR sensor. Here, it is assumed that the sampling rate is consistent among all the vehicles independent of the scan angle. That is to say that all the vehicles are scanned with enough points to represent their shape artifacts.
In Fig. 22.3a the geometry of data acquisition is shown. The sensor is flying at a certain altitude along the dotted arrow. An example of shape artifacts generated by moving objects is also depicted in Fig. 22.3b, where the black dotted box indicates the vehicle shape obtained in the scanning process of airborne LiDAR while the original vehicle is depicted as a rectangle nearby. It can be perceived that the moving vehicle is imaged as a stretched parallelogram. Let \(\theta_{v}\) be the intersection angle between the moving directions of sensor and vehicle where \(\theta_{v} \in \left[ {0^{ \circ } ,360^{ \circ } } \right]\), vL and v the velocity of aircraft and vehicle respectively, ls and lv the sensed and original lengths of the vehicle, respectively; and \(\theta_{SA}\) the shearing angle that accounts for the deformation of the vehicle as a parallelogram. The analytic relations between shape artifacts and object-movement parameters can be derived as:
$$l_{s} = \frac{{l_{v} \cdot v_{L} }}{{v_{L} - v \cdot \cos \left( {\theta_{v} } \right)}} = \frac{{l_{v} }}{{1 - \frac{v}{{ \, v_{L} }} \cdot \cos \left( {\theta_{v} } \right)}}$$
(22.7)
$$\theta_{SA} = \arctan \left( {\frac{{v \cdot \sin \left( {\theta_{v} } \right)}}{{v_{l} - v \cdot \cos \left( {\theta_{v} } \right)}}} \right) + 90^{ \circ }$$
(22.8)
where \(\theta_{SA} \in \left( {0^{ \circ } \,180^{ \circ } } \right)\) and is found as the left-bottom angle of the observed vehicle.
For the sake of full understanding of the appearance of moving objects in the airborne LiDAR data, object motions are to be divided into the following different components and investigated for their respective influences on the data artifacts generated.
First, the target is assumed to move with constant velocity \(v_{a}\) following the along-track direction, which leads to the stretching effect of the object shape depending on the relative velocity between target and sensor as illustrated in Fig. 22.4.
The analytic relation between the object velocity in along-track direction \(v_{a}\) and the observed stretched length \(l_{s}\) thus can be summarized in Eq. 22.9. The relation in Eq. 22.9 is further modified to Eq. 22.10 which explicitly connects \(v_{a}\) with the variation in the aspect ratio of vehicle shape in a mathematical way, thereby making motion detection and velocity estimation more feasible and reliable:
$$l_{s} = \frac{{l_{v} }}{{1 - \frac{{v_{a} }}{{v_{L} }}}}$$
(22.9)
$$Ar_{s} = \frac{{l_{s} }}{{w_{v} }} = \frac{Ar}{{1 - \frac{{v_{a} }}{{v_{L} }}}}$$
(22.10)
where \(Ar_{s}\) is the sensed aspect ratio of the vehicle in ALS data while \(Ar\) is the original aspect ratio of the vehicle and wv is the width of the vehicle.
Secondly, the target is assumed to move in the across-track direction with a constant velocity \(v_{c}\). This results in a scanline-wise linear shift of laser footprints that hit upon the target in the direction of movement when the sensor is sweeping over so that the observed vehicle shape in ALS data is deformed (sheared) to a certain extent as illustrated in Fig. 22.5.
Let \(v_{c}\) be the across-track motion component of the object velocity. Since \(v_{c} = v \cdot \sin \left( {\theta_{v} } \right)\), Eq. 22.8 can be rewritten as Eq. 22.11 for describing the analytic relation between the object velocity \(v_{c}\) and the observed shearing angle \(\theta_{SA}\) through the sensor velocity \(v_{L}\) and the intersection angle \(\theta_{v}\):
$$\begin{array}{*{20}l} {\theta_{SA} = \arctan \left( {\frac{1}{{{{v_{L} } \mathord{\left/ {\vphantom {{v_{L} } {v_{c} - \cot (\theta_{v} )}}} \right. \kern-\nulldelimiterspace} {v_{c} - \cot (\theta_{v} )}}}}} \right) + 90^{ \circ } } & {{\text{where}}\, \theta_{v} \ne 0^{ \circ } {/}180^{ \circ } \wedge v_{c} \ne 0} \\ {\theta_{SA} = 90^{ \circ } } & {{\text{where}}\,\theta_{v} = 0{/}180^{ \circ } \vee v_{c} = 0} \\ \end{array}$$
(22.11)
3.2 Detection of Moving Vehicles
All of the effects of moving objects described above can be exploited to not only detect vehicles’ movement but also measure their velocity. Our scheme for vehicle motion detection relies on a strategy consisting of two basic modules successively executed: (1) vehicle extraction; and (2) determination of the motion state.
For vehicle extraction, we used a hybrid strategy (Fig. 22.6) that integrates a 3D segmentation-based classification method with a context-guided approach. For a detailed analysis of vehicle detection, we refer the readers to Yao et al. (2010a, 2011).
To determine the motion state, a support vector machine (SVM) classification-based method is adopted. A set of vehicle points can be geometrically described as a spoke model with control parameters, whose configuration can be formulated as
$${\mathbf{X}} = \left( {\begin{array}{*{20}c} {{\mathbf{U}}_{1} } \hfill \\ \cdot \hfill \\ \cdot \hfill \\ {{\mathbf{U}}_{k} } \hfill \\ \end{array} } \right),{\mathbf{U}}_{i} = \left( {\begin{array}{*{20}c} {\theta_{SA}^{i} } \\ {Ar_{i} } \\ \end{array} } \right)$$
(22.12)
where k denotes the number of spokes in the model. It can be seen that the vehicle shape variability can be represented as a two-dimensional feature space (if the number of spokes k = 1). Thus, the similarity between vehicle instances of different motion states needs to be measured by a nonlinear metric. The SVM has advantages in nonlinear recognition problems and finds an optimal linear hyperplane in a higher dimensional feature space that is nonlinear in the original input space. The trick of using a kernel avoids direct evaluation in the feature space of higher dimension by computing it through the kernel function with feature vectors in the input space. The SVM classifier can be used here again to perform binary classification on those vehicles which still remain after excluding the ones of uncertain state obtained by the shape parameterization step. In addition, the classification framework for distinguishing 3D shape categories (Fletcher et al. 2003) can be adapted to the motion classification schema based on exploiting the vehicle shape features.
3.3 Concept for Vehicle Velocity Estimation with ALS Data
The estimation of the velocity of detected moving vehicles can be done based on all motion artifacts effects in a single pass of ALS data by inverting the motion artifacts model to relate the velocity with other observed and known parameters. Thus, different measurements and derivations might be used to estimate the velocity. The estimation scheme can be initially divided into two main categories, depending on whether the moving direction of vehicles is known or not:
First, given the intersection angle which can be further separated into the following three situations using respective observations to estimate the velocity:
-
(a)
The measure for shearing angle of the detected moving vehicles from their original orthogonal shape of rectangles;
-
(b)
The measure for the stretching effect of detected moving vehicles from their original size; and
-
(c)
The combination of the along-track and across-track velocity components which are estimated based on the above-mentioned effects, respectively.
Second, if the intersection angle is not given:
-
(a)
The solution to a system of bivariate equations constructed by uniting the two formulas.
The three methods in the first category assume that the moving directions of vehicles are given beforehand, whereas the last one from the second category does not. To estimate the velocity, the first three methods either utilize the shape stretching or shearing effect or combine them together when applicable. For the last case, the moving direction of vehicles can be estimated along with the velocity by uniting the variable of velocity with the variable of the intersection angle to build a system of bivariate equations and solving it, thereby giving the motion estimation great flexibility to deal with many arduous cases encountered in real-life scenarios. That means that not only the quantity but also the direction of vehicles’ motion can be derived. All possible approaches have their advantages and disadvantages and differ in the accuracy of their results, which are to be analyzed and evaluated in the following subsections, respectively.
3.3.1 Velocity Estimation Based on the Across-Track Deformation Effect
The shearing angle of moving vehicles caused by the across-track deformation allows for direct access to the velocity only if the moving direction is known a priori and input as an observation. Still, information about the orientation of the road axis relative to the vehicle motion is needed to derive the real velocity of vehicles. The velocity estimate v of the vehicle based on the shearing effect of its shape is derived by inverting Eq. 22.8 as
$$v = \frac{{v_{L} \cdot \tan \left( {\theta_{SA} - 90^{ \circ } } \right)}}{{\cos \theta_{v} \cdot \tan \left( {\theta_{SA} - 90^{ \circ } } \right) + \sin \left( {\theta_{v} } \right)}}$$
(22.13)
The value of the intersection angle \(\theta_{{v}}\) can be determined based on principal axis measurements of vehicle points as the flight direction of the airborne LiDAR sensor can always be assumed to be known thanks to sustained navigation systems. Given Eq. 22.13 which shows that the accuracy of the velocity estimate based on the across-track deformation effect \(\sigma^{c}_{v}\) is a function of the quality of the moving vehicle’s heading angle relative to the sensor flight path \(\theta_{v}\) and the accuracy of the shearing angle measurement \(\theta_{SA}\), the standard deviation of the velocity estimate is calculated using the error propagation law (Wolf and Ghilani 1997) and derived as
$$\begin{aligned} \sigma _{v}^{c} & = \sqrt {\left( {\frac{{\partial v}}{{\partial \theta _{v} }}} \right)^{2} \sigma _{{\theta _{v} }}^{2} + \left( {\frac{{\partial v}}{{\partial \theta _{{SA}} }}} \right)\sigma _{{\theta _{{SA}} }}^{2} } \\ & = \sqrt {\begin{array}{*{20}c} {\left( {\frac{{v_{L} \cdot \tan \left( {\theta _{{SA}} - 90^{ \circ } } \right) \cdot \left( {\cos \left( {\theta _{v} } \right) - \tan \left( {\theta _{{SA}} - 90^{ \circ } } \right) \cdot \sin \left( {\theta _{v} } \right)} \right)}}{{\left( {\sin \left( {\theta _{v} } \right) + \tan \left( {\theta _{{SA}} - 90^{ \circ } } \right) \cdot \cos \left( {\theta _{v} } \right)} \right)^{2} }}} \right)^{2} \sigma _{{\theta _{v} }}^{2} } \\ +\, { \left( {\frac{{2v_{L} \cdot \sin \left( {\theta _{v} } \right)\left( {\tan \left( {90^{ \circ } - \theta _{{SA}} } \right)^{2} + 1} \right)}}{{\cos \left( {2\theta _{v} } \right) \cdot \tan \left( {90^{ \circ } - \theta _{{SA}} } \right)^{2} - 2\,\sin \left( {2\theta _{v} } \right) \cdot \tan \left( {90^{ \circ } - \theta _{{SA}} } \right) - \cos \left( {2\theta _{v} } \right) + \tan \left( {90^{ \circ } - \theta _{{SA}} } \right)^{2} + 1}}} \right)^{2} \sigma _{{\theta _{{SA}} }}^{2} } \\ \end{array} } \\ \end{aligned}$$
(22.14)
with \(v_{L}\) being the instantaneous flying velocity of the sensor system.
3.3.2 Velocity Estimation Based on Along-Track Stretching Effect
Besides the above mentioned approach, the velocity of a moving vehicle can be derived by measuring its along-track stretching effect from its original vehicle size. The functional relation is given by:
$$v = \frac{{\left( {1 - Ar/Ar_{s} } \right) \cdot v_{L} }}{{\cos \left( {\theta_{v} } \right)}}$$
(22.15)
where \(Ar_{s}\) = \(l_{s} /w_{v}\) is the sensed aspect ratio of the moving vehicle, while Ar is the original aspect ratio and assumed to be constant. The accuracy of the velocity estimate based on the along-track stretching effect \(\sigma_{v}^{a}\) is a function of the quality of the aspect ratio measurement for detected moving vehicles and the accuracy of the vehicle’s heading relative to the sensor flight path. \(\sigma_{v}^{a}\) can be calculated by the error propagation law as follows:
$$\begin{aligned} \sigma _{v}^{a} & = \sqrt {\left( {\frac{{\partial v}}{{\partial \theta _{v} }}} \right)^{2} \sigma _{{\theta _{v} }}^{2} + \left( {\frac{{\partial v}}{{\partial Ar_{s} }}} \right)^{2} \sigma _{{Ar_{s} }}^{2} } \\ & = \sqrt {\left( { - \frac{{v_{L} \cdot \sin \left( {\theta _{v} } \right) \cdot \left( {Ar/Ar_{s} - 1} \right)}}{{\cos \left( {\theta _{v} } \right)^{2} }}} \right)^{2} \sigma _{{\theta _{v} }}^{2} + \left( {\frac{{Ar \cdot v_{L} }}{{Ar_{s}^{2} \cdot \cos \left( {\theta _{v} } \right)}}} \right)} \sigma _{{Ar_{s} }}^{2} \\ \end{aligned}$$
(22.16)
3.3.3 Velocity Estimation Based on Combining Two Velocity Components
Both estimation methods presented above might fail to give a reliable velocity estimate if vehicles are moving in such a direction that generated deformation effects for the vehicle shape are not dominated by either one of what the two moving components account for (e.g., a moving vehicle with intersection angle \(\theta_{v}\) = 35° and velocity v = 40 km/h). To fill this gap and enable a velocity estimate in an arbitrary traffic environment, it is proposed to use both shape deformation effects for estimating velocities. The functional dependence of the velocity estimate can be given by the sum of squares of the two motion components, which are derived based on two the shape deformation parameters Ars and \(\theta_{SA}\), respectively:
$$v = \sqrt {\left( {v_{a} } \right)^{2} + \left( {v_{c} } \right)^{2} }$$
(22.17)
$${\text{where}}\left\{ {\begin{array}{*{20}c} {v_{a} = v_{L} \cdot \left( {1 - \frac{{Ar}}{{Ar_{s} }}} \right)} \\ {v_{c} = \frac{{v_{L} }}{{\cot \left( {\theta _{{SA}} - 90^{^\circ } } \right) + \cot \left( {\theta _{v} } \right)}}} \\ \end{array} } \right.$$
(22.18)
and where va and vc are along and across-track motion components. The accuracy of the velocity estimate based on combining the two components \(\sigma_{v}^{a + c}\) is a function of the quality of the along-track and across-track motion measurements for the detected moving vehicle and \(\sigma_{v}^{a + c}\) can be first calculated with respect to these two motion components by the error propagation law as:
$$\begin{aligned} \sigma _{v}^{{a + c}} & = \sqrt {\left( {\frac{{\partial v}}{{\partial v_{a} }}} \right)^{2} \partial ^{2} v_{a} + \left( {\frac{{\partial v}}{{\partial v_{c} }}} \right)^{2} \partial ^{2} v_{c} } \\ & = \sqrt {\frac{{v_{a}^{2} }}{{v_{a}^{2} + v_{c}^{2} }}\sigma _{{v_{a} }}^{2} + \frac{{v_{c}^{2} }}{{v_{a}^{2} + v_{c}^{2} }}\sigma _{{v_{c} }}^{2} } \\ \end{aligned}$$
(22.19)
where \(\sigma_{{v_{a} }}\) and \(\sigma_{{v_{c} }}\) are the standard deviations of along- and across-track motion derivations, respectively. They can be further decomposed into the accuracy with respect to the three observations concerning the vehicle shape and motion parameters based on Eq. 22.18. Using the error propagation law, \(\sigma_{{v_{a} }}\) and \(\sigma_{{v_{c} }}\) are inferred as:
$$\sigma_{{v_{a} }} = \frac{{\partial v_{a} }}{{\partial Ar_{s} }}\sigma_{{Ar_{s} }} = \frac{{Ar \cdot v_{L} }}{{Ar_{s}^{2} }}\sigma_{{Ar_{s} }}$$
(22.20)
$$\begin{aligned} \sigma _{{v_{c} }} & = \sqrt {\left( {\frac{{\partial v_{c} }}{{\partial \theta _{v} }}} \right)^{2} \sigma _{{\theta _{v} }}^{2} + \left( {\frac{{\partial v}}{{\partial \theta _{{SA}} }}} \right)\sigma _{{\theta _{{SA}} }}^{2} } \\ & = \sqrt {\left( {\frac{{v_{L} \cdot \left( {\cot \left( {\theta _{v} } \right)^{2} + 1} \right)}}{{\left( {\cot \left( {90^{^\circ } - \theta _{{SA}} } \right) - \cot \left( {\theta _{v} } \right)} \right)^{2} }}} \right)^{2} \sigma _{{\theta _{v} }}^{2} + \left( {\frac{{v_{L} \cdot \left( {\cot \left( {90^{^\circ } - \theta _{{SA}} } \right)^{2} + 1} \right)}}{{\left( {\cot \left( {90^{^\circ } - \theta _{{SA}} } \right) - \cot \left( {\theta _{v} } \right)} \right)^{2} }}} \right)^{2} \sigma _{{\theta _{{SA}} }}^{2} } \\ \end{aligned}$$
(22.21)
Finally, after substituting Eqs. 22.20 and 22.21 into Eq. 22.19, the error propagation relation for the velocity estimate is based on combining the two velocity components with respect to the three variables Ars, \(\theta_{SA}\), and \(\theta_{v}\) is derived.
3.3.4 Joint Estimation of Vehicle Velocity and Direction by Solving Simultaneous Equations
So far, all of the estimation methods are not able to give velocity estimates if they are moving in an unknown direction or their moving detections cannot be accurately determined in advance. To solve this problem, we propose to jointly consider velocities and the intersection angle \({\theta_{v} }\) as unknown parameters simultaneously, with the variables describing the deformation effects caused by the motion components as observations. Actually, two analytic formulas for the motion artifacts model can be directly viewed as an equation system to which the velocity and the intersection angle are formulated as a set of solutions. This system of bivariate equations relating unknown parameters to observations is given by:
$$\left\{ {\begin{array}{*{20}l} {\theta _{{SA}} - 90^{^\circ } = \arctan \left( {\frac{{v \cdot \sin \left( {\theta _{v} } \right)}}{{v_{L} - v \cdot \cos \left( {\theta _{v} } \right)}}} \right)} \\ {1 - \frac{v}{{v_{L} }} \cdot \cos \left( {\theta _{v} } \right) = \frac{{Ar}}{{Ar_{s} }}} \\ \end{array} } \right.$$
(22.22)
The system is to be solved using the substitution method. First, transform the second sub-equation of Eq. 22.22 into
$$v = \frac{{v_{L} }}{{\cos \left( {\theta_{v} } \right)}} \cdot \left( {1 - \frac{Ar}{{Ar_{s} }}} \right)$$
(22.23)
and substitute it into the first sub-equation of Eq. 22.22, which has been converted into a more solution-friendly expression in advance:
$$\tan \left( {\theta_{SA} - 90^{ \circ } } \right) \cdot v_{L} = v \cdot \left( {\tan \left( {\theta_{SA} - 90^{ \circ } } \right) \cdot \cos \left( {\theta_{v} } \right) + \sin \left( {\theta_{v} } \right)} \right)$$
(22.24)
After substitution, the expression of Eq. 22.24 can be rewritten as:
$$\begin{aligned} \tan \left( {\theta_{SA} - 90^{ \circ } } \right) \cdot v_{L} & = v_{L} \left( {1 - \frac{Ar}{{Ar_{s} }}} \right) \cdot \tan \left( {\theta_{SA} - 90^{ \circ } } \right) \\ & \quad + \tan \left( {\theta_{v} } \right) \cdot v_{L} \cdot \left( {1 - \frac{Ar}{{Ar_{s} }}} \right) \\ \end{aligned}$$
(22.25)
Further, we transform to facilitate the solution and get:
$$\begin{aligned} \tan \left( {\theta _{v} } \right) & = \frac{{\tan \left( {\theta _{{SA}} - 90^{^\circ } } \right) \cdot \left[ {\left( {1 - \left( {1 - \frac{{Ar}}{{Ar_{s} }}} \right)} \right)} \right]}}{{1 - \frac{{Ar}}{{Ar_{s} }}}} = \tan \left( {\theta _{{SA}} - 90^{^\circ } } \right)\left( {\frac{{Ar_{s} }}{{Ar_{s} - Ar}} - 1} \right) \\ & \Rightarrow \theta _{v} = \arctan \left[ {\tan \left( {\theta _{{SA}} - 90^{^\circ } } \right) \cdot \left( {\frac{{Ar_{s} }}{{Ar_{s} - Ar}} - 1} \right)} \right] \\ \end{aligned}$$
(22.26)
Finally, substitute the second sub-equation in Eq. 22.26 into Eq. 22.23 again and the velocity estimate of the moving vehicle v can be derived as follows:
$$v = v_{L} \cdot \left( {1 - \frac{Ar}{{Ar_{s} }}} \right) \cdot \sec \left\{ {\arctan \left[ {\tan \left( {\theta_{SA} - 90^{ \circ } } \right) \cdot \left( {\frac{{Ar_{s} }}{{Ar_{s} - Ar}} - 1} \right)} \right]} \right\}$$
(22.27)
It can be seen that the velocity of a moving vehicle can be directly estimated based on the shape deformation parameters without the need to know the intersection angle \(\theta_{v}\) a priori. \(\theta_{v}\) can be estimated as an intermediate variable solely based on two shape deformation parameters Ars, and \(\theta_{SA}\) and is independent of the sensor flight velocity vL. For accuracy analysis, two accuracy measures can be estimated, namely the moving direction and the velocity. The accuracies of the intersection angle \(\sigma_{{\theta_{v} }}\) and the velocity estimate \(\sigma_{v}\) can be derived as functions of the quality of the along-track stretching and across-track shearing measures. Equivalently, \(\sigma_{{\theta_{v} }}\) and \(\sigma_{v}\) can be calculated with respect to the two deformation parameters by the error propagation law as:
$$\begin{aligned} \sigma _{{\theta _{v} }} & = \sqrt {\left( {\frac{{\delta \theta _{v} }}{{\delta Ar_{s} }}} \right)^{2} \sigma _{{Ar_{s} }}^{2} + \left( {\frac{{\delta \theta _{v} }}{{\delta Ar_{{\theta_{SA}}} }}} \right)\sigma _{{\theta _{{SA}} }}^{2} } \\ & = \sqrt {\begin{array}{*{20}c} {\left( {\frac{{Ar \cdot \tan \left( {90^{ \circ } - \theta _{{SA}} } \right)}}{{Ar^{2} \cdot \tan \left( {90^{ \circ } - \theta _{{SA}} } \right)^{2} \, \cdot\, \left( {Ar - Ar_{s} } \right)^{2} }}} \right)^{2} \sigma _{{Ar_{s} }}^{2} } \\ { + \frac{{Ar \cdot \left( {\tan \left( {90^{ \circ } - \theta _{{SA}} } \right)^{2} + 1} \right) + \left( {Ar - Ar_{s} } \right)}}{{Ar^{2} \cdot \tan \left( {90^{ \circ } - \theta _{{SA}} } \right)^{2} + \left( {Ar - Ar_{s} } \right)^{2} }}\sigma _{{\theta _{{SA}} }}^{2} } \\ \end{array} } \\ \end{aligned}$$
(22.28)
$$\begin{aligned} \sigma _{v} & = \sqrt {\left( {\frac{{\delta v}}{{\delta Ar_{s} }}} \right)^{2} \sigma _{{Ar_{s} }}^{2} + \left( {\frac{{\delta v}}{{\delta \theta _{{SA}} }}} \right)^{2} \sigma _{{\theta _{{SA}} }}^{2} } \\ & = \sqrt {\begin{array}{*{20}c} {\left( {\frac{{Ar \cdot v_{L} \cdot \left( {Ar \cdot \tan \left( {90^{ \circ } - \theta _{{SA}} } \right)^{2} + Ar - Ar_{s} } \right)}}{{Ar_{s}^{2} \left( {Ar - Ar_{s} } \right) \cdot \sqrt {\frac{{Ar^{2} \,\tan \left( {90^{ \circ } - \theta _{{SA}} } \right)^{2} + \left( {Ar - Ar_{s} } \right)^{2} }}{{\left( {Ar - Ar_{s} } \right)^{2} }}} }}} \right)^{2} \sigma _{{Ar_{s} }}^{2} } \\ +\,{\left( {\frac{{Ar \cdot v_{L} \cdot \tan \left( {90^{ \circ } - \theta _{{SA}} } \right) \cdot \left( {\tan \left( {90^{ \circ } - \theta _{{SA}} } \right)^{2} + 1} \right)}}{{Ar^{2} \left( {Ar - Ar_{s} } \right) \cdot \sqrt {\frac{{Ar^{2} \,\tan \left( {90^{ \circ } - \theta _{{SA}} } \right)^{2} + \left( {Ar - Ar_{s} } \right)^{2} }}{{\left( {Ar - Ar_{s} } \right)^{2} }}} }}} \right)^{2} \sigma _{{\theta _{{SA}} }}^{2} } \\ \end{array} } \\ \end{aligned}$$
(22.29)
The empirical error values for two observations \(\sigma_{Ars}\) and \(\sigma _{{\theta_{{SA}} }}\) was also assessed to the same values as used in the preceding methods. The accuracies of intersection angle \(\sigma_{{\theta_{v} }}\) and velocity estimates \(\sigma_{v}\) based on the joint estimation of moving velocity and direction are derived by inserting the empirical errors for the observations into Eqs. 22.28 and 22.29. The error of intersection angle \(\sigma_{{\theta_{v} }}\) is shown in Fig. 22.7a as a function of vehicle velocity and relative angle between vehicle heading and the sensor flying path; the relative error is indicated in Fig. 22.7b. The (relative) velocity errors \(\sigma_{v}\) and \(\sigma_{v} /v\) are shown in Fig. 22.8 as a function of vehicle velocity v and intersection angle \(\theta_{v}\). It can be seen from the plots that most of the vehicles on road sections of urban areas could not allow for high accuracy of moving direction estimation (\(\sigma_{{\theta_{v} }} /\theta_{v}\) < 25%) unless they move a little bit faster (>70 km/h). The high accuracy of velocity estimates could be only guaranteed for vehicles that obviously don’t travel in an across-track direction (\(\theta_{v}\) < 75%). The overall accuracy of velocity estimation derived in this way is slightly degraded compared to other solutions where the moving direction is given beforehand.