O presente trabalho trata do desenvolvimento de um sistema de sensoriamento de orientação utilizando sensores inerciais de baixo custo, de tecnologia MicroElectroMechanical Systems, MEMS, que apresentam altas taxas de ruído. Assim, é realizada a filtragem e fusão dos dados dos sensores para obtenção de uma estimativa confiável, com a aplicação do filtro de Kalman estendido. O sistema é utilizado para a navegação e controle em um veículo aquático de superfície autônomo. No desenvolvimento do trabalho são investigados os princípios da navegação inercial, da representação da orientação e os sistemas de coordenadas envolvidos, apresentando o método por ângulos de Euler, quatérnios e DCM e o procedimento de atualização conforme a variação da orientação. O sistema desenvolvido foi testado em bancada e em um barco com formato de trimarã construído no Laboratório de Controle e Eletrônica de Potência, na Escola de Engenharia de São Carlos, mostrando os resultados dos testes realizados navegando em uma represa, obtendo resultados satisfatórios para essa aplicação. É mostrado também o comportamento dinâmico dos veículos aquáticos de superfície através do estudo da dinâmica de corpos rígidos. / This work describes the development of an orientation sensing system composed of low cost inertial sensors with MicroElectroMechanical Systems (MEMS) technology, which presents high noise levels. Thus, filtering and sensor\'s measurements fusion is done in order to achieve a reliable estimation, trough an extended Kalman filter. The system is used for navigation and control of an autonomous aquatic surface vehicle. In this work, the principles of inertial navigation, orientation representation as well as the coordinate frames involved are investigated, presenting the methods trough Euler angles, quaternions and DCM, and the update proceeding according to the orientation changes. The developed system was tested in the lab and on a trimaran shaped vessel navigating on a dam, wich was developed in the Control and Power Electronics Laboratory at the São Carlos School of Engineering, achieving satisfactory results for this application. It is also shown the dynamic behavior of the surface aquatic vehicles, using rigid-body dynamics.

Field programmable grid arrays (FPGA) are increasingly being adopted as the primary on-board computing system for autonomous deep space vehicles. There is a need to support several complex applications for navigation and image processing in a rapidly responsive on-board FPGA-based computer. This requires exploring and combining several design concepts such as systolic arrays, hardware-software partitioning, and partial dynamic reconfiguration. A microprocessor/co-processor design that can accelerate two single precision oating-point algorithms, extended Kalman lter and a discrete wavelet transform, is presented. This research makes three key contributions. (i) A polymorphic systolic array framework comprising of recofigurable partial region-based sockets to accelerate algorithms amenable to being mapped onto linear systolic arrays. When implemented on a low end Xilinx Virtex4 SX35 FPGA the design provides a speedup of at least 4.18x and 6.61x over a state of the art microprocessor used in spacecraft systems for the extended Kalman lter and discrete wavelet transform algorithms, respectively. (ii) Switchboxes to enable communication between static and partial reconfigurable regions and a simple protocol to enable schedule changes when a socket's contents are dynamically reconfigured to alter the concurrency of the participating systolic arrays. (iii) A hybrid partial dynamic reconfiguration method that combines Xilinx early access partial reconfiguration, on-chip bitstream decompression, and bitstream relocation to enable fast scaling of systolic arrays on the PolySAF. This technique provided a 2.7x improvement in reconfiguration time compared to an o-chip partial reconfiguration technique that used a Flash card on the FPGA board, and a 44% improvement in BRAM usage compared to not using compression.

<p>This thesis approaches the problem of estimating the arm angles of an industrial robot with flexibilities in joints and links. Due to cost-cutting efforts in the industrial robots industry, weaker components and more cost-effective structures have been introduced which in turn has led to problems with flexibilities, nonlinearities and friction. In order to handle these challenging dynamic problems and achieve high accuracy this study introduces state observers to estimate the tool position.The observers use measurements of the motor angles and an accelerometer and the different evaluated observers are based on an Extended Kalman Filter and a deterministic variant. They have been evaluated in experiments on an industrial robot with two degrees of freedom. The experimental verification shows that the state estimates can be highly accurate for medium frequency motions, ranging from 3-30Hz. For this interval the estimate were also robust to model inaccuracies.The estimation of low-frequency motions was relatively poor, due to problemswith drift for the accelerometer, and it also showed a significant dependence on the accuracy of the model. For industrial robots it is mainly the medium frequency motions which are hard to estimate with existing techniques and these observers therefore carries great potential for increased precision.</p>

