2
$\begingroup$

I'm really sorry if this is a dumb question, but I don't have a clue on how to do this. I'm trying to write a kalman filter with a State vector of :

$$ {x, y, \dot{x}, \dot{y}, \ddot{x}, \ddot{y} } $$

To estimate the 2 dimensional position and velocity of a holonomic robot. Currently, I'm planning on fusing encoder odometry(50 hz, negligible latency), accelerometer data(50 hz, negligible latency), vision data (100 hz, 20 ms latency), and 3d vision data through solvepnp (20 hz, 20 ms latency). I'm hoping to get position and velocity data (+/- 1 meter, +/- 2 m/s respectively). How do I set up a filter for this using the apache commons math library?

Improve this question
$\endgroup$
1
  • $\begingroup$ Have you written and tested a simple kalman filter against a simple spring damper system? That's a useful exercise if you're new to this. $\endgroup$
    – holmeski
    Jul 2, 2020 at 18:47

0

Reset to default

Your Answer

By clicking “Post Your Answer”, you agree to our terms of service and acknowledge that you have read and understand our privacy policy and code of conduct.