Advanced Integration of GNSS and External Sensors for Autonomous Mobility Applications

L'abstract è presente nell'allegato / the abstract is in the attachmen

Homography-Based State Estimation for Autonomous Exploration in Unknown Environments

This thesis presents the development of vision-based state estimation algorithms to enable a quadcopter UAV to navigate and explore a previously unknown GPS denied environment. These state estimation algorithms are based on tracked Speeded-Up Robust Features (SURF) points and the homography relationship that relates the camera motion to the locations of tracked planar feature points in the image plane. An extended Kalman filter implementation is developed to perform sensor fusion using measurements from an onboard inertial measurement unit (accelerometers and rate gyros) with vision-based measurements derived from the homography relationship. Therefore, the measurement update in the filter requires the processing of images from a monocular camera to detect and track planar feature points followed by the computation of homography parameters. The state estimation algorithms are designed to be independent of GPS since GPS can be unreliable or unavailable in many operational environments of interest such as urban environments. The state estimation algorithms are implemented using simulated data from a quadcopter UAV and then tested using post processed video and IMU data from flights of an autonomous quadcopter. The homography-based state estimation algorithm was effective, but accumulates drift errors over time due to the relativistic homography measurement of position

Predictive Energy Management in Connected Vehicles: Utilizing Route Information Preview for Energy Saving

This dissertation formulates algorithms that use preview information of road terrain and traffic flow for reducing energy use and emissions of modern vehicles with conventional or hybrid powertrains. Energy crisis, long term energy deficit, and more restrictive environmental protection policies require developing more efficient and cleaner vehicle powertrain systems. An alternative to making advanced technology engines or electrifying the vehicle powertrain is utilizing ambient terrain and traffic information in the energy management of vehicles, a topic which has not been emphasized in the past. Today\u27s advances in vehicular telematics and advances in GIS (Geographic Information System), GPS (Global Positioning Systems), ITS (Intelligent Transportation Systems), V2V (Vehicle to Vehicle) communication, and VII (Vehicle Infrastructure Integration ) create more opportunities for predicting a vehicle\u27s trip information with details such as the future road grade, the distance to the destination, speed constraints imposed by the traffic flow, which all can be utilized for better vehicle energy management. Optimal or near optimal decision-making based on this available information requires optimal control methods, whose fundamental theories were well studied in the past but are not directly applicable due to the complexity of real problems and uncertainty in the available preview information. This dissertation proposes the use of optimal control theories and tools including Pontryagin minimum principle, Dynamic Programming (DP) which is a numerical realization of Bellman\u27s principle of optimality, and Model Predictive Control (MPC) in the optimization-based control of hybrid electric vehicles (HEVs), plug-in hybrid electric vehicles (PHEVs), and conventional vehicles based on preview of future route information. The dissertation includes three parts introduced as follows: First, the energy saving benefit in HEV energy management by previewing future terrain information and applying optimal control methods is explored. The potential gain in fuel economy is evaluated, if road grade information is integrated in energy management of hybrid vehicles. Real-world road geometry information is taken into account in power management decisions by using both Dynamic Programming (DP) and a standard Equivalent Consumption Minimization Strategy (ECMS), derived using Pontryagin minimum principle. Secondly, the contribution of different levels of preview to energy management of plug-in hybrid vehicles (PHEVs) is studied. The gains to fuel economy of plug-in hybrid vehicles with availability of velocity and terrain preview and knowledge of distance to the next charging station are investigated. Access to future driving information is classified into full, partial, or no future information and energy management strategies for real-time implementation with partial future preview are proposed. ECMS as well as Dynamic Programming (DP) is systematically utilized to handle the resulting optimal control problems with different levels of preview. We also study the benefit of future traffic flow information preview in improving the fuel economy of conventional vehicles by predictive control methods. According to the time-scale of the preview information and its importance to the driver, the energy optimization problem is decomposed into different levels. In the microscopic level, a model predictive controller as well as a car following model is employed for predictive adaptive cruise control by stochastically forecasting the driving behavior of the lead car. In the macroscopic level, we propose to incorporate the estimated macroscopic future traffic flow information and optimize the cost-to-go by utilizing a two-dimension Dynamic Programming (2D-DP). The algorithm yields the optimal trip velocity as the reference velocity for the driver or a low level controller to follow. Through the study, we show that energy use and emissions can be reduced considerably by using preview route information. The methodologies discussed in this dissertation provide an alternative mean for the automotive industry to develop more efficient and environmentally friendly vehicles by relying mostly on software and information and with minimal hardware investments

Cooperative Perception for Social Driving in Connected Vehicle Traffic

