Revert last encoder readings that came after imu crash signal

Fixes #65