add TEST mode without IMU