mirror of
https://github.com/PotentiaRobotics/engine-software.git
synced 2025-04-21 12:30:16 -04:00
Current code, need to fine tune delays
This commit is contained in:
parent
2c635f770d
commit
b05b481d89
|
@ -318,14 +318,14 @@ void loop() {
|
||||||
#ifdef OUTPUT_READABLE_QUATERNION
|
#ifdef OUTPUT_READABLE_QUATERNION
|
||||||
// display quaternion values in easy matrix form: w x y z
|
// display quaternion values in easy matrix form: w x y z
|
||||||
mpu.dmpGetQuaternion(&q, fifoBuffer);
|
mpu.dmpGetQuaternion(&q, fifoBuffer);
|
||||||
Serial.print("quat\t");
|
/*Serial.print("quat\t");
|
||||||
Serial.print(q.w);
|
Serial.print(q.w);
|
||||||
Serial.print("\t");
|
Serial.print("\t");
|
||||||
Serial.print(q.x);
|
Serial.print(q.x);
|
||||||
Serial.print("\t");
|
Serial.print("\t");
|
||||||
Serial.print(q.y);
|
Serial.print(q.y);
|
||||||
Serial.print("\t");
|
Serial.print("\t");
|
||||||
Serial.println(q.z);
|
Serial.println(q.z);*/
|
||||||
t1 = String(q.w)+" "+String(q.x)+" "+String(q.y)+" "+String(q.z);
|
t1 = String(q.w)+" "+String(q.x)+" "+String(q.y)+" "+String(q.z);
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
@ -407,14 +407,14 @@ void loop() {
|
||||||
#ifdef OUTPUT_READABLE_QUATERNION
|
#ifdef OUTPUT_READABLE_QUATERNION
|
||||||
// display quaternion values in easy matrix form: w x y z
|
// display quaternion values in easy matrix form: w x y z
|
||||||
mpu2.dmpGetQuaternion(&q, fifoBuffer2);
|
mpu2.dmpGetQuaternion(&q, fifoBuffer2);
|
||||||
Serial.print("quat2\t");
|
/*Serial.print("quat2\t");
|
||||||
Serial.print(q.w);
|
Serial.print(q.w);
|
||||||
Serial.print("\t");
|
Serial.print("\t");
|
||||||
Serial.print(q.x);
|
Serial.print(q.x);
|
||||||
Serial.print("\t");
|
Serial.print("\t");
|
||||||
Serial.print(q.y);
|
Serial.print(q.y);
|
||||||
Serial.print("\t");
|
Serial.print("\t");
|
||||||
Serial.println(q.z);
|
Serial.println(q.z);*/
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#ifdef OUTPUT_READABLE_EULER
|
#ifdef OUTPUT_READABLE_EULER
|
||||||
|
|
Loading…
Reference in New Issue
Block a user