<p><p>A permanent magnet synchronous motor is traditionally controlled from measured</p><p>values of the angular velocity and position of the rotor. However, there is a wish</p><p>from SAAB Avitronics to investigate the possibility of estimating this angular</p><p>velocity and position from the current measurements. The rotating rotor will</p><p>affect the currents in the motor’s stator depending on the rotor’s angular velocity,</p><p>and the observer estimates the angular velocity and angular position from this</p><p>effect.</p><p>There are several methods proposed in the article database IEEE Xplore to</p><p>observe this angular velocity and angular position. The methods of observation</p><p>chosen for study in this thesis are the extended Kalman filter and a phase locked</p><p>loop algorithm based on the back electro motive force augmented by an injection</p><p>method at low velocities.</p><p>The extended Kalman filter was also programmed to be run on a digital signal</p><p>processor in SAAB Avitronics’ developing hardware. The extended Kalman filter</p><p>performs well in simulations and shows promise in hardware implementation. The</p><p>algorithm for hardware implementation suffers from poor resolution in calculations</p><p>involving the covariance matrices of the Kalman filter due to the use of 16-bit</p><p>integers, yielding an observer that only functions in certain conditions.</p><p>As simulations with 32-bit integer algorithm performs well it is likely that a 32-</p><p>bit implementation of the extended Kalman filter would perform well on a motor,</p><p>making sensorless control possible in a wide range of operations.</p></p>

<p>In several projects within ABB there is a need of state and parameter estimation for nonlinear dynamic systems. One example is a project investigating optimisation of gas turbine operation. In a gas turbine there are several parameters and states which are not measured, but are crucial for the performance. Such parameters are polytropic efficiencies in compressor and turbine stages, cooling mass flows, friction coefficients and temperatures. Different methods are being tested to solve this problem of system identification or parameter estimation. This thesis describes the implementation of such a method and compares it with previously implemented identification methods. The comparison is carried out in the context of parameter estimation in gas turbine models, a dynamic load model used in power systems as well as models of other dynamic systems. Both simulated and real plant measurements are used in the study.</p>

<p>To make driving easier and safer, modern vehicles are equipped with driver support systems. Some of these systems, for example navigation or curvature warning systems, need the global position of the vehicle. To determine this position, the Global Positioning System (GPS) or a Dead Reckoning (DR) system can be used. However, these systems have often certain drawbacks. For example, DR systems suffer from error growth with time and GPS signal masking can occur. By integrating the DR position and the GPS position, the complementary characteristics of these two systems can be used advantageously. </p><p>In this thesis, low cost in-vehicle sensors (gyroscope and speedometer) are used to perform DR and the GPS receiver used has a low update frequency. The two systems are integrated with an extended Kalman filter in order to estimate a position. The evaluation of the implemented positioning algorithmshows that the system is able to give an estimated position in the horizontal plane with a relatively high update frequency and with the accuracy of the GPS receiver used. Furthermore, it is shown that the system can handle GPS signal masking for a period of time. </p><p>In order to increase the performance of a positioning system, map matching can be added. The idea with map matching is to compare the estimated trajectory of a vehicle with roads stored in a map data base, and the best match is chosen as the position of the vehicle. In this thesis, a simple off-line map matching algorithm is implemented and added to the positioning system. The evaluation shows that the algorithm is able to distinguish roads with different direction of travel from each other and handle off-road driving.</p>

