Vehicle Position Estimation Research Articles

Extracting terrain elevation information in front of the vehicle based on vehicle-mounted LiDAR in dynamic environments

Abstract Point cloud maps constructed using 3D LiDAR, are widely used for robot navigation and localization. Few studies have utilized point cloud maps to extract terrain elevationinformation in front of a vehicle, which can be used as active suspension inputs to reduce vehicle bumps. In addition, the trajectories of dynamic objects in point cloud maps and global navigation satellite system (GNSS) data loss can affect the extraction of elevation information. To solve these problems, this paper proposes a framework for extracting terrain elevation information in front of the vehicle based on vehicle-mounted LiDAR in dynamic environments. The framework consists of two modules: point cloud map construction and vehicle front terrain elevation information extraction. In the point cloud map construction module, a system for simultaneous localization and mapping (SLAM) is proposed, which is capable of building point cloud maps without GNSS. Furthermore, a dynamic descriptor-based dynamic object filtering algorithm is proposed which is applied to SLAM. Therefore, the SLAM system overcomes the influence of dynamic objects on vehicle position and attitude estimation, and there are no trajectories of dynamic objects in the point cloud maps built by the system. In the vehicle front terrain elevation information extraction module, the unscented Kalman filter is utilized to predict the vehicle position at the next moment. Based on the geometric features of the tire-ground contact area, the terrain elevation information of the tire contact area at the predicted position on the point cloud map is extracted. Experiments show that the algorithm in this paper overcomes the effect of dynamic objects and builds a vehicle point cloud map without dynamic objects under GNSS data loss, which improves the accuracy of the extraction of terrain elevation information in front of the vehicle.

Raspberry Pi Based Real Time Lane, Obstacle and Traffic Signal Detection System

The project proposes a Raspberry Pi-based system for real-time detection of lanes, obstacles, and traffic signals to improve road safety and assist drivers. The system uses computer vision algorithms and sensor data to provide situational awareness for vehicles. The lane detection module uses image processing to identify lane markings and estimate vehicle position, while the obstacle detection module uses visual and distance sensors to identify obstacles in the vehicle’s path. The traffic signal detection module uses image processing to identify and interpret traffic signals, helping drivers adhere to traffic regulations. The integration of these modules on a Raspberry Pi platform allows for compact deployment within vehicles, ensuring timely response to dynamic road conditions. This project offers a promising solution for intelligent transportation systems aimed at reducing accidents and improving traffic flow in urban environments. Key Words: Spotting,hough transform,obstascle detection,rasp cam,traffic signal detection,lane.

Reliable urban vehicle localization under faulty satellite navigation signals

Reliable urban navigation using global navigation satellite system requires accurately estimating vehicle position despite measurement faults and monitoring the trustworthiness (or integrity) of the estimated location. However, reflected signals in urban areas introduce biases (or faults) in multiple measurements, while blocked signals reduce the number of available measurements, hindering robust localization and integrity monitoring. This paper presents a novel particle filter framework to address these challenges. First, a Bayesian fault-robust optimization task, formulated through a Gaussian mixture model (GMM) measurement likelihood, is integrated into the particle filter to mitigate faults in multiple measurement for enhanced positioning accuracy. Building on this, a novel test statistic leveraging the particle filter distribution and the GMM likelihood is devised to monitor the integrity of the localization by detecting errors exceeding a safe threshold. The performance of the proposed framework is demonstrated on real-world and simulated urban driving data. Our localization algorithm consistently achieves smaller positioning errors compared to existing filters under multiple faults. Furthermore, the proposed integrity monitor exhibits fewer missed and false alarms in detecting unsafe large localization errors.

Predicting Vehicle Pose in Six Degrees of Freedom from Single Image in Real-World Traffic Environments Using Deep Pretrained Convolutional Networks and Modified Centernet

Abstract The study focuses on intelligent driving, emphasizing the importance of recognizing nearby vehicles and estimating their positions using visual input from a single image. It employs transfer learning techniques, integrating deep convolutional networks’ features into a modified CenterNet model for six-degrees-of-freedom (6DoF) vehicle position estimation. To address the vanishing gradient problem, the model incorporates simultaneous double convolutional blocks with skip connections. Utilizing the ApolloCar3D dataset, which surpasses KITTI in comprehensiveness, the study evaluates pretrained models’ performance using mean average precision (mAP). The recommended model, Center-DenseNet201, achieves a mAP of 11.82% for relative translation thresholds (A3DP-Rel) and 39.92% for absolute translation thresholds (A3DP-Abs). These findings highlight the effectiveness of pretrained models in the modified architecture, enhancing vehicle posture prediction accuracy from single images. The research contributes to autonomous vehicle development, fostering safer and more efficient navigation systems in real-world traffic scenarios.

