IMU calibration size fix
Changed so states are sent correctly