<p>Knowledge about the current road slope can improve several applications in a heavy-duty vehicle such as predictive cruise control and automated gearbox control. In this thesis the possibility of estimating the road slope based on signals from a vehicles air suspension system has been studied. More specifically, the measurement consists of a pressure signal measuring the axle load, and a vertical distance sensor.</p><p>A variety of suspension systems can be mounted on a Scania truck. During this thesis, two discrete-time models based on two different rear axle air suspension systems have been proposed. The models use the effect of alternating axle load during a change in the road slope and the estimates are computed using an extended Kalman filter.</p><p>The first model is based on a rear axle suspension known as the 2-bellow system. This type of suspension is strongly affected by the driveshaft torque, which results in a behaviour where the rear end is pushed upwards and thus decreasing the rear axle load during uphill driving. A model was developed in order to compensate for this behaviour. Unfortunately, the estimates showed less promising results and all attempts to determine the error was unsuccessful.</p><p>The latter model is based on the 4-bellow system. This suspension system is not affected by the driveshaft torque and a less complex model could be derived. The experimental results indicated that road slope estimation was possible and with a fairly accurate result. However, more work is needed since the estimate is affected by road surface irregularities and since the algorithm requires knowledge about the vehicles mass and the location of the centre of gravity.</p><p>All the presented results have been estimated based on real data from a test track at Scania Technical Centre in Södertälje.</p>

<p>Today’s diesel engines are complex with systems like VGT and EGR to be able to fulfil the stricter emission legislations and the demands on the fuel consumption. Controlling a system like this demands a sophisticated control system. Furthermore, the authorities demand on self diagnosis requires an equal sophisticated diagnosis system. These systems require good knowledge about the signals present in the system and how they affect each other.</p><p>One way to achieve this is to have a good model of the system and based on this calculate an observer. The observer is then used to estimate signals used for control and diagnosis. Advantages with an observer instead of using just sensors are that the sensor signals often are noisy and need to be filtered before they can be used. This causes time delay which further complicates the control and diagnosis systems. Other advantages are that sensors are expensive and that some engine quantities are hard to measure.</p><p>In this Master’s thesis a model of a Scania diesel engine is developed and an observer is calculated. Due to the non-linearities in the model the observer is based on a constant gain extended Kalman filter.</p>

<p>A lane departure warning system relying exclusively on a camera has several shortcomings and tends to be sensitive to, e.g., bad weather and abrupt manoeuvres. To handle these situations, the system proposed in this thesis uses a dynamic model of the vehicle and integration of relative motion sensors to estimate the vehicle’s position on the road. The relative motion is measured using vision, inertial, and vehicle sensors. All these sensors types are affected by errors such as offset, drift and quantization. However the different sensors are sensitive to different types of errors, e.g., the camera system is rather poor at detecting rapid lateral movements, a type of situation which an inertial sensor practically never fails to detect. These kinds of complementary properties make sensor fusion interesting. The approach of this Master’s thesis is to use an already existing lane departure warning system as vision sensor in combination with an inertial measurement unit to produce a system that is robust and can achieve good warnings if an unintentional lane departure is about to occur. For the combination of sensor data, different sensor fusion models have been proposed and evaluated on experimental data. The models are based on a nonlinear model that is linearized so that a Kalman filter can be applied. Experiments show that the proposed solutions succeed at handling situations where a system relying solely on a camera would have problems. The results from the testing show that the original lane departure warning system, which is a single camera system, is outperformed by the suggested system.</p>

<p>Scania CV AB is a large manufacturer of heavy duty trucks that, with an increasingly stricter emission legislation, have a rising demand for an effective On Board Diagnosis (OBD) system. One idea for improving the OBD system is to employ a model for the construction of an observer based diagnosis system. The proposal in this report is, because of a nonlinear model, to use a nonlinear filtering method for improving the needed state estimates. Two nonlinear filters are tested, the Particle Filter (PF) and the Extended Kalman Filter (EKF). The primary objective is to evaluate the use of the PF for Fault Detection and Isolation (FDI), and to compare the result against the use of the EKF.</p><p>With the information provided by the PF and the EKF, two residual based diagnosis systems and two likelihood based diagnosis systems are created. The results with the PF and the EKF are evaluated for both types of systems using real measurement data. It is shown that the four systems give approximately equal results for FDI with the exception that using the PF is more computational demanding than using the EKF. There are however some indications that the PF, due to the nonlinearities, could offer more if enough CPU time is available.</p>