Integrate IMU into commmandbase and holly