Kernel-based fault diagnosis of inertial sensors using analytical redundancy

Kernel methods are able to exploit high-dimensional spaces for representational advantage, while only operating implicitly in such spaces, thus incurring none of the computational cost of doing so. They appear to have the potential to advance the state of the art in control and signal processing applications and are increasingly seeing adoption across these domains. Applications of kernel methods to fault detection and isolation (FDI) have been reported, but few in aerospace research, though they offer a promising way to perform or enhance fault detection. It is mostly in process monitoring, in the chemical processing industry for example, that these techniques have found broader application. This research work explores the use of kernel-based solutions in model-based fault diagnosis for aerospace systems. Specifically, it investigates the application of these techniques to the detection and isolation of IMU/INS sensor faults – a canonical open problem in the aerospace field. Kernel PCA, a kernelised non-linear extension of the well-known principal component analysis (PCA) algorithm, is implemented to tackle IMU fault monitoring. An isolation scheme is extrapolated based on the strong duality known to exist between probably the most widely practiced method of FDI in the aerospace domain – the parity space technique – and linear principal component analysis. The algorithm, termed partial kernel PCA, benefits from the isolation properties of the parity space method as well as the non-linear approximation ability of kernel PCA. Further, a number of unscented non-linear filters for FDI are implemented, equipped with data-driven transition models based on Gaussian processes - a non-parametric Bayesian kernel method. A distributed estimation architecture is proposed, which besides fault diagnosis can contemporaneously perform sensor fusion. It also allows for decoupling faulty sensors from the navigation solution

Design, control and error analysis of a fast tool positioning system for ultra-precision machining of freeform surfaces

