Add Error Print Fuction
Fix Read Bug
Read Gyro and Aceel