Added test commands for IMU. We are still reading all zeros for the byte array so there are still bugs to be fixed.