Optimal vehicle position estimation using adaptive unscented Kalman filter based on sensor fusion

Precise position recognition systems are actively used in various automotive technology fields such as autonomous vehicles, intelligent transportation systems, and vehicle driving safety systems. In line with this demand, this paper proposes a new vehicle position estimation algorithm based on sensor fusion between low-cost standalone global positioning system (GPS) and inertial measurement unit (IMU) sensors. In order to estimate accurate vehicle position information using two complementary sensor types, adaptive unscented Kalman filter (AUKF), an optimal state estimation algorithm, is applied to the vehicle kinematic model. Since this AUKF includes an adaptive covariance matrix whose value changes under GPS outage conditions, it has high estimation robustness even if the accuracy of the GPS measurement signal is low. Through comparison of estimation errors with both extended Kalman filter (EKF) and UKF, which are widely used state estimation algorithms, it can be confirmed how improved the estimation performance of the proposed AUKF algorithm in real-vehicle experiments is. The given test course includes roads of various shapes as well as GPS outage sections, so it is suitable for evaluating vehicle position estimation performance.

A Fusion Strategy for Vehicle Positioning at Intersections Utilizing UWB and Onboard Sensors.

For vehicle positioning applications in Intelligent Transportation Systems (ITS), lane-level or even more precise localization is desired in some typical urban scenarios. With the rapid development of wireless positioning technologies, ultrawide bandwidth (UWB) has stood out and become a prominent approach for high-precision positioning. However, in traffic scenarios, the UWB-based positioning method may deteriorate because of not-line-of-sight (NLOS) propagation, multipath effect and other external interference. To overcome these problems, in this paper, a fusion strategy utilizing UWB and onboard sensors is developed to achieve reliable and precise vehicle positioning. It is a two-step approach, which includes the preprocessing of UWB raw measurements and the global estimation of vehicle position. Firstly, an ARIMA-GARCH model to address the NLOS problem of UWB at vehicular traffic scenarios is developed, and then the NLOS of UWB can be detected and corrected efficiently. Further, an adaptive IMM algorithm is developed to realize global fusion. Compared with traditional IMM, the proposed AIMM is capable of adjusting the model probabilities to make them better matching for current driving conditions, then positioning accuracy can be improved. Finally, the method is validated through experiments. Field test results verify the effectiveness and feasibility of the proposed strategy.

A Highway In-Transit Vehicle Position Estimation Method Considering Road Characteristics and Short-Term Driving Style

A Highway In-Transit Vehicle Position Estimation Method Considering Road Characteristics and Short-Term Driving Style

Robust Sparse Recovery Based Vehicles Location Estimation in Intelligent Transportation System

An architecture for vehicle position estimation is introduced in this paper to tackle the issue of vehicles positioning in traffic congestion of intelligent transportation system (ITS). The introduced architecture is related to three unmanned aerial vehicles (UAVs) equipped with uniform linear array (ULA), ITS center and the terminal of position estimation, in which the UAV collect data from the ULA, the ITS center store data and the terminal is responsible for executing the corresponding direction of arrival (DOA) estimation algorithm to estimate the vehicle position. In the introduced architecture, DOA estimation is the crucial issue, hence a robust sparse recovery framework based on the optimal weighted subspace fitting is put forward for DOA estimation in the presence of direction-dependent unknown mutual coupling. Firstly, a data model can be obtained by a new transformation approach. Then, a sparse recovery algorithm based on the weighted subspace fitting is used to estimate the desired DOAs. The proposed DOA estimation algorithm can achieve superior performance in both coherent and incoherent signals in the environment of direction-dependent mutual coupling, and this environment often occurs in traffic congestion. Based on the DOA estimation results obtained from the proposed efficient regularized sparse recovery algorithm, the position of vehicles is final estimated by a weighted three-points cross-positioning method. The results of various simulation experiments fully demonstrate the robustness and superiority of the proposed architecture and algorithm.

Improved modeling and fast in-field calibration of optical flow sensor for unmanned aerial vehicle position estimation

To better reveal the principle of off-the-shelf OFS that used for UAV position estimation, two measurement models are derived, namely the continuous-time and discrete-time models. Then the intrinsic equivalence of these two models is also proven. Based on these two models, a calibration method for OFS is introduced, which only makes use of in-situ rotation to determine the OFS’s parameters including its focal length and installation angles with respect to the UAV. Furthermore, an OFS-based UAV position estimation algorithm is presented, which stems from the proposed discrete-time model. The proposed OFS models, calibration method, and position estimation algorithm form a full solution for UAV displacement measurement via OFS, and its feasibility and effectiveness is verified through flight tests on a quadcopter UAV in outdoor environment.

