Today, a rapid development towards fuel efficient technological aids for vehicles is in progress. One step towards this is the development of platooning systems. The main concept of platooning is to let several heavy duty vehicles (HDVs) drive in a convoy and share important information with each other via wireless communication. This thesis describes one out of three subsystems in a project developed to handle the process from raw sensor data to control signal. The goal of the project is to achieve a safe and smooth control with the main purpose of reduced fuel consumption. This subsystem processes the raw sensor data received from the different HDVs. The purpose is to estimate the positions and velocities of the vehicles in a platoon, taking into account that packet-loss, out of sequence measurements and irrelevant information can occur. This is achieved by filtering the information from different sensors in an Extended Kalman Filter and converting it into a local coordinate system with the origin in the ego vehicle. Moreover, the estimates are sorted and categorized into classes with respect to the status of the vehicles. The result of the thesis is useful estimates that are independent of outer effects in a local reference system with origin in the host vehicle. This information can then be used for further sensor fusion and implementation of a Model Predictive Controller (MPC) in two other subsystems. These three subsystems result in a smooth and safe control with an average reduced fuel consumption of approxi- mately 11.1% when the vehicles drive with a distance of 0.5 seconds in a simulated environment. / Dagens utveckling inom fordonsindustrin fokuserar mer och mer påutveckling av bränsleeffektiva hjälpmedel. Ett steg i denna riktning är utvecklingen av platooningsystem. Huvudkonceptet med platooning är att låta flera tunga fordon köra i följd i en konvoj och dela viktig information med varandra via trådlös kommuni- kation och en automatiserad styrstrategi. Detta examensarbete beskriver ett utav tre delsystem i ett projekt som är utvecklat för att hantera en process från rå sensordata till styrsignaler för fordonen. Målet är att uppnå en säker och mjuk reglering med huvudsyftet att reducera bränsleförbrukningen. Det här delsystemet behandlar mottagen sensordata från de olika fordonen. Målet med delsystemet är att skatta positioner och hastigheter för fordonen i konvojen med hänsyn till att förlorad, försenad eller irrelevant information från det trådlösa nätverket kan förekomma. Detta uppnås genom filtrering i ett Extended Kalman Filter och konvertering till ett lokalt referenssystem med origo i det egna fordo- net. Utöver detta sorteras informationen och kategoriseras in i olika klasser efter fordonens status. Examensarbetet resulterade i användbara skattningar oberoende av yttre om- ständigheter i ett lokalt referenssystem med origo i det egna fordonet. Denna information kan användas vidare för ytterligare sensorfusion och implementering av en modellbaserad prediktionsregulator (MPC) i två andra delsystem. De tre delsystemen resulterade i en mjuk och säker reglering och en reducerad bränsleför- brukning med i genomsnitt 11.1% då fordonen körde med 0.5 sekunders avstånd i en simulerad miljö.

The Defence, Peace, Safety and Security (DPSS) competency area within the Council for Scientific and Industrial Research (CSIR) has identified the need for the development of a robot that can operate in almost any land-based environment. Legged robots, especially hexapod (six-legged) robots present a wide variety of advantages that can be utilised in this environment and is identified as a feasible solution. The biggest advantage and main reason for the development of legged robots over mobile (wheeled) robots, is their ability to navigate in uneven, unstructured terrain. However, due to the complicated control algorithms needed by a legged robot, most literature only focus on navigation in even or relatively even terrains. This is seen as the main limitation with regards to the development of legged robot applications. For navigation in unstructured terrain, postural controllers of legged robots need fast and precise knowledge about the state of the robot they are regulating. The speed and accuracy of the state estimation of a legged robot is therefore very important. Even though state estimation for mobile robots has been studied thoroughly, limited research is available on state estimation with regards to legged robots. Compared to mobile robots, locomotion of legged robots make use of intermitted ground contacts. Therefore, stability is a main concern when navigating in unstructured terrain. In order to control the stability of a legged robot, six degrees of freedom information is needed about the base of the robot platform. This information needs to be estimated using measurements from the robot’s sensory system. A sensory system of a robot usually consist of multiple sensory devices on board of the robot. However, legged robots have limited payload capacities and therefore the amount of sensory devices on a legged robot platform should be kept to a minimum. Furthermore, exteroceptive sensory devices commonly used in state estimation, such as a GPS or cameras, are not suitable when navigating in unstructured and unknown terrain. The control and localisation of a legged robot should therefore only depend on proprioceptive sensors. The need for the development of a reliable state estimation framework (that only relies on proprioceptive information) for a low-cost, commonly available hexapod robot is identified. This will accelerate the process for control algorithm development. In this study this need is addressed. Common proprioceptive sensors are integrated on a commercial low-cost hexapod robot to develop the robot platform used in this study. A state estimation framework for legged robots is used to develop a state estimation methodology for the hexapod platform. A kinematic model is also derived and verified for the platform, and measurement models are derived to address possible errors and noise in sensor measurements. The state estimation methodology makes use of an Extended Kalman filter to fuse the robots kinematics with measurements from an IMU. The needed state estimation equations are also derived and implemented in Matlab®. The state estimation methodology developed is then tested with multiple experiments using the robot platform. In these experiments the robot platform captures the sensory data with a data acquisition method developed while it is being tracked with a Vicon motion capturing system. The sensor data is then used as an input to the state estimation equations in Matlab® and the results are compared to the ground-truth measurement outputs of the Vicon system. The results of these experiments show very accurate estimation of the robot and therefore validate the state estimation methodology and this study. / MIng (Computer and Electronic Engineering), North-West University, Potchefstroom Campus, 2015

