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,

ẋ,

ẏ,

ẍ,

ÿ }

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?

$\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 '20 at 18:47

This site is temporarily in read only mode and not accepting new answers.

Browse other questions tagged .