The development of autonomous vehicle technology has moved to the center of automotive research in recent decades. In the foreseeable future, road vehicles at all levels of automation and connectivity will be required to operate safely in a hybrid traffic where human operated vehicles (HOVs) and fully and semi-autonomous vehicles (AVs) coexist. Having an accurate and reliable perception of the road is an important requirement for achieving this objective. This dissertation addresses some of the associated challenges via developing a human-like social driver model and devising a decentralized cooperative perception framework. A human-like driver model can aid the development of AVs by building an understanding of interactions among human drivers and AVs in a hybrid traffic, therefore facilitating an efficient and safe integration. The presented social driver model categorizes and defines the driver\u27s psychological decision factors in mathematical representations (target force, object force, and lane force). A model predictive control (MPC) is then employed for the motion planning by evaluating the prevailing social forces and considering the kinematics of the controlled vehicle as well as other operating constraints to ensure a safe maneuver in a way that mimics the predictive nature of the human driver\u27s decision making process. A hierarchical model predictive control structure is also proposed, where an additional upper level controller aggregates the social forces over a longer prediction horizon upon the availability of an extended perception of the upcoming traffic via vehicular networking. Based on the prediction of the upper level controller, a sequence of reference lanes is passed to a lower level controller to track while avoiding local obstacles. This hierarchical scheme helps reduce unnecessary lane changes resulting in smoother maneuvers. The dynamic vehicular communication environment requires a robust framework that must consistently evaluate and exploit the set of communicated information for the purpose of improving the perception of a participating vehicle beyond the limitations. This dissertation presents a decentralized cooperative perception framework that considers uncertainties in traffic measurements and allows scalability (for various settings of traffic density, participation rate, etc.). The framework utilizes a Bhattacharyya distance filter (BDF) for data association and a fast covariance intersection fusion scheme (FCI) for the data fusion processes. The conservatism of the covariance intersection fusion scheme is investigated in comparison to the traditional Kalman filter (KF), and two different fusion architectures: sensor-to-sensor and sensor-to-system track fusion are evaluated. The performance of the overall proposed framework is demonstrated via Monte Carlo simulations with a set of empirical communications models and traffic microsimulations where each connected vehicle asynchronously broadcasts its local perception consisting of estimates of the motion states of self and neighboring vehicles along with the corresponding uncertainty measures of the estimates. The evaluated framework includes a vehicle-to-vehicle (V2V) communication model that considers intermittent communications as well as a model that takes into account dynamic changes in an individual vehicle’s sensors’ FoV in accordance with the prevailing traffic conditions. The results show the presence of optimality in participation rate, where increasing participation rate beyond a certain level adversely affects the delay in packet delivery and the computational complexity in data association and fusion processes increase without a significant improvement in the achieved accuracy via the cooperative perception. In a highly dense traffic environment, the vehicular network can often be congested leading to limited bandwidth availability at high participation rates of the connected vehicles in the cooperative perception scheme. To alleviate the bandwidth utilization issues, an information-value discriminating networking scheme is proposed, where each sender broadcasts selectively chosen perception data based on the novelty-value of information. The potential benefits of these approaches include, but are not limited to, the reduction of bandwidth bottle-necking and the minimization of the computational cost of data association and fusion post processing of the shared perception data at receiving nodes. It is argued that the proposed information-value discriminating communication scheme can alleviate these adverse effects without sacrificing the fidelity of the perception

Theoretical framework for In-Car Navigation based on Integrated GPS/IMU Technologies

In this report the problem of vehicular navigation based on the integration of the global positioning system and an inertial navigation system is tackled. After analysing some fundamental technical issues about reference systems, vehicle modelling and sensors, a novel solution, combining extended Kalman filtering with particle filltering, is developed. This solution allows to embed highly non-linear constraints originating from digital maps in the position estimation process and is expected to be implementable on commercial hardware platforms equipped with low cost inertial sensorsJRC.G.6-Digital Citizen Securit

Generic Multisensor Integration Strategy and Innovative Error Analysis for Integrated Navigation

A modern multisensor integrated navigation system applied in most of civilian applications typically consists of GNSS (Global Navigation Satellite System) receivers, IMUs (Inertial Measurement Unit), and/or other sensors, e.g., odometers and cameras. With the increasing availabilities of low-cost sensors, more research and development activities aim to build a cost-effective system without sacrificing navigational performance. Three principal contributions of this dissertation are as follows: i) A multisensor kinematic positioning and navigation system built on Linux Operating System (OS) with Real Time Application Interface (RTAI), York University Multisensor Integrated System (YUMIS), was designed and realized to integrate GNSS receivers, IMUs, and cameras. YUMIS sets a good example of a low-cost yet high-performance multisensor inertial navigation system and lays the ground work in a practical and economic way for the personnel training in following academic researches. ii) A generic multisensor integration strategy (GMIS) was proposed, which features a) the core system model is developed upon the kinematics of a rigid body; b) all sensor measurements are taken as raw measurement in Kalman filter without differentiation. The essential competitive advantages of GMIS over the conventional error-state based strategies are: 1) the influences of the IMU measurement noises on the final navigation solutions are effectively mitigated because of the increased measurement redundancy upon the angular rate and acceleration of a rigid body; 2) The state and measurement vectors in the estimator with GMIS can be easily expanded to fuse multiple inertial sensors and all other types of measurements, e.g., delta positions; 3) one can directly perform error analysis upon both raw sensor data (measurement noise analysis) and virtual zero-mean process noise measurements (process noise analysis) through the corresponding measurement residuals of the individual measurements and the process noise measurements. iii) The a posteriori variance component estimation (VCE) was innovatively accomplished as an advanced analytical tool in the extended Kalman Filter employed by the GMIS, which makes possible the error analysis of the raw IMU measurements for the very first time, together with the individual independent components in the process noise vector

The novel application of optimization and charge blended energy management control for component downsizing within a plug-in hybrid electric vehicle

The adoption of Plug-in Hybrid Electric Vehicles (PHEVs) is widely seen as an interim solution for the decarbonization of the transport sector. Within a PHEV, determining the required energy storage capacity of the battery remains one of the primary concerns for vehicle manufacturers and system integrators. This fact is particularly pertinent since the battery constitutes the largest contributor to vehicle mass. Furthermore, the financial cost associated with the procurement, design and integration of battery systems is often cited as one of the main barriers to vehicle commercialization. The ability to integrate the optimization of the energy management control system with the sizing of key PHEV powertrain components presents a significant area of research. Contained within this paper is an optimization study in which a charge blended strategy is used to facilitate the downsizing of the electrical machine, the internal combustion engine and the high voltage battery. An improved Equivalent Consumption Method has been used to manage the optimal power split within the powertrain as the PHEV traverses a range of different drivecycles. For a target CO2 value and drivecycle, results show that this approach can yield significant downsizing opportunities, with cost reductions on the order of 2%–9% being realizable