The Defence, Peace, Safety and Security (DPSS) competency area within the Council for Scientific and Industrial Research (CSIR) has identified the need for the development of a robot that can operate in almost any land-based environment. Legged robots, especially hexapod (six-legged) robots present a wide variety of advantages that can be utilised in this environment and is identified as a feasible solution. The biggest advantage and main reason for the development of legged robots over mobile (wheeled) robots, is their ability to navigate in uneven, unstructured terrain. However, due to the complicated control algorithms needed by a legged robot, most literature only focus on navigation in even or relatively even terrains. This is seen as the main limitation with regards to the development of legged robot applications. For navigation in unstructured terrain, postural controllers of legged robots need fast and precise knowledge about the state of the robot they are regulating. The speed and accuracy of the state estimation of a legged robot is therefore very important. Even though state estimation for mobile robots has been studied thoroughly, limited research is available on state estimation with regards to legged robots. Compared to mobile robots, locomotion of legged robots make use of intermitted ground contacts. Therefore, stability is a main concern when navigating in unstructured terrain. In order to control the stability of a legged robot, six degrees of freedom information is needed about the base of the robot platform. This information needs to be estimated using measurements from the robot’s sensory system. A sensory system of a robot usually consist of multiple sensory devices on board of the robot. However, legged robots have limited payload capacities and therefore the amount of sensory devices on a legged robot platform should be kept to a minimum. Furthermore, exteroceptive sensory devices commonly used in state estimation, such as a GPS or cameras, are not suitable when navigating in unstructured and unknown terrain. The control and localisation of a legged robot should therefore only depend on proprioceptive sensors. The need for the development of a reliable state estimation framework (that only relies on proprioceptive information) for a low-cost, commonly available hexapod robot is identified. This will accelerate the process for control algorithm development. In this study this need is addressed. Common proprioceptive sensors are integrated on a commercial low-cost hexapod robot to develop the robot platform used in this study. A state estimation framework for legged robots is used to develop a state estimation methodology for the hexapod platform. A kinematic model is also derived and verified for the platform, and measurement models are derived to address possible errors and noise in sensor measurements. The state estimation methodology makes use of an Extended Kalman filter to fuse the robots kinematics with measurements from an IMU. The needed state estimation equations are also derived and implemented in Matlab®. The state estimation methodology developed is then tested with multiple experiments using the robot platform. In these experiments the robot platform captures the sensory data with a data acquisition method developed while it is being tracked with a Vicon motion capturing system. The sensor data is then used as an input to the state estimation equations in Matlab® and the results are compared to the ground-truth measurement outputs of the Vicon system. The results of these experiments show very accurate estimation of the robot and therefore validate the state estimation methodology and this study. / MIng (Computer and Electronic Engineering), North-West University, Potchefstroom Campus, 2015

International Telemetering Conference Proceedings / October 23-26, 2000 / Town & Country Hotel and Conference Center, San Diego, California / Pseudolites have been proposed for augmentation/replacement of the GPS system in radiolocation applications. However, a terrestrial pseudolite system suffers from the near-far effect due to received power disparities. Conventional code tracking loops as employed in GPS receivers are unable to suppress near-far interference. Here, a multiuser code tracking algorithm is presented based on the extended Kalman filter (EKF.) The EKF jointly tracks the delays and amplitudes of multiple received pseudolite waveforms. A modified EKF based on an approximate Bayesian estimator (BEKF) is also developed, which can in principle both acquire and track code delays, as well as detect loss-of-lock. Representative simulation results for the BEKF are presented for code tracking with 2 and 5 users.

A Discrete Extended Kalman Filter has been designed to process measurements from a magnetometer, sun sensor, IMU, and GPS receiver to provide the relative position, velocity, attitude, and gyro bias of a chaser spacecraft relative to a target spacecraft. An Extended Kalman Filter with Uncompensated Bias has also been developed for the implementation of well known biases and errors that are not directly observable. A detailed explanation of the algorithms, models, and derivations that go into both filters is presented. With this simulation and specific sensor selection the position of the chaser spacecraft relative to the target can be estimated to within about 5 m, the velocity to within .1 m/s, and the attitude to within 2 degrees for both filters. If a thrust is applied to the IMU measurements, it takes about 1.5 minutes to get a good position estimate, using the Extended Kalman Filter with Uncompensated Bias. The error settles almost immediately using the general Extended Kalman Filter. These filters have been designed for and can be implemented on almost any small, low cost, low power satellite with this inexpensive set of sensors. / text