This thesis was previously held under moratorium from 03/12/19 to 03/12/21Freeform surfaces are widely found in advanced imaging and illumination systems, orthopaedic implants, high-power beam shaping applications, and other high-end scientific instruments. They give the designers greater ability to cope with the performance limitations commonly encountered in simple-shape designs. However, the stringent requirements for surface roughness and form accuracy of freeform components pose significant challenges for current machining techniques—especially in the optical and display market where large surfaces with tens of thousands of micro features are to be machined. Such highly wavy surfaces require the machine tool cutter to move rapidly while keeping following errors small. Manufacturing efficiency has been a bottleneck in these applications. The rapidly changing cutting forces and inertial forces also contribute a great deal to the machining errors. The difficulty in maintaining good surface quality under conditions of high operational frequency suggests the need for an error analysis approach that can predict the dynamic errors. The machining requirements also impose great challenges on machine tool design and the control process. There has been a knowledge gap on how the mechanical structural design affects the achievable positioning stability. The goal of this study was to develop a tool positioning system capable of delivering fast motion with the required positioning accuracy and stiffness for ultra-precision freeform manufacturing. This goal is achieved through deterministic structural design, detailed error analysis, and novel control algorithms. Firstly, a novel stiff-support design was proposed to eliminate the structural and bearing compliances in the structural loop. To implement the concept, a fast positioning device was developed based on a new-type flat voice coil motor. Flexure bearing, magnet track, and motor coil parameters were designed and calculated in detail. A high-performance digital controller and a power amplifier were also built to meet the servo rate requirement of the closed-loop system. A thorough understanding was established of how signals propagated within the control system, which is fundamentally important in determining the loop performance of high-speed control. A systematic error analysis approach based on a detailed model of the system was proposed and verified for the first time that could reveal how disturbances contribute to the tool positioning errors. Each source of disturbance was treated as a stochastic process, and these disturbances were synthesised in the frequency domain. The differences between following error and real positioning error were discussed and clarified. The predicted spectrum of following errors agreed with the measured spectrum across the frequency range. It is found that the following errors read from the control software underestimated the real positioning errors at low frequencies and overestimated them at high frequencies. The error analysis approach thus successfully revealed the real tool positioning errors that are mingled with sensor noise. Approaches to suppress disturbances were discussed from the perspectives of both system design and control. A deterministic controller design approach was developed to preclude the uncertainty associated with controller tuning, resulting in a control law that can minimize positioning errors. The influences of mechanical parameters such as mass, damping, and stiffness were investigated within the closed-loop framework. Under a given disturbance condition, the optimal bearing stiffness and optimal damping coefficients were found. Experimental positioning tests showed that a larger moving mass helped to combat all disturbances but sensor noise. Because of power limits, the inertia of the fast tool positioning system could not be high. A control algorithm with an additional acceleration-feedback loop was then studied to enhance the dynamic stiffness of the cutting system without any need for large inertia. An analytical model of the dynamic stiffness of the system with acceleration feedback was established. The dynamic stiffness was tested by frequency response tests as well as by intermittent diamond-turning experiments. The following errors and the form errors of the machined surfaces were compared with the estimates provided by the model. It is found that the dynamic stiffness within the acceleration sensor bandwidth was proportionally improved. The additional acceleration sensor brought a new error source into the loop, and its contribution of errors increased with a larger acceleration gain. At a certain point, the error caused by the increased acceleration gain surpassed other disturbances and started to dominate, representing the practical upper limit of the acceleration gain. Finally, the developed positioning system was used to cut some typical freeform surfaces. A surface roughness of 1.2 nm (Ra) was achieved on a NiP alloy substrate in flat cutting experiments. Freeform surfaces—including beam integrator surface, sinusoidal surface, and arbitrary freeform surface—were successfully machined with optical-grade quality. Ideas for future improvements were proposed in the end of this thesis.Freeform surfaces are widely found in advanced imaging and illumination systems, orthopaedic implants, high-power beam shaping applications, and other high-end scientific instruments. They give the designers greater ability to cope with the performance limitations commonly encountered in simple-shape designs. However, the stringent requirements for surface roughness and form accuracy of freeform components pose significant challenges for current machining techniques—especially in the optical and display market where large surfaces with tens of thousands of micro features are to be machined. Such highly wavy surfaces require the machine tool cutter to move rapidly while keeping following errors small. Manufacturing efficiency has been a bottleneck in these applications. The rapidly changing cutting forces and inertial forces also contribute a great deal to the machining errors. The difficulty in maintaining good surface quality under conditions of high operational frequency suggests the need for an error analysis approach that can predict the dynamic errors. The machining requirements also impose great challenges on machine tool design and the control process. There has been a knowledge gap on how the mechanical structural design affects the achievable positioning stability. The goal of this study was to develop a tool positioning system capable of delivering fast motion with the required positioning accuracy and stiffness for ultra-precision freeform manufacturing. This goal is achieved through deterministic structural design, detailed error analysis, and novel control algorithms. Firstly, a novel stiff-support design was proposed to eliminate the structural and bearing compliances in the structural loop. To implement the concept, a fast positioning device was developed based on a new-type flat voice coil motor. Flexure bearing, magnet track, and motor coil parameters were designed and calculated in detail. A high-performance digital controller and a power amplifier were also built to meet the servo rate requirement of the closed-loop system. A thorough understanding was established of how signals propagated within the control system, which is fundamentally important in determining the loop performance of high-speed control. A systematic error analysis approach based on a detailed model of the system was proposed and verified for the first time that could reveal how disturbances contribute to the tool positioning errors. Each source of disturbance was treated as a stochastic process, and these disturbances were synthesised in the frequency domain. The differences between following error and real positioning error were discussed and clarified. The predicted spectrum of following errors agreed with the measured spectrum across the frequency range. It is found that the following errors read from the control software underestimated the real positioning errors at low frequencies and overestimated them at high frequencies. The error analysis approach thus successfully revealed the real tool positioning errors that are mingled with sensor noise. Approaches to suppress disturbances were discussed from the perspectives of both system design and control. A deterministic controller design approach was developed to preclude the uncertainty associated with controller tuning, resulting in a control law that can minimize positioning errors. The influences of mechanical parameters such as mass, damping, and stiffness were investigated within the closed-loop framework. Under a given disturbance condition, the optimal bearing stiffness and optimal damping coefficients were found. Experimental positioning tests showed that a larger moving mass helped to combat all disturbances but sensor noise. Because of power limits, the inertia of the fast tool positioning system could not be high. A control algorithm with an additional acceleration-feedback loop was then studied to enhance the dynamic stiffness of the cutting system without any need for large inertia. An analytical model of the dynamic stiffness of the system with acceleration feedback was established. The dynamic stiffness was tested by frequency response tests as well as by intermittent diamond-turning experiments. The following errors and the form errors of the machined surfaces were compared with the estimates provided by the model. It is found that the dynamic stiffness within the acceleration sensor bandwidth was proportionally improved. The additional acceleration sensor brought a new error source into the loop, and its contribution of errors increased with a larger acceleration gain. At a certain point, the error caused by the increased acceleration gain surpassed other disturbances and started to dominate, representing the practical upper limit of the acceleration gain. Finally, the developed positioning system was used to cut some typical freeform surfaces. A surface roughness of 1.2 nm (Ra) was achieved on a NiP alloy substrate in flat cutting experiments. Freeform surfaces—including beam integrator surface, sinusoidal surface, and arbitrary freeform surface—were successfully machined with optical-grade quality. Ideas for future improvements were proposed in the end of this thesis

