Fix the quaternion parameters
parent
3f6933a220
commit
a6469f57a6
|
@ -232,9 +232,9 @@ void loop() {
|
||||||
diff = q.getProduct(pq.getConjugate());
|
diff = q.getProduct(pq.getConjugate());
|
||||||
|
|
||||||
// Quaternion - rotacija
|
// Quaternion - rotacija
|
||||||
bundle.add("/quaternion").add(q.w).add(q.y).add(q.x).add(q.z); // W X Y Z
|
bundle.add("/quaternion").add(q.w).add(q.y * -1).add(q.z).add(q.x * -1); // W X Y Z
|
||||||
// Quaterion difference - rotacijska razlika (prejsnji reading - trenutni reading)
|
// Quaterion difference - rotacijska razlika (prejsnji reading - trenutni reading)
|
||||||
bundle.add("/quaternionDiff").add(diff.w).add(diff.y).add(diff.x).add(diff.z); // W X Y Z
|
bundle.add("/quaternionDiff").add(diff.w).add(diff.y * -1).add(diff.z).add(diff.x * -1); // W X Y Z
|
||||||
|
|
||||||
#ifdef OUTPUT_READABLE_REALACCEL
|
#ifdef OUTPUT_READABLE_REALACCEL
|
||||||
// display real acceleration, adjusted to remove gravity
|
// display real acceleration, adjusted to remove gravity
|
||||||
|
|
Loading…
Reference in New Issue