An important aspect for precision guidance, navigation, and control for lunar operations is environmental modeling. In particular, consider gravity field modeling. Available gravity field models for the Moon reach degree and order 165 requiring the use and storage of approximately 26,000 spherical harmonic coefficients. Although the high degree and order provide a means by which to accurately predict trajectories within the influence of the Moon's gravitational field, the size of these models makes using them computationally expensive and restricts their use in design environments with limited computer memory and storage. It is desirable to determine reduced complexity realizations of the gravitational models to lower the computational burden while retaining the structure of the original gravitational field for use in rapid design environments. The extended Kalman filter and the unscented Kalman filter are used to create reduced order models and are compared against a simple truncation based reduction method. Both variations of the Kalman filter out perform the truncation based method as a means by which to reduce the complexity of the gravitational field. The extended Kalman filter and unscented Kalman filter were able to achieve good estimates of position while reducing the number of spherical harmonic coefficients used in gravitational acceleration calculations by approximately 5,400, greatly increasing the speed of the calculations while reducing the required computer allocation. / text

"This work addresses the problem of generating a 3D mesh grid model of a tree by a climbing robot for tree inspection. In order to generate a consistent model of the tree while climbing, the robot needs to be able to track its location while generating the model. Hence we explored this problem as a subset of Simultaneous Localization and Mapping problem. The monocular camera based Visual Simultaneous Localization and Mapping(VSLAM) algorithm was adopted to map the features on the tree. Multi-scale grid based FAST feature detector combined with Lucas Kande Optical flow was used to extract features from the tree. Inverse depth representation of feature was selected to seamlessly handle newly initialized features. The camera and the feature states along with their co-variances are managed in an Extended Kalman filter. In our VSLAM implementation we have attempted to track a large number of features. From the sparse spatial distribution of features we get using Extended Kalman filter we attempt to generate a 3D mesh grid model with the help of an unordered triangle fitting algorithm. We explored the implementation in C++ using Eigen, OpenCV and Point Cloud Library. A multi-threaded software design of the VSLAM algorithm was implemented. The algorithm was evaluated with image sets from trees susceptible to Asian Long Horn Beetle. "

This thesis demonstrates that any individual can provide relevant observational data to further research efforts within the Aerospace community, through the use of amateur telescopes. A Meade LX200 12 in. telescope and Lumenera Skynyx 2.0 camera were utilized to observe small LEO satellites, using a well-documented point-and-wait staring method. Over a period of three months, a total of 186 observation attempts were made resulting in 97 successful captures. From the gathered data, three possible aerospace applications were analyzed: validation of a satellite brightness prediction model, angles-only orbit determination including extended Kalman filtering, and temporal error growth in TLE-based orbit propagation. Further investigations include a preliminary optimization using MATLAB's fmincon function (informed by the previous analyses) to determine an optimal telescope size for performing LEO observations.

<p>This thesis aims the problem of underwater vehicle positioning. The vehicle usedwas a Saab Seaeye Falcon which was equipped with a Doppler Velocity Log(DVL)manufactured by RD Instruments and an inertial measurement unit (IMU) fromXsense. During the work several different Extended Kalman Filter (EKF) havebeen tested both with a hydrodynamic model of the vehicle and a model withconstant acceleration and constant angular velocity. The filters were tested withdata from test runs in lake Vättern. The EKF with constant acceleration andconstant angular velocity appeared to be the better one. The misalignment of thesensors were also tried to be estimated but with poor result.</p>

This dissertation presents an experimental and analytical study of the Vision Based Navigation system (VisNav). VisNav is a novel intelligent optical sensor system invented by Texas A&M University recently for autonomous proximity operations. This dissertation is focused on system calibration techniques and navigation algorithms. This dissertation is composed of four parts. First, the fundamental hardware and software design configuration of the VisNav system is introduced. Second, system calibration techniques are discussed that should enable an accurate VisNav system application, as well as characterization of errors. Third, a new six degree-of-freedom navigation algorithm based on the Gaussian Least Squares Differential Correction is presented that provides a geometrical best position and attitude estimates through batch iterations. Finally, a dynamic state estimation algorithm utilizing the Extended Kalman Filter (EKF) is developed that recursively estimates position, attitude, linear velocities, and angular rates. Moreover, an approach for integration of VisNav measurements with those made by an Inertial Measuring Unit (IMU) is derived. This novel VisNav/IMU integration technique is shown to significantly improve the navigation accuracy and guarantee the robustness of the navigation system in the event of occasional dropout of VisNav data.