Vehicle Speed and Position Estimation considering Microscopic Heterogeneous Car-Following Characteristics in Connected Vehicle Environments

This paper proposes a method for estimating the speed and position of unsampled vehicles using sampled data from connected automated vehicles (CAVs). The determination of vehicle speed and position on the road is a challenging and crucial task, as they can effectively reflect traffic flow characteristics and contribute to traffic state estimation and intersection signal timing optimization. Connected automated vehicles have the capability to upload their own trajectory data while also capturing trajectory data of surrounding vehicles through onboard sensors. Therefore, this paper proposes a novel approach to estimate the speed and position of unsampled vehicles. Firstly, using real vehicle trajectory data, the correlation between the velocity of following vehicles and the velocity of leading vehicles under different densities is analyzed, leading to the development of a velocity estimation model incorporating a speed correction factor. Secondly, the correlation between time headway, the rate of change of following vehicle acceleration, and traffic density is examined. To address the issue of heterogeneous behavior in vehicle following described by the Intelligent Driver Model (IDM), a real-time optimization model for estimating vehicle position by optimizing IDM parameters is proposed. The velocity estimation model and the position estimation model are summarized as two nonlinear optimization problems. Finally, the proposed method is validated using actual vehicle trajectory data. Experimental results demonstrate that when the number of connected automated vehicles (CAVs) is 2, the proposed method reduces the average absolute error by 30.73% and the standard deviation of the average absolute error by 42.8% compared to a linear model-based speed estimation method under different density conditions. Compared to a method that estimates vehicle position by calibrating desired gaps, the proposed method reduces the average absolute error by 38.2% and the standard deviation of the average absolute error by 41.7% under different density conditions. Furthermore, the proposed method exhibits good practicality under different CAV penetration rates.

An over-the-horizon potential safety threat vehicle identification method based on ETC big data

Smart cars rely on sensors like LIDAR and high-precision map-based perception for driving environment sensing. However, they can't detect low-speed vehicles beyond visual range, affecting safety and comfort. Manual vehicles face similar challenges. Low-speed driving contributes to expressway accidents due to limited visibility, road design, and equipment performance. To enhance safety, an over-the-horizon potential safety threat vehicle identification method using ETC big data is proposed. It consists of three layers. The first layer is the vehicle section travel speed sensing layer based on the wlp-XGBoost algorithm. The second layer is the in-transit vehicle position estimation layer based on the DR-HMM algorithm. The third layer is the Multi-information fusion of potential safety threat vehicle identification layer. Dynamic real-time detection and identification of potential safety threats in expressway sections were achieved, and simulations were conducted using real-time ETC data from Quanxia section on an ETC platform. Results show accurate prediction of vehicle speed and position in different road sections and traffic situations, with over 95% accuracy and recall in identifying potential safety threat vehicles. It perceives changes in the traffic conditions of road sections in real-time based on the changing trend of potential safety threat vehicle numbers, providing a vital reference for speed planning and risk avoidance.

Road-Network-Map-Assisted Vehicle Positioning Based on Pose Graph Optimization.

Satellite signals are easily lost in urban areas, which causes difficulty in vehicles being located with high precision. Visual odometry has been increasingly applied in navigation systems to solve this problem. However, visual odometry relies on dead-reckoning technology, where a slight positioning error can accumulate over time, resulting in a catastrophic positioning error. Thus, this paper proposes a road-network-map-assisted vehicle positioning method based on the theory of pose graph optimization. This method takes the dead-reckoning result of visual odometry as the input and introduces constraints from the point-line form road network map to suppress the accumulated error and improve vehicle positioning accuracy. We design an optimization and prediction model, and the original trajectory of visual odometry is optimized to obtain the corrected trajectory by introducing constraints from map correction points. The vehicle positioning result at the next moment is predicted based on the latest output of the visual odometry and corrected trajectory. The experiments carried out on the KITTI and campus datasets demonstrate the superiority of the proposed method, which can provide stable and accurate vehicle position estimation in real-time, and has higher positioning accuracy than similar map-assisted methods.

Radar sensor based machine learning approach for precise vehicle position estimation

