RoboidControl/RoboidControl-cpp
RoboidControl/RoboidControl-cpp
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Corrected model orientation

Browse Source
This commit is contained in:
Pascal Serrarens 2025-02-27 12:07:56 +01:00
parent c7650f1be1
commit 7a9df4aec5
1 changed files with 2 additions and 1 deletions

3
Messages/LowLevelMessages.cpp

@ -1,6 +1,7 @@
#include "LowLevelMessages.h" #include "LowLevelMessages.h"
#include "LinearAlgebra/float16.h" #include "LinearAlgebra/float16.h"
#include <iostream>
namespace RoboidControl { namespace RoboidControl {
@ -65,7 +66,7 @@ void LowLevelMessages::SendQuat32(char* buffer, unsigned char* ix, SwingTwist16
qz = -qz; qz = -qz;
qw = -qw; qw = -qw;
} }
// Serial.printf(" (%d) %d:%d:%d:%d ", startIndex, qx, qy, qz, qw); // std::cout << (int)qx << "," << (int)qy << "," << (int)qz << "," << (int)qw << "\n";
buffer[(*ix)++] = qx; buffer[(*ix)++] = qx;
buffer[(*ix)++] = qy; buffer[(*ix)++] = qy;
buffer[(*ix)++] = qz; buffer[(*ix)++] = qz;