Inertial Navigation Integration Kalman FIlter

Please don't post Bullet support questions here, use the above forums instead.
catalin.dragosh
Posts: 1
Joined: Mon Mar 14, 2011 3:51 pm

Inertial Navigation Integration Kalman FIlter

Post by catalin.dragosh »

Hello,
I am trying to create a filter that can integrate inertial measurements with GPS measurements. My inertial sensors are a yaw axis gyro, an odometer, and possibly a 3axis accelerometer.
Could you please help me with some guidance? I have read papers, articles and books on the subject but I am still a little confused.
I consider the acceleration constant, so I have a state vector x=[E N v_E v_N a_E a_N], E and N are the positions in NED coordinate system, v_E and v_N are the speed on each axis, and a is the acceleration on each axis
The measurement vector z is [E_GPS N_GPS E_DR N_DR a_E a_N] where E_GPS and N_GPS are the coordinates obtained from the GPS receiver and E_DR and N_DR are the coordinates obtained from the inertial sensors through dead reckoning, and a is the acceleration obtained from the accelerometer.
F, the transformation matrix is: [1 0 dt 0 (dt^2)/2 0; 0 1 0 dt 0 (dt^2)/2; 0 0 1 0 dt 0; 0 0 0 1 0 dt; 0 0 0 0 0 1];
H, the measurement matrix is: [1 0 0 0 0 0; 0 1 0 0 0 0 ; 1 0 0 0 0 0; 0 1 0 0 0 0; 0 0 0 0 1 0; 0 0 0 0 0 1],
Does it make any sense so far? Should I chose a different state vector?
My problem is that I don't know, for this system how can I determine the process noise covariance and measurement noise covariance.
Can you give me some indications in that direction?
Thank you very much.