GPS_IMU_Kalman_Filter
GPS_IMU_Kalman_Filter copied to clipboard
jacobian calculate error
In calculate_jacobian function, r13 should be turn_radius * ( cos(dt*psi_dot + psi) - cos(psi) ).
agree with you!
@yvesguo you are right
@karanchawla it seems that you are calculating the jacobian wrong, I just checked it and as @yvesguo suggested r13 should be replaced.
can I ask where the jacobian equations from