Estimating vehicles’ position precisely is essential in Vehicular Adhoc Networks (VANETs) for their safe, autonomous, and reliable operation. The conventional approaches used for vehicles’ position estimation, like Global Positioning System (GPS) and Global Navigation Satellite System (GNSS), pose significant data delays and data transmission errors, which render them ineffective in achieving precision in vehicles’ position estimation, especially under dynamic environments. Moreover, the existing radar-based approaches proposed for position estimation utilize the static values of range and azimuth, which make them inefficient in highly dynamic environments. In this paper, we propose a radar-based relative vehicle positioning estimation method. In the proposed method, the dynamic range and azimuth of a Frequency Modulated Continuous Wave radar is utilized to precisely estimate a vehicle’s position. In the position estimation process, the speed of the vehicle equipped with the radar sensor, called the reference vehicle, is considered such that a change in the vehicle’s speed changes the range and azimuth of the radar sensor. For relative position estimation, the distance and relative speed between the reference vehicle and a nearby vehicle are used. To this end, only those vehicles are considered that have a higher possibility of coming in contact with the reference vehicle. The data recorded by the radar sensor is subsequently utilized to calculate the precision and intersection Over Union (IOU) values. You Only Look Once (YOLO) version 4 is utilized to calculate precision and IOU values from the data captured using the radar sensor. The performance is evaluated under various real-time traffic scenarios in a MATLAB-based simulator. Results show that our proposed method achieves 80.0% precision in position estimation and obtains an IOU value up to 87.14%, thereby outperforming the state-of-the-art.

Augmentation for unmanned aerial vehicle position estimation using MARG and optical flow sensors

The optical flow sensor can detect the movement of the unmanned aerial vehicle (UAV) on the ground; thus, it is widely used for UAV flight control. The commonly used pinhole model of optical flow sensor describes the optical flow measurement in linear and angular velocities. It is not suitable in the case of discrete-time processing. A novel measurement model for the optical flow sensor is proposed, which directly gives the relationship between the optical flow and the UAV’s translational/angular motions in each sampling period. A data fusion scheme based on cubature transform is also presented, which can augment UAV’s position estimation using optical flow data. The proposed method is proven to be effective through flight tests on UAVs.

Finite-Horizon URTSS-Based Position Estimation for Urban Vehicle Localization

Vehicles in urban areas are facing the problem of lacking Global Positioning System (GPS) signals in the urban canyon environments. In this article, we present a finite-horizon Unscented Rauch-Tung-Striebel Smoother (URTSS)-based position estimation method for urban vehicle localization, which uses information from past, present, and near-future. To estimate vehicle pose, a nonlinear constant velocity state-space model is established. Sensors can only obtain immediate information, and we describe the near-future information obtained via predetermined paths using “pseudomeasurements.” The noise characteristics of pseudomeasurements are subsequently modeled and analyzed based on the fact that the uncertainty of pseudomeasurements increases over time. Using the URTSS, we design a finite-horizon estimator to achieve the fusion of past, present, and near-future information, which can perfectly yield a vehicle position estimation. Numerical simulation and road experiments are conducted to show that the proposed scheme is able to provide accurate position estimation in finite horizon when GPS signals are temporarily lost.

An optimised extreme learning machine (OELM) for simultaneous localisation and mapping in autonomous vehicles

Autonomous robots can navigate unexpected situations without human involvement. Multiple sensors for object recognition and mapping are used in autonomous driving, factory automation, and security service robots. Advances in motion planning allow autonomous cars to map their position and orientation. Vehicle position estimates may be off. SLAM algorithms map an unfamiliar environment and estimate a vehicle's position. We present a grey wolf optimised extreme learning machine (OELM) approach to leverage deep learning networks. It can build an environment map independently and help the system navigate autonomously. First, a CNN-GRU hybrid model for training Stereo and IMU sensor data is provided. ELM is then optimised for SLAM. The proposed method minimises posture estimate error for autonomous vehicles. Our method captures autonomous driving scenarios using KITTI data. IMU and stereo images collect data. Comparing the computed path to ground truth poses enhances accuracy and decreases error. Improved ELM has lower RMSE than prior SLAM. Data show that OELM-SLAM is more accurate than ELM.

An Integrated UWB-IMU-Vision Framework for Autonomous Approaching and Landing of UAVs

