State Estimation

IMU readings for Hip Roll, Pitch and Yaw motions: 

The readings seem coherent.

Comparisons of angular velocities: one coming from ROS Topic, another coming from Gazebo in ang_vel in the State Estimator.