added imu functionality and shutdown when unrecoverable CAN problem detected