Unmanned Aerial Vehicles (UAVs) autonomous approaching and landing on mobile platforms always play an important role in various application scenarios. Such a complicated autonomous task requires an integrated multi-sensor system to guarantee environmental adaptability in contrast to using each sensor individually. Multi-sensor fusion perception demonstrates great feasibility to compensate for adverse visual events, undesired vibrations of inertia sensors, and satellite positioning loss. In this paper, a UAV autonomous landing scheme based on multi-sensor fusion is proposed. In particular, Ultra Wide-Band (UWB) sensor, Inertial Measurement Unit (IMU), and vision feedback are integrated to guide the UAV to approach and land on a moving object. In the approaching stage, a UWB-IMU-based sensor fusion algorithm is proposed to provide relative position estimation of vehicles with real time and high consistency. Such a sensor integration addresses the open challenge of inaccurate satellite positioning when the UAV is near the ground. It can also be extended to satellite-denied environmental applications. When the landing platform is detected by the onboard camera, the UAV performs autonomous landing. In the landing stage, the vision sensor is involved. With the visual feedback, a deep-learning-based detector and local pose estimator are enabled when the UAV approaches the landing platform. To validate the feasibility of the proposed autonomous landing scheme, both simulation and real-world experiments in extensive scenes are performed. As a result, the proposed landing scheme can land successfully with adequate accuracy in most common scenarios.

A New Method of Vehicle Positioning Using Bumps and Road Surface Defects

This paper presents the first usage of road surface defects as a means of vehicle position detection. Whilst several applications are possible, this work focuses on use in Formula E racing, where several driver information systems depend heavily upon accurate vehicle position estimation, including energy management advice and split time information, and where use of common positioning systems such as GPS is forbidden. Teams currently estimate the position on track by integrating vehicle speed, but this is susceptible to error accumulation throughout a lap, diminishing the precision and value of driver information systems. This work presents a method to improve the vehicle’s position estimate by detecting bumps in the road surface using suspension damper displacement data, an approach which is novel because it is independent of common positioning techniques such as GPS. These bumps are used as positionally-fixed checkpoints around the track, allowing the positional estimate to be regularly corrected, mitigating drift in the original estimated position. Results of the bump detection algorithm developed show for the first time that this technique can pinpoint the vehicle position with a precision of 1.41m standard deviation, with scope for further improvement. This result is significant for positioning surface vehicles where other more standard techniques are precluded. In the Formula E application the approach is found to improve the precision (consistency) of the vehicle positional estimate for large parts of the circuit, which will allow higher quality and more reliable information to be given to the driver, thereby giving a competitive advantage.

Low-Cost Attitude Estimation Using GPS/IMU Fusion Aided by Land Vehicle Model Constraints and Gravity-Based Angles

This paper details a method to improve accuracy of the land vehicle attitude estimation. It employs the vehicle model constraints to enhance the integration of GPS and a low-cost MEMS inertial measurement unit (MIMU) (GPS/MIMU). To improve the yaw angle estimation, we propose a lateral velocity constraint (LVC) aided method based on the observability analysis for the integrated fusion system. The theoretical analysis indicates that the yaw angle will be directly observed if LVC is augmented into the GPS/MIMU fusion algorithm. Furthermore, for LVC/MIMU system without GPS, the roll angle is always well estimated regardless of whether the vehicle is moving or stationary, and, surprisingly, the pitch angle can also be relatively accurately estimated if the vehicle is moving. Thus, when GPS is unavailable, the LVC/MIMU fusion is proposed by replacing the GPS measurement with the virtual measurement LVC. It is an encouraging improvement since the accumulating errors induced by gyro bias can be suppressed using MIMU alone. Moreover, to overcome the shortage that the pitch angle is not observed if the vehicle is stationary, we propose to fuse the gyros with gravity-based angles by Kalman filtering if the vehicle is detected motionless based on a switching rule. The experimental results compare favorably to theoretical analysis, showing that the proposed method can effectively improve the accuracy for land vehicle attitude estimation.

Position control for an autonomous underwater vehicle under noisy conditions

Position tracking of an autonomous underwater vehicle is not trivial as its accuracy is affected by process noise, measurement noise, and uncertain hydrodynamic parameters. Thus, in this article, we studied the position control of an autonomous underwater vehicle that operates under largely unbounded system uncertainties and large noise levels and proposed a method that reduces the interference and thereby enhances the overall autonomous underwater vehicle position estimation. Our technique extended the ensemble Kalman filter by combining it with a time-delay estimator to compensate against extended uncertainty of the system dynamics which cannot be solved by the traditional ensemble Kalman filter. Our synthetic simulations demonstrated the effectiveness of the proposed controller, highlighting its appealing position-control accuracy under simultaneous noise and uncertain hydrodynamics parameters. In addition, our simulation results showed that the proposed controller outperforms the conventional time-delay controller by a percentage range of approximately 30.8%–92.6% in terms of root-mean-square error and requires on average less than 88.2% calculation time than the conventional model predictive control.