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