Bimanual robot skills: MP encoding, dimensionality reduction and reinforcement learning

In our culture, robots have been in novels and cinema for a long time, but it has been specially in the last two decades when the improvements in hardware - better computational power and components - and advances in Artificial Intelligence (AI), have allowed robots to start sharing spaces with humans. Such situations require, aside from ethical considerations, robots to be able to move with both compliance and precision, and learn at different levels, such as perception, planning, and motion, being the latter the focus of this work. The first issue addressed in this thesis is inverse kinematics for redundant robot manipulators, i.e: positioning the robot joints so as to reach a certain end-effector pose. We opt for iterative solutions based on the inversion of the kinematic Jacobian of a robot, and propose to filter and limit the gains in the spectral domain, while also unifying such approach with a continuous, multipriority scheme. Such inverse kinematics method is then used to derive manipulability in the whole workspace of an antropomorphic arm, and the coordination of two arms is subsequently optimized by finding their best relative positioning. Having solved the kinematic issues, a robot learning within a human environment needs to move compliantly, with limited amount of force, in order not to harm any humans or cause any damage, while being as precise as possible. Therefore, we developed two dynamic models for the same redundant arm we had analysed kinematically: The first based on local models with Gaussian projections, and the second characterizing the most problematic term of the dynamics, namely friction. Such models allowed us to implement feed-forward controllers, where we can actively change the weights in the compliance-precision tradeoff. Moreover, we used such models to predict external forces acting on the robot, without the use of force sensors. Afterwards, we noticed that bimanual robots must coordinate their components (or limbs) and be able to adapt to new situations with ease. Over the last decade, a number of successful applications for learning robot motion tasks have been published. However, due to the complexity of a complete system including all the required elements, most of these applications involve only simple robots with a large number of high-end technology sensors, or consist of very simple and controlled tasks. Using our previous framework for kinematics and control, we relied on two types of movement primitives to encapsulate robot motion. Such movement primitives are very suitable for using reinforcement learning. In particular, we used direct policy search, which uses the motion parametrization as the policy itself. In order to improve the learning speed in real robot applications, we generalized a policy search algorithm to give some importance to samples yielding a bad result, and we paid special attention to the dimensionality of the motion parametrization. We reduced such dimensionality with linear methods, using the rewards obtained through motion repetition and execution. We tested such framework in a bimanual task performed by two antropomorphic arms, such as the folding of garments, showing how a reduced dimensionality can provide qualitative information about robot couplings and help to speed up the learning of tasks when robot motion executions are costly.A la nostra cultura, els robots han estat presents en novel·les i cinema des de fa dècades, però ha sigut especialment en les últimes dues quan les millores en hardware (millors capacitats de còmput) i els avenços en intel·ligència artificial han permès que els robots comencin a compartir espais amb els humans. Aquestes situacions requereixen, a banda de consideracions ètiques, que els robots siguin capaços de moure's tant amb suavitat com amb precisió, i d'aprendre a diferents nivells, com són la percepció, planificació i moviment, essent l'última el centre d'atenció d'aquest treball. El primer problema adreçat en aquesta tesi és la cinemàtica inversa, i.e.: posicionar les articulacions del robot de manera que l'efector final estigui en una certa posició i orientació. Hem estudiat el camp de les solucions iteratives, basades en la inversió del Jacobià cinemàtic d'un robot, i proposem un filtre que limita els guanys en el seu domini espectral, mentre també unifiquem tal mètode dins un esquema multi-prioritat i continu. Aquest mètode per a la cinemàtica inversa és usat a l'hora d'encapsular tota la informació sobre l'espai de treball d'un braç antropomòrfic, i les capacitats de coordinació entre dos braços són optimitzades, tot trobant la seva millor posició relativa en l'espai. Havent resolt les dificultats cinemàtiques, un robot que aprèn en un entorn humà necessita moure's amb suavitat exercint unes forces limitades per tal de no causar danys, mentre es mou amb la màxima precisió possible. Per tant, hem desenvolupat dos models dinàmics per al mateix braç robòtic redundant que havíem analitzat des del punt de vista cinemàtic: El primer basat en models locals amb projeccions de Gaussianes i el segon, caracteritzant el terme més problemàtic i difícil de representar de la dinàmica, la fricció. Aquests models ens van permetre utilitzar controladors coneguts com "feed-forward", on podem canviar activament els guanys buscant l'equilibri precisió-suavitat que més convingui. A més, hem usat aquests models per a inferir les forces externes actuant en el robot, sense la necessitat de sensors de força. Més endavant, ens hem adonat que els robots bimanuals han de coordinar els seus components (braços) i ser capaços d'adaptar-se a noves situacions amb facilitat. Al llarg de l'última dècada, diverses aplicacions per aprendre tasques motores robòtiques amb èxit han estat publicades. No obstant, degut a la complexitat d'un sistema complet que inclogui tots els elements necessaris, la majoria d'aquestes aplicacions consisteixen en robots més aviat simples amb costosos sensors d'última generació, o a resoldre tasques senzilles en un entorn molt controlat. Utilitzant el nostre treball en cinemàtica i control, ens hem basat en dos tipus de primitives de moviment per caracteritzar la motricitat robòtica. Aquestes primitives de moviment són molt adequades per usar aprenentatge per reforç. En particular, hem usat la búsqueda directa de la política, un camp de l'aprenentatge per reforç que usa la parametrització del moviment com la pròpia política. Per tal de millorar la velocitat d'aprenentatge en aplicacions amb robots reals, hem generalitzat un algoritme de búsqueda directa de política per a donar importància a les mostres amb mal resultat, i hem donat especial atenció a la reducció de dimensionalitat en la parametrització dels moviments. Hem reduït la dimensionalitat amb mètodes lineals, utilitzant les recompenses obtingudes EN executar els moviments. Aquests mètodes han estat provats en tasques bimanuals com són plegar roba, usant dos braços antropomòrfics. Els resultats mostren com la reducció de dimensionalitat pot aportar informació qualitativa d'una tasca, i al mateix temps ajuda a aprendre-la més ràpid quan les execucions amb robots reals són costoses

