Updated circular test to publish correct IMU stamp

- correct imu stamp
- minor changes