Corrected measurement keeps growing
Hi! We are currently developing a AUV, and we want to use the robot_localization pkg for our state estimation. We use an IMU and a DVL (with pressure and ahrs measurements) to estimate the state of the drone. While the raw measurements are correct, the transformed measurements (from sensor frame to odom) are constantly growing. In the debug file, these growing measurements can be found in the Ekf::predict step (... Topic is: pose0 Measurement is: ["THESE ARE GROWING"] ...). How can that be? I believed the measurements used in the ekf are the raw measurement transformed to the target frame, which is a static transform. So as long as the raw measurements are not growing, these measurements should not either?
add a comment
