Attention: Answers.ros.org is deprecated as of August the 11th, 2023. Please visit robotics.stackexchange.com to ask a new question. This site will remain online in read-only mode during the transition and into the foreseeable future. Selected questions and answers have been migrated, and redirects have been put in place to direct users to the corresponding questions on Robotics Stack Exchange. Additional details are available here.

Revision history [back]

Short answer would be that you cannot have multiple governing equations for your system dynamics. My suggestions is to simplify your dynamics, propagate your system model using only the longitudinal acceleration sensor value from your IMU. The rest of your state can be constrained and you can simply propagate them at each time-step with no change.

ROS Answers is licensed under Creative Commons Attribution 3.0 Content on this site is licensed under a Creative Commons Attribution Share Alike 3.0 license.