Comments (4)
Hi,
what are the sensors you want to integrate? The package will probably get released in summer.
Simon
from ethzasl_sensor_fusion.
Hi,
first of all, thanks for sharing this ros package! I'm trying to use it as a starting point for a robust fusion algorithm for a car like vehicle. Besides other sensors, the car has an IMU and encoders on the wheels. These sensors (IMU and encoders) publish their data synchronized at 100Hz.
The encoders are used as velocity sensors. If I use one big H matrix for all encoders, it works fine. As far as I understand EKFs, it should be allowed to serialize the update step by splitting the residual vector r, the H matrix and the R matrix in smaller chunks and calling the update step several times with the different chunks of r, H and R (e.g. A. Gelb "Applied Optimal Estimation"). If I use separate H matrices and residual vectors and then call measruements->ssf_core.applyMeasurement(...) for each sensor directly, the filter diverges and after a short time it outputs NANs.
When I looked through the code of ssf_core, I couldn't find any reason why it should not be possible to call applyMeasurements(...) several times directly one after the other with the different chunks of r, H and R. The state_idx is the same for all calls.
So my question is, why is the current code not suitable for multi-sensor fusion? Are there any updates on the release date of your multi-sensor package?
Julian
from ethzasl_sensor_fusion.
Julian,
If you call applyMeasurement() two times with measurements with the same time stamps the first one gets overwritten by the second one:
- the first applyMeasurement() takes the time stamp of its corresponding measurement, goes back in the state history to apply the measurement at its correct place and propagates the states to the present time
- the second applyMeasurement() does exactly the same thing, but since the state in the history that matches best to the measurement time stamp did not get changed by the previous applyMeasurement() (only the following state got changed) all things will be overwritten.
The big change in the Multi Sensor Fusion (MSF) is that it can handle multiple measurements correctly even with different time delays.
A workaround in your case would be to call applyMeasurement() once and make sure that the next call uses a more recent state from the history than the first call. This is an approximation but since your IMU runs at 100Hz the time error where you apply the second measurement is maximum 5ms.
Hope this helps
Best
Stephan
From: Julian Löchner [[email protected]]
Sent: Wednesday, August 21, 2013 6:37 AM
To: ethz-asl/ethzasl_sensor_fusion
Subject: Re: [ethzasl_sensor_fusion] package roadmap (#7)
Hi,
first of all, thanks for sharing this ros package! I'm trying to use it as a starting point for a robust fusion algorithm for a car like vehicle. Besides other sensors, the car has an IMU and encoders on the wheels. These sensors (IMU and encoders) publish their data synchronized at 100Hz.
The encoders are used as velocity sensors. If I use one big H matrix for all encoders, it works fine. As far as I understand EKFs, it should be allowed to serialize the update step by splitting the residual vector r, the H matrix and the R matrix in smaller chunks and calling the update step several times with the different chunks of r, H and R (e.g. A. Gelb "Applied Optimal Estimation"). If I use separate H matrices and residual vectors and then call measruements->ssf_core.applyMeasurement(...) for each sensor directly, the filter diverges and after a short time it outputs NANs.
When I looked through the code of ssf_core, I couldn't find any reason why it should not be possible to call applyMeasurements(...) several times directly one after the other with the different chunks of r, H and R. The state_idx is the same for all calls.
So my question is, why is the current code not suitable for multi-sensor fusion? Are there any updates on the release date of your multi-sensor package?
Julian
—
Reply to this email directly or view it on GitHubhttps://github.com//issues/7#issuecomment-23017304.
from ethzasl_sensor_fusion.
@TranMinhHoang have a look here: https://github.com/ethz-asl/ethzasl_msf
from ethzasl_sensor_fusion.
Related Issues (20)
- Catkinize this package and make compile on the build-server HOT 1
- Problem with the initialization of ethzasl_sensor_fusion HOT 8
- ethzasl_sensor_fusion ... no output data HOT 1
- strange accelerometer measurements of Microstrain MEMS IMU on an octocopter
- Erro Compiling - Serial port HOT 1
- form rxplot to rqt_plot ? HOT 4
- IMU and Sensor Coordinates confusion HOT 7
- Estimation Jitter Causing Instability HOT 1
- Can not find "PositionWithCovarianceStamped.h" HOT 2
- Tutorial worked first time only HOT 7
- Performance Expectation Issues
- issues on IMU-camera calibration HOT 1
- How can I generate the codes in file calcQ.h ? HOT 1
- When does the init() get called in pose_measurement.h?
- issue about the initial error state covariance P
- rosmake can't build HOT 4
- understanding about computing the quaternion integration in function propagateState()
- What kind of data is position of vicon?
- I can not visual the data
- Localization with Respect to an Object HOT 1
Recommend Projects
-
React
A declarative, efficient, and flexible JavaScript library for building user interfaces.
-
Vue.js
🖖 Vue.js is a progressive, incrementally-adoptable JavaScript framework for building UI on the web.
-
Typescript
TypeScript is a superset of JavaScript that compiles to clean JavaScript output.
-
TensorFlow
An Open Source Machine Learning Framework for Everyone
-
Django
The Web framework for perfectionists with deadlines.
-
Laravel
A PHP framework for web artisans
-
D3
Bring data to life with SVG, Canvas and HTML. 📊📈🎉
-
Recommend Topics
-
javascript
JavaScript (JS) is a lightweight interpreted programming language with first-class functions.
-
web
Some thing interesting about web. New door for the world.
-
server
A server is a program made to process requests and deliver data to clients.
-
Machine learning
Machine learning is a way of modeling and interpreting data that allows a piece of software to respond intelligently.
-
Visualization
Some thing interesting about visualization, use data art
-
Game
Some thing interesting about game, make everyone happy.
Recommend Org
-
Facebook
We are working to build community through open source technology. NB: members must have two-factor auth.
-
Microsoft
Open source projects and samples from Microsoft.
-
Google
Google ❤️ Open Source for everyone.
-
Alibaba
Alibaba Open Source for everyone
-
D3
Data-Driven Documents codes.
-
Tencent
China tencent open source team.
from ethzasl_sensor_fusion.