added states and controls for kinematic IMU model