ROS-service for IMU reset added: not yet working...