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

Disable compact angle support

Browse Source
This commit is contained in:
Pascal Serrarens 2024-04-17 15:22:19 +02:00
parent 4403f7a341
commit e94eb397bb
1 changed files with 27 additions and 27 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

54
NetworkSync.cpp
View File

@ -7,9 +7,9 @@
#endif #endif
#include "LinearAlgebra/Angle.h" #include "LinearAlgebra/Angle.h"
#include "LinearAlgebra/Angle16.h" // #include "LinearAlgebra/Angle16.h"
#include "LinearAlgebra/Angle32.h" // #include "LinearAlgebra/Angle32.h"
#include "LinearAlgebra/AngleUsing.h" // #include "LinearAlgebra/AngleUsing.h"
#include "LinearAlgebra/Spherical.h" #include "LinearAlgebra/Spherical.h"
void NetworkSync::SendVector3(unsigned char *data, unsigned int startIndex, void NetworkSync::SendVector3(unsigned char *data, unsigned int startIndex,
@ -68,32 +68,32 @@ void NetworkSync::SendQuat32(unsigned char *data, int startIndex,
data[startIndex++] = qw; data[startIndex++] = qw;
} }
void NetworkSync::SendAngle(unsigned char *data, unsigned int startIndex, // void NetworkSync::SendAngle(unsigned char *data, unsigned int startIndex,
const float angle) { // const float angle) {
AngleUsing<unsigned char> packedAngle = AngleUsing<unsigned char>(angle); // AngleUsing<unsigned char> packedAngle = AngleUsing<unsigned char>(angle);
data[startIndex] = packedAngle.GetValue(); // data[startIndex] = packedAngle.GetValue();
} // }
void NetworkSync::SendAngle16(unsigned char *data, unsigned int startIndex, // void NetworkSync::SendAngle16(unsigned char *data, unsigned int startIndex,
const float angle) { // const float angle) {
AngleUsing<signed short> packedAngle = AngleUsing<signed short>(angle); // AngleUsing<signed short> packedAngle = AngleUsing<signed short>(angle);
signed short value = packedAngle.GetValue(); // signed short value = packedAngle.GetValue();
data[startIndex] = value >> 8; // data[startIndex] = value >> 8;
data[startIndex + 1] = value & 0xFF; // data[startIndex + 1] = value & 0xFF;
} // }
void NetworkSync::SendAngle32(unsigned char *data, unsigned int startIndex, // void NetworkSync::SendAngle32(unsigned char *data, unsigned int startIndex,
const float angle) { // const float angle) {
AngleUsing<signed long> packedAngle = AngleUsing<signed long>(angle); // AngleUsing<signed long> packedAngle = AngleUsing<signed long>(angle);
unsigned long value = packedAngle.GetValue(); // unsigned long value = packedAngle.GetValue();
data[startIndex] = value >> 24 & 0xFF; // data[startIndex] = value >> 24 & 0xFF;
data[startIndex + 1] = value >> 16 & 0xFF; // data[startIndex + 1] = value >> 16 & 0xFF;
data[startIndex + 2] = value >> 8 & 0xFF; // data[startIndex + 2] = value >> 8 & 0xFF;
data[startIndex + 3] = value & 0xFF; // data[startIndex + 3] = value & 0xFF;
// Serial.printf(" %lu=%d:%d:%d:%d ", value, data[startIndex], // // Serial.printf(" %lu=%d:%d:%d:%d ", value, data[startIndex],
// data[startIndex + 1], data[startIndex + 2], // // data[startIndex + 1], data[startIndex + 2],
// data[startIndex + 3]); // // data[startIndex + 3]);
} // }
void NetworkSync::SendSingle100(unsigned char *data, unsigned int startIndex, void NetworkSync::SendSingle100(unsigned char *data, unsigned int startIndex,
float value) { float value) {