Code reading from the IMU and Motors, printing Quaternions