Made changes to the imu_testing project and it is working now