Delayed Fusion of Relative State Measurements by Extending Stochastic Cloning via Direct Kalman Filtering
|
|
- Heather Kelly
- 6 years ago
- Views:
Transcription
1 Delayed Fusion of Relative State Measurements by Extending Stochastic Cloning via Direct Kalman Filtering Ehsan Asadi and Carlo L Bottasso Department of Aerospace Science and echnology Politecnico di Milano, Milano, Italy, 6 ehsanasadi@polimiit and carlobottasso@polimiit Abstract In this work, a real-time localization problem is formulated by incorporating exteroceptive sensors as sources of both relative state measurement and delayed information within a direct Kalman filtering approach he problem of delayed incorporation of relative state measurements is addressed by extending the stochastic cloning framework, whereby an augmented state vector is defined by copies of the current and delayed states he formulation is developed within a tightly coupled visionaided inertial navigation system suitable for GPS-denied environments o enhance performance, a previously described approximate observation model is replaced here with an exact one he proposed formulation is tested and demonstrated with simulation experiments conducted on a small RUAV flying in a virtual environment, showing the mitigation of adverse effects on the estimator performance caused by delays and the nature of relative state measurements Keywords Stochastic cloning; Relative state measurements; Delayed measurements; Vision aided INS I Introduction Self localization via multi sensor fusion is a key technology and an enabler of many tasks in navigation and control of autonomous vehicles In order to achieve high accuracy and robust interaction with dynamic environments, intelligent systems are nowadays equipped with various types of sensors comprising both proprioceptive sensors [] (such as encoders, gyros or accelerometers) and exteroceptive ones (such as sonars, laser scanners or cameras) In contrast to a GPS or a compass, which provide the absolute position or heading of the vehicle, relative information can be acquired by using lasers or stereo cameras yielding the position of the environment features with respect to the vehicle Standard Extended Kalman Filtering (EKF) formulations are typically not adequate for optimally incorporating relative measurements Simultaneous Localization and Mapping (SLAM) methods are capable of handling this situation, but their computational requirements can be significant due to the state vector augmentation that they perform his hinders the use of Visual-SLAM (V-SLAM) approaches in various real-time demanding applications his work is based on a localization approach resulting in an algorithm that is suitable for demanding real-time performance in GPS-denied environments A possible localization approach making use of relative state measurements is based on an approximate observation model using (average) translational and rotational velocities during the measurement acquisition time interval []; this way, measurements can be expressed directly via the current state of the vehicle his approach is accurate when the motion velocity is approximatively constant between steps A more formal approach to this problem was proposed by Ref [3], which developed a stochastic cloning framework for relative state (pose) measurements he formulation of Refs [], [3] was based on the indirect form of the (loosely coupled) Kalman filter, and estimated the errors in the states rather than the states themselves A similar implementation was also reported in Ref [4], which proposed a loosely coupled vision-aided inertial navigation with a delayed state filter to process relative state measurements In vision-based navigation systems [], latency due to the extraction of information from images in real-time applications is the other factor (besides computational complexity) limiting the frequency of fusing visual information By increasing the frequency at which image frames are incorporated into the process, real-time performance is typically achieved at the expense of accuracy by reducing the computational complexity and the number of features From a different point of view, it might be more effective in some cases to avoid reducing the computational complexity, in favor of the delayed fusion of more accurate information at a lower frequency More in general, better performance may be achieved by trade offs between frequency and computational complexity Measurement delay has been the subject of numerous investigations, for example in the context of systems requiring long time visual processing [6], [7] Some methods fuse delayed measurements as they arrive [8], [9]; these methods are effectively implemented in tracking and navigation systems for handling GPS delays he implementation of delayed state filters has also been proposed in several applications [], [] he problem is more complicated if the delayed measurement is also a relative state measurement, as in the case of visual information acquired by tracking feature points in image scenes Goal of this work is to simultaneously mitigate the effects on the estimator performance caused by the nature of relative state measurements and by delays generated by the on-line processing of visual information First, the stochastic cloning
2 formulation [] is rewritten here in a direct form of Kalman filtering hen, the problem of delayed incorporation of relative state measurements for a real-time application is addressed by extending the state vector with copies of the current and delayed vehicle states his way, the augmented state vector, which includes three copies of current and delayed vehicle states, introduces more interdependent effects into the approach via cross-correlation terms A vision aided inertial navigation approach [] in GPS-denied environments is here optimized by exploiting an exact observation model within the proposed extended stochastic cloning framework Simulation experiments are conducted to assess the performance of the proposed extended stochastic cloning approach in the presence of delayed relative state measurements II Delayed Relative State Measurements he standard EKF estimator is based on the following statespace model: ( ) x k+ = f k xk,µ k, z k = h k (x k )+ξ k, (a) (b) where f ( ) and h( ) express the process and observation models, respectively Furthermore,µ k andξ k are the associated process and measurement noise vectors, respectively, assuming E{µ k µ k }= Q and E{ξ k ξ k }=Υ Consider now z k to be a relative state measurement, logged at time step k, but provided to the estimator with m time steps of latency, noted z k his way one may derive a non-standard observation model that can be expressed as z k = h k+m (x k+m k, x k k, x, z )+ξ k () III Stochastic Cloning Framework Delayed state Kalman filtering is an optimal approach for incorporating delayed measurements where z k = h k+m (x k+m k, x k k )+ξ k An augmented state vector, x k k, is used within the estimator by extending the state vector with a same copy of the vehicle state at time step k, by defining x k k = [ x k k x k k] (3) A more general stochastic cloning framework was presented in an indirect form of Kalman filtering [3] to correctly account for the correlations between consecutive relative-state measurements, where z k+m = h k+m (x k+m k, x k k, z k )+ξ k+m According to Ref [3], the filter (error) state vector was augmented to include two copies of the vehicle error 3 state, x, and a copy of observations his way, at time step k the augmented state is defined as x k k = [ x k k x k k z ] k (4) he star symbol, [ ], indicates a delayed measurement with m time steps of latency he bar symbol, [ ], indicates the augmented form of vectors or matrices 3 he tilde symbol, [ ], is used to signify the error between the actual value of a quantity and its estimate, ie x k k = x k ˆx k k IV Extended Stochastic Cloning Considering that delay may be associated with exteroceptive measurements, the relative state measurement is related to the vehicle states at three different times instead of two, as indicated in Eq () herefore, the previous frameworks represented by delayed state Kalman filtering and stochastic cloning does not in general provide an optimal solution in this case o address this problem, in the present work copy of the current and delayed vehicle states are appended to the current state, alongside with the latest exteroceptive measurements, this way obtaining an extended stochastic cloning framework In comparison to Ref [3], this implementation allows for a larger number of cross-correlation terms, among the vehicle state at three different times and between the vehicle states and the observations Considering the last relative measurements, which were logged at time step k m and fused at k, the proposed augmented state vector is given by the following expression x k k = [ x k k x k k x z ] () In comparison to SLAM approaches, here the state vector and the computational cost do not grow with the environment size, as only frame to frame measurements are incorporated Environment features are directly augmented to the state vector and they are replaced by a new one as soon as they disappear from the field of view A Resetting the Cloned Filter In order to prepare the cloned filter, the augmented state vector and covariance matrix are reset right after completing the Kalman update by the last exteroceptive measurement Considering time step k, the augmented state vector is given by Eq () and the covariance matrix is reset as P k k = P k k P k k P xk x P xk z P k k P k k P xk x P xk z P x k x P x k x P P x z P x k z P x k z P x z P z z (6) Sub-matrices P k k and P in Eq (6) are acquired according to the standard Kalman filter implementation and directly extracted from the covariance matrix before it is reset However, sub-matrices P xk x, P xk z, P x z and P z z are the required unknown blocks at the sample time step k, and should be computed after the Kalman update hese matrices are evaluated later on in Sect IV-D B State Propagation Consider a linearization of the previous system (a), expressed in the discrete form x k+ = F k x k + G k µ k, (7) where F k and G k represent Jacobians of the process model f k with respect to the state x k and noiseµ k vectors hen, the propagation of a non-augmented state vector is obtained as x k+ k = F k x k k, P k+ k = F k P k k F k + G k Q k G k, (8a) (8b)
3 Subsequently, after m time steps of propagation, the above formulation can be modified as, x k+m k =F k k+m x k k, (9a) P k+m k =F k k+m P k k Fk k+m +Q k k+m, (9b) wheref k k+m = m i= F k+m i andq k k+m = E { σ k k+m σk k+m} is the covariance of σ k k+m, while σ k k+m is the corresponding process noise after m time steps of propagation Further details on the formulation are given in Appendix I Using a similar approach, the corresponding updates for the augmented state vector and covariance matrix can be written as x k+m k =F k k+m x k k, (a) P k+m k =F k k+m P k k F k k+m+q k k+m, (b) where x k+m =F k k+m x k +σ k k+m, and F k k+m Q k k+m F k k+m = I, Q k k+m= his way, after m time steps of propagation, the augmented state vector and covariance matrix at time step k+m are given by x k+m k = [ x k+m k x k k x z ], () P k+m k = P k+m k F k k+m P k k F k k+m P xk x F k k+m P xk z P k k Fk k+m P k k P xk x P xk z P x k x Fk k+m P x k x P P x z P x k z Fk k+m P x k z P x z P z z () According to Eq (), a large block of the covariance matrix will be kept unchanged during state propagation C State Update Consider now time step k+m, when a new delayed measurement is fed to the estimator he Kalman equation at the update step can be applied after computing the augmented covariance of the residual and the Kalman gain: where S= H k+m P k+m k H k+m+υ k, (3) K=P k+m k H k+ms = [ K k+m K k K K z ], (4) H k+m = [ H k+m k+m H k+m k H k+m M ], () and H k+m k+m, H k+m k, H k+m and M k+m represent the Jacobians of the nonlinear observation model, expressed by Eq (), with respect to x k+m, x k, x and z, respectively he main goal is to update the current state of the vehicle, but the delayed states are also required to be updated to prepare the augmented covariance matrix for the next update step, and this is obtained as follows: ˆx k+m k+m = x k+m k + K k+m ( z k ẑz k), (6a) ˆP k+m k+m = P k+m k K k+m S K k+m (6b) D Evaluating the Cross-Covariance Relations In order to complete the above formulation, it is necessary to compute four submatrices, which are unknown components of the augmented covariance matrix expressed by Eq (6) Here the matrices are computed at time step k+m, whereas the corresponding matrices at time step k can be readily extracted by a similar formulation o compute the unknown term P xk+m x k, first the cross covariance between the augmented state vector at two different time steps is expressed wrt the covariance matrix at time k +m P xk+m x k = E{ x k+m k+m x k k} = E{[(I K k+m H k+m ) x k+m k K k+m ξ k ] [F k k+m( x k+m k σ k k+m )] } = (I K k+m H k+m )( E{ x k+m k x k+m k} E{ x k+m k σ k k+m } )F k k+m P k+m k+m F k k+m (I K k+m H k+m )Q k k+m F k k+m, (7) where (I K k+m H k+m )E{ x k+m k x k+m k} is replaced by P k+m k+m, assuming the Kalman gain to be optimal, and E{ x k+m k σ k k+m } E{[F k k+m x k k +σ k k+m ][σ k k+m ] }=Q k k+m Finally, by Eq 7 and using a blockwise inversion off k k+m, block P xk+m x k can be readily expressed as P xk+m x k = (P k+m k+m Q k k+m )Fk k+m, (8) Q k k+m = (I K k+m H k+m k+m )Q k k+m In order to simplify the computation of the other interdependent terms, here the last measurement is assumed as a temporary variable augmented to the state vector, similarly to what done in Ref [3] herefore, we have X= [ x k+m k z k ], (9) H= [ H k+m ] () Noting that P xk+m k z = P k k+m k H k+m, the corresponding covariance ofxcan be written as P P k+m k = k+m k P k+m k H k+m H k+m P k+m k H k+m P k+m k Hk+m+Υ () k Regarding the sparse observation model H, the residual covariancesis equal to S, and the corresponding Kalman gain is expressed as K=PH S = [K K z k+m ] = [K (H K) ] () Finally, by applying the Kalman update, the covariance matrix is given as P k+m k+m P xk+m z P k+m k+m = k =P k+m k KSK = P x k+m z k P k+m k K S K H k+m (P k+m k K S K ) P z k z k (P k+m k K S K )H k+m H k+m (P k+m k K S K )H k+m+υ k (3)
4 According to Eq (3), and noting that P k+m k+m = P k+m k K S K, the cross-covariance terms P xk+m z, P x k k z and P z k k z k at time step k+ m can be readily expressed as P xk+m z k = AP k+m k+m H k+m ; A=[ I ], (4a) P xk z k = BP k+m k+m H k+m ; B=[ I ], (4b) P z k z k = H k+m P k+m k+m H k+m+υ k (4c) A similar formulation can also be derived for the crosscovariance terms at time step k P xk z, P x z and P z z, previously introduced in Eqs (6) and () his way, the augmented covariance matrix after m time step of propagation, as expressed by Eq (), can be rewritten as Eq () Considering the expression of Eq (), in order to have an efficient implementation in terms of computational cost, it is advisable to accumulate the products off k k+m andf k, where the required multiplications to extract P k+m k are delayed and carried out when the new delayed measurements arrive at the estimator V Case Study A tightly-coupled vision aided inertial navigation system (VA-INS) for GPS-denied environments was proposed in Ref [] and subsequently extended in Ref [7] A set of environment features tracked by the vision system were treated as independent visual measurements, and they were fused with inertial readings in order to enhance the estimates in the case of GPS unavailability However, an approximate observation model was used to handle relative state measurements Goal of this work is to improve on the previous formulation by optimizing the estimator performance in real-time applications o this end, an exact vision-based observation model and the delays associated with visual measurements are optimally considered here through the proposed extended stochastic cloning framework he estimator is based on a state vector composed of translational and angular velocities, v and ω, together with the position, r, and quaternion parameters, q, ie x v (v,ω, r, q ) (6) he VA-INS architecture investigated here is based on tracking scene points among stereo images and across time steps Consider a fixed feature point P, whose position vectors wrt framescandc of a stereo vision setup are noted d and d, respectively hus, an exact feature-based observation model discretized across two consecutive time instants t and t k, is given by d (t k ) C k = C ( R(t k ) (r(t k ) r(t ))+ (I R(t k ) R(t ))(c+ Cd(t ) C ) ) + d(t ) C, (7) where matrix C indicates the constant-in-time rotation that brings the body-attached frame intoc, and c is the position vector of point C with respect to the origin of the body frame Furthermore, R = R(q) are the components of the rotation tensor that brings the fixed Earth frame into the body frame Assuming m time steps of latency, the left hand side of Eq (7) is provided by the vision system at time k+ m Equation (7) also represents the relation of the position of a feature point wrt the camera at time t k, noted d(t k ) C k, to its position at t, noted d(t ) C, through the partial vehicle states (position and quaternions) at times t k and t According to the proposed extended stochastic cloning framework, the augmented state vector for this specific problem is defined here as where x d (r, q ) x k k = [ x v k k x d k k x d z ], (8) VI Experiments and Results In this simulation experiment, a small helicopter performs a low level flight in an urban canyon within a small village he stereo camera is mounted in front of the vehicle looking forward to buildings and several other objects featuring realistic textures A Matlab/Simulink simulator was developed, that includes a flight mechanics model of a small RUAV, models of inertial navigation sensors, magnetometer, GPS and their noise models he simulator is used in conjunction with the OGRE graphics engine [], for rendering a virtual environment scene and simulating the image acquisition process All sensor measurements are simulated (see able I) as the helicopter flies at an altitude of m following a rectangular path at a constant speed of m/sec (see Fig ) Navigation measurements are provided at a rate of Hz, while stereo images at the rate of Hz with a sec delay he sonar altimeter is also available at Hz he GPS, available at a rate of Hz, is turned off after sec in the flight, to demonstrate entering into a GPS-denied region In order to have a comprehensive assessment of the proposed formulation, various experiments are conducted for the two conditions of relative state measurements without and with delay ABLE I: Sensors and vibration noise levels Sensors Noise Level Gyro deg/s Accelerometer m/s Magnetometer 4 Gauss GPS m Fig : Simulated small village environment and flight trajectory
5 P k+m k = P k+m k F k k+m P k k F k k+m (P k k Q k )F P k k F k k+m P k k (P k k Q k )F k F k (P k k Q k ) F k k+m k F k k+m AP k k H k AP k k H k F k (P k k Q k ) P BP k k H k H k P k k A F k k+m H k P k k A H k P k k B H k P k k H k+υ () ) Relative state measurement with no delay Figures (a)-(f) report the estimated trajectory and position errors, in the presence of no delay, using different approaches: Approximate approach he approximate observation model is used, where the relative displacement and rotation of the vehicle are computed based on (average) translational and rotational velocity states Delayed State Kalman filtering (DSK) he time correlation between measurement noises are neglected, ie x k k = [ x k k x k k] Direct Stochastic Cloning (DSC) he simple form of the proposed formulation via direct Kalman filtering is used, where the corresponding parts of formulation that address latency are removed, ie x k k = [ x k k x k k z ] ) Relative state measurement in the presence of delay Figures 3(a)-3(f) report the estimated trajectory and position errors, in the presence of delay, using different approaches: Delayed State Kalman filtering (DSK) his approach is used to demonstrate the effects when delay is not properly handled within the estimator, using x k k = [ x k k x k k] Simplified form of Extended Direct Stochastic Cloning (S-EDSC) he simple form of the proposed extended stochastic cloning is used, where the corresponding parts of the formulation that address the time correlation between measurement noises are removed, ie x k k = [ x k k x k k x ] Extended Direct Stochastic Cloning (EDSC) he complete form of the proposed extended stochastic cloning is used, ie x k k = [ x k k x k k x z ] Figures 4 and report the velocity analysis for each approach, without and with considering delays, respectively he loss of the GPS signal may cause a rapid divergence of the estimates of the standard non-vision-aided observer, however the vision-aided navigation system is capable of enhancing the estimates even in the absence of GPS readings According to the results in the case of no delay, using the exact vision-based model allows for a considerable improvement of the estimates in comparison to the approximate model via standard EKF, cf Figs (a)-(f) Furthermore using a direct stochastic cloning approach provides for smoother estimates, where the filter bounds are also better fitted to the position errors his improvement is clearer in the position rather than the velocity estimates Moreover, the results show the unsuccessful performance of the standard form of the delayed state Kalman filtering and of stochastic cloning for handling both delay and relativestate issues simultaneously On the other hand, the proposed extended stochastic cloning achieves a considerable improvement of the estimates in the presence of delayed relative state measurements, as shown in Figs 3(a)-3(f) VII Conclusion In this work, a localization problem through direct Kalman filtering has been studied, by incorporating exteroceptive sensors as a simultaneous source of relative state and delayed measurements he stochastic cloning framework was extended for a direct form of Kalman filtering, in which the problem of delayed incorporation of relative state measurements is also addressed It was proposed to extend the state vector with a copy of the current and of the delayed vehicle states, this way introducing more interdependencies in the model he formulation was used to optimize a tightly coupled vision-aided navigation system operating in GPS-denied environments A previously described approximated observation model was replaced with an exact one, with the purpose of mitigating effects on the estimator performance caused by delays and by the nature of relative state measurements he proposed formulation was tested and demonstrated with simulation experiments conducted on a small RUAV flying in a virtual environment he results show the rather disappointing performance of standard delayed state Kalman filtering and stochastic cloning for handling both delay and relative-state simultaneously On the other hand, the proposed extended stochastic cloning approach allows for a considerable improvement of the estimates in the presence of relative state measurements associated with delay σ k k+m = k+m j=k+ VIII Appendix I k+m j F k+m i G j µ j + G k+m µ k+m i= (9) Q k k+m = E { σ k k+m σk k+m} = k+m k+m j k+m F k+m i G j j Q j G j F k+m i j=k+ i= i= + G k+m Q k+m G k+m (3)
6 (b) Approximate Approach Position errors (a) Approximate Approach rajectory estimate; GPS is off after sec (d) DSK Position errors (c) DSK rajectory estimate; GPS is off after sec (e) DSC rajectory estimate; GPS is off after sec (f) DSC Position errors Fig : No delay Left: rajectory estimate and Right: Position Errors, with 9% confidence bounds Green line: Error between position estimate and position prediction Red line: Error between position estimate and real position
7 (b) DSK Position errors (a) DSK rajectory estimate; GPS is off after sec (d) S-EDSC Position errors (c) S-EDSC rajectory estimate; GPS is off after sec (e) EDSC rajectory estimate; GPS is off after sec (f) EDSC Position errors Fig 3: In the presence of delay Left: rajectory estimate, and Right: Position Errors, with 9% confidence bounds Green line: Error between position estimate and position prediction Red line: Error between position estimate and real position
8 Fig 4: No delay Velocity errors, with 9% confidence bounds Left: Approximate Approach, Center: DSK, Right: DSC Green line: Error between velocity estimate and velocity prediction Red line: Error between velocity estimate and real velocity Fig : In the presence of delay Velocity errors, with 9% confidence bounds Left: DSK, Center: S-EDSC, Right: EDSC Green line: Error between velocity estimate and velocity prediction Red line: Error between velocity estimate and real velocity References [] A I Mourikis and S I Roumeliotis, On the treatment of relative pose measurements for mobile robot localization, in Proc IEEE Int Conf on Robotics and Automation, Orlando, FL, 6, pp [] C L Bottasso and D Leonello, Vision-aided inertial navigation by sensor fusion for an autonomous rotorcraft vehicle, in Proc AHS Int Specialists Meeting on Unmanned Rotorcraft, Arizona, USA,, pp 8 [3] A I Mourikis, S I Roumeliotis, and J W Burdick, Sc-kf mobile robot localization: A stochastic cloning-kalman filter for processing relative-state measurements, IEEE ransactions on Robotics, vol 3, no 4, pp 77 73, 7 [4] J P ardif, M George, M Laverne, A Kelly, and A Stentz, A new approach to vision-aided inertial navigation, in Proc IEEE/RSJ International Conference on Intelligent Robots and Systems, aipei, aiwan,, pp [] E S Jones and S Soatto, Visual-inertial navigation, mapping and localization: A scalable real-time causal approach, he International Journal of Robotics Research, vol 3, no 4, pp 47 43, [6] S Pornsarayouth and M Wongsaisuwan, Sensor fusion of delay and non-delay signal using Kalman filter with moving covariance, in Proc IEEE International Conference on Robotics and Biomimetics, 9 [7] E Asadi and C L Bottasso, Handling delayed fusion in visionaugmented inertial navigation, in Proc 9th International Conference on Informatics in Control, Automation and Robotics, Rome, Italy,, pp [8] H L Alexander, State estimation for distributed systems with sensing delay, in SPIE, 99, pp 3 [9] D Larsen, N A Andersen, O Ravn, and N Poulsen, Incorporation of time delayed measurements in a discrete-time Kalman filter, in Proc 37th IEEE Conference on Decision and Control, 998, pp [] A Gopalakrishnan, N Kaisare, and S Narasimhan, Incorporating delayed and infrequent measurements in extended Kalman filter based nonlinear state estimation, Journal of Process Control, vol, no, pp 9 9, [] M J Stanway, Delayed-state sigma point Kalman filters for underwater navigation, in Proc IEEE/OES Autonomous Underwater Vehicles (AUV), Woods Hole, MA, USA,, pp 9 [] G Junker, Pro OGRE 3D Programming New York: Springer-Verlag, 6
On the Treatment of Relative-Pose Measurements for Mobile Robot Localization
On the Treatment of Relative-Pose Measurements for Mobile Robot Localization Anastasios I. Mourikis and Stergios I. Roumeliotis Dept. of Computer Science & Engineering, University of Minnesota, Minneapolis,
More informationSC-KF Mobile Robot Localization: A Stochastic-Cloning Kalman Filter for Processing Relative-State Measurements
1 SC-KF Mobile Robot Localization: A Stochastic-Cloning Kalman Filter for Processing Relative-State Measurements Anastasios I. Mourikis, Stergios I. Roumeliotis, and Joel W. Burdick Abstract This paper
More informationSC-KF Mobile Robot Localization: A Stochastic Cloning-Kalman Filter for Processing Relative-State Measurements
SC-KF Mobile Robot Localization: A Stochastic Cloning-Kalman Filter for Processing Relative-State Measurements Anastasios I. Mourikis, Stergios I. Roumeliotis, and Joel W. Burdick Abstract This paper presents
More informationSensors Fusion for Mobile Robotics localization. M. De Cecco - Robotics Perception and Action
Sensors Fusion for Mobile Robotics localization 1 Until now we ve presented the main principles and features of incremental and absolute (environment referred localization systems) could you summarize
More informationStochastic Cloning: A generalized framework for processing relative state measurements
Stochastic Cloning: A generalized framework for processing relative state measurements Stergios I. Roumeliotis and Joel W. Burdick Division of Engineering and Applied Science California Institute of Technology,
More informationFuzzy Logic Based Nonlinear Kalman Filter Applied to Mobile Robots Modelling
Fuzzy Logic Based Nonlinear Kalman Filter Applied to Mobile Robots Modelling Rodrigo Carrasco Sch. Department of Electrical Engineering Pontificia Universidad Católica de Chile, CHILE E-mail: rax@ing.puc.cl
More informationUAV Navigation: Airborne Inertial SLAM
Introduction UAV Navigation: Airborne Inertial SLAM Jonghyuk Kim Faculty of Engineering and Information Technology Australian National University, Australia Salah Sukkarieh ARC Centre of Excellence in
More informationVision-Aided Navigation Based on Three-View Geometry
Vision-Aided Navigation Based on hree-view Geometry Vadim Indelman, Pini Gurfil Distributed Space Systems Lab, Aerospace Engineering, echnion Ehud Rivlin Computer Science, echnion Hector Rotstein RAFAEL
More informationwith Application to Autonomous Vehicles
Nonlinear with Application to Autonomous Vehicles (Ph.D. Candidate) C. Silvestre (Supervisor) P. Oliveira (Co-supervisor) Institute for s and Robotics Instituto Superior Técnico Portugal January 2010 Presentation
More informationLecture 13 Visual Inertial Fusion
Lecture 13 Visual Inertial Fusion Davide Scaramuzza Outline Introduction IMU model and Camera-IMU system Different paradigms Filtering Maximum a posteriori estimation Fix-lag smoothing 2 What is an IMU?
More information1 Kalman Filter Introduction
1 Kalman Filter Introduction You should first read Chapter 1 of Stochastic models, estimation, and control: Volume 1 by Peter S. Maybec (available here). 1.1 Explanation of Equations (1-3) and (1-4) Equation
More informationLocation Estimation using Delayed Measurements
Downloaded from orbit.dtu.dk on: Jan 29, 2019 Location Estimation using Delayed Measurements Bak, Martin; Larsen, Thomas Dall; Nørgård, Peter Magnus; Andersen, Nils Axel; Poulsen, Niels Kjølstad; Ravn,
More informationLocal Reference Filter for Life-Long Vision Aided Inertial Navigation
Local Reference Filter for Life-Long Vision Aided Inertial Navigation Korbinian Schmid Department of Perception and Cognition Robotics and Mechatronics Center German Aerospace Center (DLR Email: Korbinian.Schmid@dlr.de
More informationA Study of Covariances within Basic and Extended Kalman Filters
A Study of Covariances within Basic and Extended Kalman Filters David Wheeler Kyle Ingersoll December 2, 2013 Abstract This paper explores the role of covariance in the context of Kalman filters. The underlying
More informationAutomated Tuning of the Nonlinear Complementary Filter for an Attitude Heading Reference Observer
Automated Tuning of the Nonlinear Complementary Filter for an Attitude Heading Reference Observer Oscar De Silva, George K.I. Mann and Raymond G. Gosine Faculty of Engineering and Applied Sciences, Memorial
More informationSimultaneous Localization and Map Building Using Natural features in Outdoor Environments
Simultaneous Localization and Map Building Using Natural features in Outdoor Environments Jose Guivant, Eduardo Nebot, Hugh Durrant Whyte Australian Centre for Field Robotics Department of Mechanical and
More informationAerial Robotics. Vision-based control for Vertical Take-Off and Landing UAVs. Toulouse, October, 2 nd, Henry de Plinval (Onera - DCSD)
Aerial Robotics Vision-based control for Vertical Take-Off and Landing UAVs Toulouse, October, 2 nd, 2014 Henry de Plinval (Onera - DCSD) collaborations with P. Morin (UPMC-ISIR), P. Mouyon (Onera), T.
More informationAutomatic Self-Calibration of a Vision System during Robot Motion
Proceedings of the 2006 IEEE International Conference on Robotics and Automation Orlando, Florida - May 2006 Automatic Self-Calibration of a Vision System during Robot Motion Agostino Martinelli, avide
More informationIncorporation of Time Delayed Measurements in a. Discrete-time Kalman Filter. Thomas Dall Larsen, Nils A. Andersen & Ole Ravn
Incorporation of Time Delayed Measurements in a Discrete-time Kalman Filter Thomas Dall Larsen, Nils A. Andersen & Ole Ravn Department of Automation, Technical University of Denmark Building 326, DK-2800
More informationESTIMATOR STABILITY ANALYSIS IN SLAM. Teresa Vidal-Calleja, Juan Andrade-Cetto, Alberto Sanfeliu
ESTIMATOR STABILITY ANALYSIS IN SLAM Teresa Vidal-Calleja, Juan Andrade-Cetto, Alberto Sanfeliu Institut de Robtica i Informtica Industrial, UPC-CSIC Llorens Artigas 4-6, Barcelona, 88 Spain {tvidal, cetto,
More informationEvaluation of different wind estimation methods in flight tests with a fixed-wing UAV
Evaluation of different wind estimation methods in flight tests with a fixed-wing UAV Julian Sören Lorenz February 5, 2018 Contents 1 Glossary 2 2 Introduction 3 3 Tested algorithms 3 3.1 Unfiltered Method
More informationSLAM for Ship Hull Inspection using Exactly Sparse Extended Information Filters
SLAM for Ship Hull Inspection using Exactly Sparse Extended Information Filters Matthew Walter 1,2, Franz Hover 1, & John Leonard 1,2 Massachusetts Institute of Technology 1 Department of Mechanical Engineering
More informationMulti-Sensor Fusion for Localization of a Mobile Robot in Outdoor Environments
Multi-Sensor Fusion for Localization of a Mobile Robot in Outdoor Environments Thomas Emter, Arda Saltoğlu and Janko Petereit Introduction AMROS Mobile platform equipped with multiple sensors for navigation
More informationKalman Filter Enhancement for UAV Navigation
Kalman Filter Enhancement for UAV Navigation Roger Johnson* Jerzy Sasiade** Janusz Zalewsi* *University of Central Florida Orlando, FL 86-2450, USA **Carleton University Ottawa, Ont. KS 5B6, Canada Keywords
More informationIsobath following using an altimeter as a unique exteroceptive sensor
Isobath following using an altimeter as a unique exteroceptive sensor Luc Jaulin Lab-STICC, ENSTA Bretagne, Brest, France lucjaulin@gmail.com Abstract. We consider an underwater robot equipped with an
More informationSensors for mobile robots
ROBOTICS 01PEEQW Basilio Bona DAUIN Politecnico di Torino Mobile & Service Robotics Sensors for Robotics 2 Sensors for mobile robots Sensors are used to perceive, analyze and understand the environment
More informationAdaptive Estimation of Measurement Bias in Six Degree of Freedom Inertial Measurement Units: Theory and Preliminary Simulation Evaluation
Adaptive Estimation of Measurement Bias in Six Degree of Freedom Inertial Measurement Units: Theory and Preliminary Simulation Evaluation Andrew R. Spielvogel and Louis L. Whitcomb Abstract Six-degree
More informationA Multi-State Constraint Kalman Filter for Vision-aided Inertial Navigation
A Multi-State Constraint Kalman Filter for Vision-aided nertial Navigation Anastasios. Mourikis and Stergios. Roumeliotis Abstract n this paper, we present an Extended Kalman Filter (EKF)-based algorithm
More informationRao-Blackwellized Particle Filtering for 6-DOF Estimation of Attitude and Position via GPS and Inertial Sensors
Rao-Blackwellized Particle Filtering for 6-DOF Estimation of Attitude and Position via GPS and Inertial Sensors GRASP Laboratory University of Pennsylvania June 6, 06 Outline Motivation Motivation 3 Problem
More informationDecentralized Multi-robot Cooperative Localization using Covariance Intersection
Decentralized Multi-robot Cooperative Localization using Covariance Intersection Luis C. Carrillo-Arce, Esha D. Nerurkar, José L. Gordillo, and Stergios I. Roumeliotis Abstract In this paper, we present
More informationTarget tracking and classification for missile using interacting multiple model (IMM)
Target tracking and classification for missile using interacting multiple model (IMM Kyungwoo Yoo and Joohwan Chun KAIST School of Electrical Engineering Yuseong-gu, Daejeon, Republic of Korea Email: babooovv@kaist.ac.kr
More informationEKF and SLAM. McGill COMP 765 Sept 18 th, 2017
EKF and SLAM McGill COMP 765 Sept 18 th, 2017 Outline News and information Instructions for paper presentations Continue on Kalman filter: EKF and extension to mapping Example of a real mapping system:
More informationDesign of Adaptive Filtering Algorithm for Relative Navigation
Design of Adaptive Filtering Algorithm for Relative Navigation Je Young Lee, Hee Sung Kim, Kwang Ho Choi, Joonhoo Lim, Sung Jin Kang, Sebum Chun, and Hyung Keun Lee Abstract Recently, relative navigation
More informationA First-Estimates Jacobian EKF for Improving SLAM Consistency
A First-Estimates Jacobian EKF for Improving SLAM Consistency Guoquan P. Huang 1, Anastasios I. Mourikis 1,2, and Stergios I. Roumeliotis 1 1 Dept. of Computer Science and Engineering, University of Minnesota,
More informationIMU-Laser Scanner Localization: Observability Analysis
IMU-Laser Scanner Localization: Observability Analysis Faraz M. Mirzaei and Stergios I. Roumeliotis {faraz stergios}@cs.umn.edu Dept. of Computer Science & Engineering University of Minnesota Minneapolis,
More informationFuzzy Adaptive Kalman Filtering for INS/GPS Data Fusion
A99936769 AMA-99-4307 Fuzzy Adaptive Kalman Filtering for INS/GPS Data Fusion J.Z. Sasiadek* and Q. Wang** Dept. of Mechanical & Aerospace Engineering Carleton University 1125 Colonel By Drive, Ottawa,
More informationL11. EKF SLAM: PART I. NA568 Mobile Robotics: Methods & Algorithms
L11. EKF SLAM: PART I NA568 Mobile Robotics: Methods & Algorithms Today s Topic EKF Feature-Based SLAM State Representation Process / Observation Models Landmark Initialization Robot-Landmark Correlation
More informationMetric Visual-Inertial Navigation System Using Single Optical Flow Feature
13 European Control Conference (ECC) July 17-19, 13, Zürich, Switzerland. Metric Visual-Inertial Navigation System Using Single Optical Flow Feature Sammy Omari 1 and Guillaume Ducard Abstract This paper
More informationInvestigation of the Attitude Error Vector Reference Frame in the INS EKF
Investigation of the Attitude Error Vector Reference Frame in the INS EKF Stephen Steffes, Jan Philipp Steinbach, and Stephan Theil Abstract The Extended Kalman Filter is used extensively for inertial
More informationEE 570: Location and Navigation
EE 570: Location and Navigation Aided INS Aly El-Osery Kevin Wedeward Electrical Engineering Department, New Mexico Tech Socorro, New Mexico, USA In Collaboration with Stephen Bruder Electrical and Computer
More informationBayes Filter Reminder. Kalman Filter Localization. Properties of Gaussians. Gaussians. Prediction. Correction. σ 2. Univariate. 1 2πσ e.
Kalman Filter Localization Bayes Filter Reminder Prediction Correction Gaussians p(x) ~ N(µ,σ 2 ) : Properties of Gaussians Univariate p(x) = 1 1 2πσ e 2 (x µ) 2 σ 2 µ Univariate -σ σ Multivariate µ Multivariate
More informationAutonomous Mobile Robot Design
Autonomous Mobile Robot Design Topic: Extended Kalman Filter Dr. Kostas Alexis (CSE) These slides relied on the lectures from C. Stachniss, J. Sturm and the book Probabilistic Robotics from Thurn et al.
More informationAiding Off-Road Inertial Navigation with High Performance Models of Wheel Slip
Aiding Off-Road Inertial Navigation with High Performance Models of Wheel Slip Forrest Rogers-Marcovitz, Michael George, Neal Seegmiller, and Alonzo Kelly Abstract When GPS, or other absolute positioning,
More informationSensor Aided Inertial Navigation Systems
Arvind Ramanandan Department of Electrical Engineering University of California, Riverside Riverside, CA 92507 April, 28th 2011 Acknowledgements: 1 Prof. Jay A. Farrell 2 Anning Chen 3 Anh Vu 4 Prof. Matthew
More informationProbability Map Building of Uncertain Dynamic Environments with Indistinguishable Obstacles
Probability Map Building of Uncertain Dynamic Environments with Indistinguishable Obstacles Myungsoo Jun and Raffaello D Andrea Sibley School of Mechanical and Aerospace Engineering Cornell University
More informationKalman Filters with Uncompensated Biases
Kalman Filters with Uncompensated Biases Renato Zanetti he Charles Stark Draper Laboratory, Houston, exas, 77058 Robert H. Bishop Marquette University, Milwaukee, WI 53201 I. INRODUCION An underlying assumption
More informationA Deterministic Filter for Simultaneous Localization and Odometry Calibration of Differential-Drive Mobile Robots
1 A Deterministic Filter for Simultaneous Localization and Odometry Calibration of Differential-Drive Mobile Robots Gianluca Antonelli Stefano Chiaverini Dipartimento di Automazione, Elettromagnetismo,
More informationAdaptive Two-Stage EKF for INS-GPS Loosely Coupled System with Unknown Fault Bias
Journal of Gloal Positioning Systems (26 Vol. 5 No. -2:62-69 Adaptive wo-stage EKF for INS-GPS Loosely Coupled System with Unnown Fault Bias Kwang Hoon Kim Jang Gyu Lee School of Electrical Engineering
More informationMotion Tracking with Fixed-lag Smoothing: Algorithm and Consistency Analysis
Motion Tracing with Fixed-lag Smoothing: Algorithm and Consistency Analysis Tue-Cuong Dong-Si and Anastasios I. Mouriis Dept. of Electrical Engineering, University of California, Riverside E-mail: tdongsi@ee.ucr.edu,
More informationQuaternion-Based Tracking Control Law Design For Tracking Mode
A. M. Elbeltagy Egyptian Armed forces Conference on small satellites. 2016 Logan, Utah, USA Paper objectives Introduction Presentation Agenda Spacecraft combined nonlinear model Proposed RW nonlinear attitude
More informationIMU-Camera Calibration: Observability Analysis
IMU-Camera Calibration: Observability Analysis Faraz M. Mirzaei and Stergios I. Roumeliotis {faraz stergios}@cs.umn.edu Dept. of Computer Science & Engineering University of Minnesota Minneapolis, MN 55455
More informationIntroduction to Mobile Robotics SLAM: Simultaneous Localization and Mapping
Introduction to Mobile Robotics SLAM: Simultaneous Localization and Mapping Wolfram Burgard, Cyrill Stachniss, Kai Arras, Maren Bennewitz What is SLAM? Estimate the pose of a robot and the map of the environment
More informationLecture. Aided INS EE 570: Location and Navigation. 1 Overview. 1.1 ECEF as and Example. 1.2 Inertial Measurements
Lecture Aided EE 570: Location and Navigation Lecture Notes Update on April 13, 2016 Aly El-Osery and Kevin Wedeward, Electrical Engineering Dept., New Mexico Tech In collaoration with Stephen Bruder,
More informationReal-time Attitude Estimation Techniques Applied to a Four Rotor Helicopter
43rd IEEE Conference on Decision and Control December 14-17, 4 Atlantis, Paradise Island, Bahamas ThC9.3 Real- Attitude Estimation Techniques Applied to a Four Rotor Helicopter Matthew G. Earl and Raffaello
More informationRobot Localisation. Henrik I. Christensen. January 12, 2007
Robot Henrik I. Robotics and Intelligent Machines @ GT College of Computing Georgia Institute of Technology Atlanta, GA hic@cc.gatech.edu January 12, 2007 The Robot Structure Outline 1 2 3 4 Sum of 5 6
More informationAided Inertial Navigation with Geometric Features: Observability Analysis
Aided nertial Navigation with eometric Features: Observability Analysis Yulin Yang and uoquan Huang Abstract n this paper, we perform observability analysis for inertial navigation systems NS aided by
More informationROBUST CONSTRAINED ESTIMATION VIA UNSCENTED TRANSFORMATION. Pramod Vachhani a, Shankar Narasimhan b and Raghunathan Rengaswamy a 1
ROUST CONSTRINED ESTIMTION VI UNSCENTED TRNSFORMTION Pramod Vachhani a, Shankar Narasimhan b and Raghunathan Rengaswamy a a Department of Chemical Engineering, Clarkson University, Potsdam, NY -3699, US.
More informationAutonomous Navigation, Guidance and Control of Small 4-wheel Electric Vehicle
Journal of Asian Electric Vehicles, Volume 10, Number 1, June 01 Autonomous Navigation, Guidance and Control of Small 4-wheel Electric Vehicle Satoshi Suzuki International Young Researchers Empowerment
More informationOn the Observability and Self-Calibration of Visual-Inertial Navigation Systems
Center for Robotics and Embedded Systems University of Southern California Technical Report CRES-08-005 R B TIC EMBEDDED SYSTEMS LABORATORY On the Observability and Self-Calibration of Visual-Inertial
More informationJoint GPS and Vision Estimation Using an Adaptive Filter
1 Joint GPS and Vision Estimation Using an Adaptive Filter Shubhendra Vikram Singh Chauhan and Grace Xingxin Gao, University of Illinois at Urbana-Champaign Shubhendra Vikram Singh Chauhan received his
More informationFIBER OPTIC GYRO-BASED ATTITUDE DETERMINATION FOR HIGH- PERFORMANCE TARGET TRACKING
FIBER OPTIC GYRO-BASED ATTITUDE DETERMINATION FOR HIGH- PERFORMANCE TARGET TRACKING Elias F. Solorzano University of Toronto (Space Flight Laboratory) Toronto, ON (Canada) August 10 th, 2016 30 th AIAA/USU
More informationVisual SLAM Tutorial: Bundle Adjustment
Visual SLAM Tutorial: Bundle Adjustment Frank Dellaert June 27, 2014 1 Minimizing Re-projection Error in Two Views In a two-view setting, we are interested in finding the most likely camera poses T1 w
More informationROBOTICS 01PEEQW. Basilio Bona DAUIN Politecnico di Torino
ROBOTICS 01PEEQW Basilio Bona DAUIN Politecnico di Torino Probabilistic Fundamentals in Robotics Gaussian Filters Course Outline Basic mathematical framework Probabilistic models of mobile robots Mobile
More informationOn Underweighting Nonlinear Measurements
On Underweighting Nonlinear Measurements Renato Zanetti The Charles Stark Draper Laboratory, Houston, Texas 7758 Kyle J. DeMars and Robert H. Bishop The University of Texas at Austin, Austin, Texas 78712
More informationQuaternion based Extended Kalman Filter
Quaternion based Extended Kalman Filter, Sergio Montenegro About this lecture General introduction to rotations and quaternions. Introduction to Kalman Filter for Attitude Estimation How to implement and
More informationUsing the Kalman Filter for SLAM AIMS 2015
Using the Kalman Filter for SLAM AIMS 2015 Contents Trivial Kinematics Rapid sweep over localisation and mapping (components of SLAM) Basic EKF Feature Based SLAM Feature types and representations Implementation
More informationSpace Surveillance with Star Trackers. Part II: Orbit Estimation
AAS -3 Space Surveillance with Star Trackers. Part II: Orbit Estimation Ossama Abdelkhalik, Daniele Mortari, and John L. Junkins Texas A&M University, College Station, Texas 7783-3 Abstract The problem
More informationOne Approach to the Integration of Inertial and Visual Navigation Systems
FATA UNIVERSITATIS (NIŠ) SER.: ELE. ENERG. vol. 18, no. 3, December 2005, 479-491 One Approach to the Integration of Inertial and Visual Navigation Systems Dedicated to Professor Milić Stojić on the occasion
More informationALARGE number of applications require robots to move in
IEEE TRANSACTIONS ON ROBOTICS, VOL. 22, NO. 5, OCTOBER 2006 917 Optimal Sensor Scheduling for Resource-Constrained Localization of Mobile Robot Formations Anastasios I. Mourikis, Student Member, IEEE,
More informationTSRT14: Sensor Fusion Lecture 9
TSRT14: Sensor Fusion Lecture 9 Simultaneous localization and mapping (SLAM) Gustaf Hendeby gustaf.hendeby@liu.se TSRT14 Lecture 9 Gustaf Hendeby Spring 2018 1 / 28 Le 9: simultaneous localization and
More informationVN-100 Velocity Compensation
VN-100 Velocity Compensation Velocity / Airspeed Aiding for AHRS Applications Application Note Abstract This application note describes how the VN-100 can be used in non-stationary applications which require
More informationLecture 7: Optimal Smoothing
Department of Biomedical Engineering and Computational Science Aalto University March 17, 2011 Contents 1 What is Optimal Smoothing? 2 Bayesian Optimal Smoothing Equations 3 Rauch-Tung-Striebel Smoother
More informationDistributed estimation in sensor networks
in sensor networks A. Benavoli Dpt. di Sistemi e Informatica Università di Firenze, Italy. e-mail: benavoli@dsi.unifi.it Outline 1 An introduction to 2 3 An introduction to An introduction to In recent
More informationMotion Tracking with Fixed-lag Smoothing: Algorithm and Consistency Analysis
Motion Tracking with Fixed-lag Smoothing: Algorithm and Consistency Analysis Tue-Cuong Dong-Si and Anastasios I Mourikis Dept of Electrical Engineering, University of California, Riverside E-mail: tdong@studentucredu,
More informationAutonomous Mobile Robot Design
Autonomous Mobile Robot Design Topic: Inertial Measurement Unit Dr. Kostas Alexis (CSE) Where am I? What is my environment? Robots use multiple sensors to understand where they are and how their environment
More informationOn Filter Consistency of Discrete-time Nonlinear Systems with Partial-state Measurements
On Filter Consistency of Discrete-time Nonlinear Systems with Partial-state Measurements Guoquan P Huang and Stergios I Roumeliotis Abstract Linearized filters, such as the extended Kalman filter EKF),
More informationNAVIGATION OF THE WHEELED TRANSPORT ROBOT UNDER MEASUREMENT NOISE
WMS J. Pure Appl. Math. V.7, N.1, 2016, pp.20-27 NAVIGAION OF HE WHEELED RANSPOR ROBO UNDER MEASUREMEN NOISE VLADIMIR LARIN 1 Abstract. he problem of navigation of the simple wheeled transport robot is
More informationCOS Lecture 16 Autonomous Robot Navigation
COS 495 - Lecture 16 Autonomous Robot Navigation Instructor: Chris Clark Semester: Fall 011 1 Figures courtesy of Siegwart & Nourbakhsh Control Structure Prior Knowledge Operator Commands Localization
More informationOn the Performance of Multi-robot Target Tracking
On the Performance of Multi-robot arget racking Faraz M. Mirzaei, Anastasios I. Mourikis, and Stergios I. Roumeliotis Abstract In this paper, we study the accuracy of Cooperative Localization and arget
More informationProprioceptive Navigation, Slip Estimation and Slip Control for Autonomous Wheeled Mobile Robots
Proprioceptive Navigation, Slip Estimation and Slip Control for Autonomous Wheeled Mobile Robots Martin Seyr Institute of Mechanics and Mechatronics Vienna University of Technology martin.seyr@tuwien.ac.at
More informationSystem identification and sensor fusion in dynamical systems. Thomas Schön Division of Systems and Control, Uppsala University, Sweden.
System identification and sensor fusion in dynamical systems Thomas Schön Division of Systems and Control, Uppsala University, Sweden. The system identification and sensor fusion problem Inertial sensors
More informationProbabilistic Fundamentals in Robotics. DAUIN Politecnico di Torino July 2010
Probabilistic Fundamentals in Robotics Gaussian Filters Basilio Bona DAUIN Politecnico di Torino July 2010 Course Outline Basic mathematical framework Probabilistic models of mobile robots Mobile robot
More informationControl of a Car-Like Vehicle with a Reference Model and Particularization
Control of a Car-Like Vehicle with a Reference Model and Particularization Luis Gracia Josep Tornero Department of Systems and Control Engineering Polytechnic University of Valencia Camino de Vera s/n,
More informationMeasurement Observers for Pose Estimation on SE(3)
Measurement Observers for Pose Estimation on SE(3) By Geoffrey Stacey u4308250 Supervised by Prof. Robert Mahony 24 September 2010 A thesis submitted in part fulfilment of the degree of Bachelor of Engineering
More informationSigma-Point Kalman Filters for Integrated Navigation
Sigma-Point Kalman Filters for Integrated Navigation Rudolph van der Merwe and Eric A. Wan Adaptive Systems Lab, OGI School of Science & Engineering, Oregon Health & Science University BIOGRAPHY Rudolph
More informationSigma-Point Kalman Filters for Nonlinear Estimation and Sensor-Fusion - Applications to Integrated Navigation - Rudolph van der Merwe and Eric A.
Sigma-Point Kalman Filters for Nonlinear Estimation and Sensor-Fusion - Applications to Integrated Navigation - Rudolph van der Merwe and Eric A. Wan OGI School of Science & Engineering, Oregon Health
More informationAided Inertial Navigation With Geometric Features: Observability Analysis
Aided Inertial Navigation With Geometric Features: Observability Analysis Yulin Yang - yuyang@udel.edu Guoquan Huang - ghuang@udel.edu Department of Mechanical Engineering University of Delaware, Delaware,
More informationUsing Match Uncertainty in the Kalman Filter for a Sonar Based Positioning System
Using atch Uncertainty in the Kalman Filter for a Sonar Based ositioning System Oddbjørn Bergem, Claus Siggaard Andersen, Henrik Iskov Christensen Norwegian Defence Research Establishment, Norway Laboratory
More informationAdaptive Unscented Kalman Filter with Multiple Fading Factors for Pico Satellite Attitude Estimation
Adaptive Unscented Kalman Filter with Multiple Fading Factors for Pico Satellite Attitude Estimation Halil Ersin Söken and Chingiz Hajiyev Aeronautics and Astronautics Faculty Istanbul Technical University
More informationReduced Sigma Point Filters for the Propagation of Means and Covariances Through Nonlinear Transformations
1 Reduced Sigma Point Filters for the Propagation of Means and Covariances Through Nonlinear Transformations Simon J. Julier Jeffrey K. Uhlmann IDAK Industries 91 Missouri Blvd., #179 Dept. of Computer
More informationDetermining absolute orientation of a phone by imaging celestial bodies
Technical Disclosure Commons Defensive Publications Series October 06, 2017 Determining absolute orientation of a phone by imaging celestial bodies Chia-Kai Liang Yibo Chen Follow this and additional works
More informationConsistent Triangulation for Mobile Robot Localization Using Discontinuous Angular Measurements
Seminar on Mechanical Robotic Systems Centre for Intelligent Machines McGill University Consistent Triangulation for Mobile Robot Localization Using Discontinuous Angular Measurements Josep M. Font Llagunes
More informationThe Scaled Unscented Transformation
The Scaled Unscented Transformation Simon J. Julier, IDAK Industries, 91 Missouri Blvd., #179 Jefferson City, MO 6519 E-mail:sjulier@idak.com Abstract This paper describes a generalisation of the unscented
More informationScalable Sparsification for Efficient Decision Making Under Uncertainty in High Dimensional State Spaces
Scalable Sparsification for Efficient Decision Making Under Uncertainty in High Dimensional State Spaces IROS 2017 KHEN ELIMELECH ROBOTICS AND AUTONOMOUS SYSTEMS PROGRAM VADIM INDELMAN DEPARTMENT OF AEROSPACE
More informationA Rocket Experiment for Measurement Science Education
Journal of Physics: Conference Series PAPER OPEN ACCESS A Rocket Experiment for Measurement Science Education To cite this article: T Mitterer et al 2018 J. Phys.: Conf. Ser. 1065 022005 View the article
More informationPredicting the Performance of Cooperative Simultaneous Localization and Mapping (C-SLAM)
1 Predicting the Performance of Cooperative Simultaneous Localization and Mapping (C-SLAM) Anastasios I. Mourikis and Stergios I. Roumeliotis Dept. of Computer Science & Engineering, University of Minnesota,
More informationSemi-Analytical Guidance Algorithm for Fast Retargeting Maneuvers Computation during Planetary Descent and Landing
ASTRA 2013 - ESA/ESTEC, Noordwijk, the Netherlands Semi-Analytical Guidance Algorithm for Fast Retargeting Maneuvers Computation during Planetary Descent and Landing Michèle LAVAGNA, Paolo LUNGHI Politecnico
More informationA Monocular Vision-aided Inertial Navigation System with Improved Numerical Stability
AIAA SciTech 5-9 January 215, Kissimmee, Florida AIAA Guidance, Navigation, and Control Conference AIAA 215-97 A Monocular Vision-aided Inertial Navigation System with Improved Numerical Stability Daniel
More informationVlad Estivill-Castro. Robots for People --- A project for intelligent integrated systems
1 Vlad Estivill-Castro Robots for People --- A project for intelligent integrated systems V. Estivill-Castro 2 Probabilistic Map-based Localization (Kalman Filter) Chapter 5 (textbook) Based on textbook
More informationRobotics. Mobile Robotics. Marc Toussaint U Stuttgart
Robotics Mobile Robotics State estimation, Bayes filter, odometry, particle filter, Kalman filter, SLAM, joint Bayes filter, EKF SLAM, particle SLAM, graph-based SLAM Marc Toussaint U Stuttgart DARPA Grand
More information