diff --git a/src/bno055_imu_ros_driver.cpp b/src/bno055_imu_ros_driver.cpp
index 3dfa7022dfd691011da6f6d84868f1ce7067d101..544384b1494c8c1b73eccd670f02fd85937ca76e 100644
--- a/src/bno055_imu_ros_driver.cpp
+++ b/src/bno055_imu_ros_driver.cpp
@@ -73,6 +73,7 @@ bool Bno055ImuDriver::startDriver(void)
   {
     try{
       this->imu_device->set_operation_mode(config_mode);
+      this->imu_device->set_sensor_units(false,true);
       this->imu_device->set_data_rate(this->config_.update_rate);
       this->imu_device->set_accel_config(this->config_.accel_range,this->config_.accel_bandwidth,this->config_.accel_pwr_mode);
       this->imu_device->set_gyro_config(this->config_.gyro_range,this->config_.gyro_bandwidth,this->config_.gyro_pwr_mode);