Abstract-Highly assisted and Autonomous Driving is dependent on the accurate localization of both the vehicle and other targets within the environment. With increasing traffic on roads and wider proliferation of low cost sensors, a vehicleinfrastructure cooperative localization scenario can provide improved performance over traditional mono-platform localization. The paper highlights the various challenges in the process and proposes a solution based on Factor Graphs which utilizes the concept of topology of vehicles. A Factor Graph represents probabilistic graphical model as a bipartite graph. It is used to add the inter-vehicle distance as constraints while localizing the vehicle. The proposed solution is easily scalable for many vehicles without increasing the execution complexity. Finally simulation indicates that incorporating the topology information as a state estimate can improve performance over the traditional Kalman Filter approach.
Precise localization is a key requirement for the success of highly assisted or autonomous vehicles. The diminishing cost of hardware has resulted in a proliferation of the number of sensors in the environment. Cooperative localization (CL) presents itself as a feasible and effective solution for localizing the ego-vehicle and its neighboring vehicles. However, one of the major challenges to fully realize the effective use of infrastructure sensors for jointly estimating the state of a vehicle in cooperative vehicle-infrastructure localization is an effective data association. In this paper, we propose a method which implements symmetric measurement equations within factor graphs in order to overcome the data association challenge with a reduced bandwidth overhead. Simulated results demonstrate the benefits of the proposed approach in comparison with our previously proposed approach of topology factors.
Abstract-Autonomous vehicles operating in dynamic environments rely on precise localization. In this paper we present a novel approach for cooperative localization of vehicular systems and an infrastructure RADAR which is resilient against outliers generated from the RADAR. The problem of cooperative localization is represented as a factor graph, where interrelated topologies (including that of outliers) are added as constraint factor between vehicle states. Corresponding probabilities for multiple topologies between states of the two vehicles are calculated using the Probability Data Association Filter and assigned to the respective edges in the graph. Simulation results indicate that this technique has significant benefits in the context of improving the resilience against outliers while optimizing joint state estimates. The methodology presented in this paper has the potential to provide a robust and flexible framework for cooperative localization in the presence of clutter, obscuration and targets entering and leaving the field of view.
scite is a Brooklyn-based organization that helps researchers better discover and understand research articles through Smart Citations–citations that display the context of the citation and describe whether the article provides supporting or contrasting evidence. scite is used by students and researchers from around the world and is funded in part by the National Science Foundation and the National Institute on Drug Abuse of the National Institutes of Health.