修改打印频率

iic_6dof_imu/iic_6dof_imu.ino

@@ -28,5 +28,5 @@ void loop()
   imuData.GetQuater();
   Serial.print("Quater:");Serial.print((float)imuData.stcQuater.q[0]/32768);Serial.print(" ");Serial.print((float)imuData.stcQuater.q[1]/32768);Serial.print(" ");Serial.print((float)imuData.stcQuater.q[2]/32768);Serial.print(" ");Serial.println((float)imuData.stcQuater.q[3]/32768);
   Serial.println("");
-  delay(500);
+  delay(100);
 }

serial_6dof_imu/imuData.cpp

@@ -40,6 +40,7 @@ void ImuDataClass ::CopeSerialData(unsigned char ucData)
 			case 0x56:	memcpy(&stcPress,&ucRxBuffer[2],8);break;
 			case 0x57:	memcpy(&stcLonLat,&ucRxBuffer[2],8);break;
 			case 0x58:	memcpy(&stcGPSV,&ucRxBuffer[2],8);break;
+      case 0x59:  memcpy(&stcQuater,&ucRxBuffer[2],8);break;
 		}
 		ucRxCnt=0;
 	}

serial_6dof_imu/serial_6dof_imu.ino

@@ -23,7 +23,7 @@ void loop()
   Serial.print("Quater:");Serial.print((float)imuData.stcQuater.q[0]/32768);Serial.print(" ");Serial.print((float)imuData.stcQuater.q[1]/32768);Serial.print(" ");Serial.print((float)imuData.stcQuater.q[2]/32768);Serial.print(" ");Serial.println((float)imuData.stcQuater.q[3]/32768);
   
   Serial.println("");
-  delay(500);
+  delay(00);
 }
 
 /*