Bimanual robot skills: MP encoding, dimensionality reduction and reinforcement learning

Aplicat embargament des de la data de defensa fins 1/7/2018Premio a la mejor Tesis Doctoral sobre Robótica, Edición 2017, atorgat pel Comité Español de Automática.Finalista del 2018 George Girault PhD Award, from EuRoboticsIn our culture, robots have been in novels and cinema for a long time, but it has been specially in the last two decades when the improvements in hardware - better computational power and components - and advances in Artificial Intelligence (AI), have allowed robots to start sharing spaces with humans. Such situations require, aside from ethical considerations, robots to be able to move with both compliance and precision, and learn at different levels, such as perception, planning, and motion, being the latter the focus of this work. The first issue addressed in this thesis is inverse kinematics for redundant robot manipulators, i.e: positioning the robot joints so as to reach a certain end-effector pose. We opt for iterative solutions based on the inversion of the kinematic Jacobian of a robot, and propose to filter and limit the gains in the spectral domain, while also unifying such approach with a continuous, multipriority scheme. Such inverse kinematics method is then used to derive manipulability in the whole workspace of an antropomorphic arm, and the coordination of two arms is subsequently optimized by finding their best relative positioning. Having solved the kinematic issues, a robot learning within a human environment needs to move compliantly, with limited amount of force, in order not to harm any humans or cause any damage, while being as precise as possible. Therefore, we developed two dynamic models for the same redundant arm we had analysed kinematically: The first based on local models with Gaussian projections, and the second characterizing the most problematic term of the dynamics, namely friction. Such models allowed us to implement feed-forward controllers, where we can actively change the weights in the compliance-precision tradeoff. Moreover, we used such models to predict external forces acting on the robot, without the use of force sensors. Afterwards, we noticed that bimanual robots must coordinate their components (or limbs) and be able to adapt to new situations with ease. Over the last decade, a number of successful applications for learning robot motion tasks have been published. However, due to the complexity of a complete system including all the required elements, most of these applications involve only simple robots with a large number of high-end technology sensors, or consist of very simple and controlled tasks. Using our previous framework for kinematics and control, we relied on two types of movement primitives to encapsulate robot motion. Such movement primitives are very suitable for using reinforcement learning. In particular, we used direct policy search, which uses the motion parametrization as the policy itself. In order to improve the learning speed in real robot applications, we generalized a policy search algorithm to give some importance to samples yielding a bad result, and we paid special attention to the dimensionality of the motion parametrization. We reduced such dimensionality with linear methods, using the rewards obtained through motion repetition and execution. We tested such framework in a bimanual task performed by two antropomorphic arms, such as the folding of garments, showing how a reduced dimensionality can provide qualitative information about robot couplings and help to speed up the learning of tasks when robot motion executions are costly.A la nostra cultura, els robots han estat presents en novel·les i cinema des de fa dècades, però ha sigut especialment en les últimes dues quan les millores en hardware (millors capacitats de còmput) i els avenços en intel·ligència artificial han permès que els robots comencin a compartir espais amb els humans. Aquestes situacions requereixen, a banda de consideracions ètiques, que els robots siguin capaços de moure's tant amb suavitat com amb precisió, i d'aprendre a diferents nivells, com són la percepció, planificació i moviment, essent l'última el centre d'atenció d'aquest treball. El primer problema adreçat en aquesta tesi és la cinemàtica inversa, i.e.: posicionar les articulacions del robot de manera que l'efector final estigui en una certa posició i orientació. Hem estudiat el camp de les solucions iteratives, basades en la inversió del Jacobià cinemàtic d'un robot, i proposem un filtre que limita els guanys en el seu domini espectral, mentre també unifiquem tal mètode dins un esquema multi-prioritat i continu. Aquest mètode per a la cinemàtica inversa és usat a l'hora d'encapsular tota la informació sobre l'espai de treball d'un braç antropomòrfic, i les capacitats de coordinació entre dos braços són optimitzades, tot trobant la seva millor posició relativa en l'espai. Havent resolt les dificultats cinemàtiques, un robot que aprèn en un entorn humà necessita moure's amb suavitat exercint unes forces limitades per tal de no causar danys, mentre es mou amb la màxima precisió possible. Per tant, hem desenvolupat dos models dinàmics per al mateix braç robòtic redundant que havíem analitzat des del punt de vista cinemàtic: El primer basat en models locals amb projeccions de Gaussianes i el segon, caracteritzant el terme més problemàtic i difícil de representar de la dinàmica, la fricció. Aquests models ens van permetre utilitzar controladors coneguts com "feed-forward", on podem canviar activament els guanys buscant l'equilibri precisió-suavitat que més convingui. A més, hem usat aquests models per a inferir les forces externes actuant en el robot, sense la necessitat de sensors de força. Més endavant, ens hem adonat que els robots bimanuals han de coordinar els seus components (braços) i ser capaços d'adaptar-se a noves situacions amb facilitat. Al llarg de l'última dècada, diverses aplicacions per aprendre tasques motores robòtiques amb èxit han estat publicades. No obstant, degut a la complexitat d'un sistema complet que inclogui tots els elements necessaris, la majoria d'aquestes aplicacions consisteixen en robots més aviat simples amb costosos sensors d'última generació, o a resoldre tasques senzilles en un entorn molt controlat. Utilitzant el nostre treball en cinemàtica i control, ens hem basat en dos tipus de primitives de moviment per caracteritzar la motricitat robòtica. Aquestes primitives de moviment són molt adequades per usar aprenentatge per reforç. En particular, hem usat la búsqueda directa de la política, un camp de l'aprenentatge per reforç que usa la parametrització del moviment com la pròpia política. Per tal de millorar la velocitat d'aprenentatge en aplicacions amb robots reals, hem generalitzat un algoritme de búsqueda directa de política per a donar importància a les mostres amb mal resultat, i hem donat especial atenció a la reducció de dimensionalitat en la parametrització dels moviments. Hem reduït la dimensionalitat amb mètodes lineals, utilitzant les recompenses obtingudes EN executar els moviments. Aquests mètodes han estat provats en tasques bimanuals com són plegar roba, usant dos braços antropomòrfics. Els resultats mostren com la reducció de dimensionalitat pot aportar informació qualitativa d'una tasca, i al mateix temps ajuda a aprendre-la més ràpid quan les execucions amb robots reals són costoses.Award-winningPostprint (published version

New Approaches in Automation and Robotics

The book New Approaches in Automation and Robotics offers in 22 chapters a collection of recent developments in automation, robotics as well as control theory. It is dedicated to researchers in science and industry, students, and practicing engineers, who wish to update and enhance their knowledge on modern methods and innovative applications. The authors and editor of this book wish to motivate people, especially under-graduate students, to get involved with the interesting field of robotics and mechatronics. We hope that the ideas and concepts presented in this book are useful for your own work and could contribute to problem solving in similar applications as well. It is clear, however, that the wide area of automation and robotics can only be highlighted at several spots but not completely covered by a single book

Identification and Optimal Linear Tracking Control of ODU Autonomous Surface Vehicle

Autonomous surface vehicles (ASVs) are being used for diverse applications of civilian and military importance such as: military reconnaissance, sea patrol, bathymetry, environmental monitoring, and oceanographic research. Currently, these unmanned tasks can accurately be accomplished by ASVs due to recent advancements in computing, sensing, and actuating systems. For this reason, researchers around the world have been taking interest in ASVs for the last decade. Due to the ever-changing surface of water and stochastic disturbances such as wind and tidal currents that greatly affect the path-following ability of ASVs, identification of an accurate model of inherently nonlinear and stochastic ASV system and then designing a viable control using that model for its planar motion is a challenging task. For planar motion control of ASV, the work done by researchers is mainly based on the theoretical modeling in which the nonlinear hydrodynamic terms are determined, while some work suggested the nonlinear control techniques and adhered to simulation results. Also, the majority of work is related to the mono- or twin-hull ASVs with a single rudder. The ODU-ASV used in present research is a twin-hull design having two DC trolling motors for path-following motion. A novel approach of time-domain open-loop observer Kalman filter identifications (OKID) and state-feedback optimal linear tracking control of ODU-ASV is presented, in which a linear state-space model of ODU-ASV is obtained from the measured input and output data. The accuracy of the identified model for ODU-ASV is confirmed by validation results of model output data reconstruction and benchmark residual analysis. Then, the OKID-identified model of the ODU-ASV is utilized to design the proposed controller for its planar motion such that a predefined cost function is minimized using state and control weighting matrices, which are determined by a multi-objective optimization genetic algorithm technique. The validation results of proposed controller using step inputs as well as sinusoidal and arc-like trajectories are presented to confirm the controller performance. Moreover, real-time water-trials were performed and their results confirm the validity of proposed controller in path-following motion of ODU-ASV

Driver behavior classification and lateral control for automobile safety systems

Advanced driver assistance systems (ADAS) have been developed to help drivers maintain stability, improve road safety, and avoid potential collision. The data acquisition equipment that can be used to measure the state and parameter information of the vehicle may not be available for a standard passenger car due to economical and technical limitations. This work focuses on developing three technologies (longitudinal tire force estimation, driver behavior classification and lateral control) using low-cost sensors that can be utilized in ADAS. For the longitudinal tire force estimation, a low cost 1Hz positioning global system (GPS) and a steering angle sensor are used as the vehicle data acquisition equipment. A nonlinear extended two-wheel vehicle dynamic model is employed. The sideslip angle and the yaw rate are estimated by discrete Kalman Filter. A time independent piecewise optimization scheme is proposed to provide time-continuous estimates of longitude tire force, which can be transferred to the throttle/brake pedal position. The proposed method can be validated by the estimation results. Driver behavior classification systems can detect unsafe driver behavior and avoid potentially dangerous situations. To realize this strategy, a machine learning classification method, Gaussian Mixture model (GMM), is applied to classify driver behavior. In this application, a low cost 1Hz GPS receiver is considered as the vehicle data acquisition equipment instead of other more costly sensors (such as steering angle sensor, throttle/brake position sensor, and etc.). Since the driving information is limited, the nonlinear extended two-wheel vehicle dynamic model is adopted to reconstruct the driver behavior. Firstly, the sideslip angle and the yaw rate are calculated since they are not available from the GPS measurements. Secondly, a piecewise optimization scheme is proposed to reproduce the steering angle and the longitudinal force. Finally, a GMM classifier is trained to identify abnormal driver behavior. The simulation results demonstrated that the proposed scenario can detect the unsafe driver behavior effectively. The lateral control system developed in this study is a look-down reference system which uses a magnetic sensor at the front bumper to measure the front lateral displacement and a GPS to measure the vehicle\u27s heading orientation. Firstly, the steering angles can be estimated by using the data provided by the front magnetic sensor and GPS. The estimation algorithm is an observer for a new extended single-track model, in which the steering angle and its derivative are viewed as two state variables. Secondly, the road curvature is determined based on the linear relationship with respect to the steering angle. Thirdly, an accurate and real-time estimation of the vehicle\u27s lateral displacements can be accomplished according to a state observer. Finally, the closed loop controller is used as a compensator for automated steering. The proposed estimation and control algorithms are validated by simulation results. The results showed that this lateral steering control system achieved a good and robust performance for vehicles following or tracking a reference path