diff --git a/NetworkSync.cpp b/NetworkSync.cpp index fe375e9..194656c 100644 --- a/NetworkSync.cpp +++ b/NetworkSync.cpp @@ -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 packedAngle = AngleUsing(angle); - data[startIndex] = packedAngle.GetValue(); -} +// void NetworkSync::SendAngle(unsigned char *data, unsigned int startIndex, +// const float angle) { +// AngleUsing packedAngle = AngleUsing(angle); +// data[startIndex] = packedAngle.GetValue(); +// } -void NetworkSync::SendAngle16(unsigned char *data, unsigned int startIndex, - const float angle) { - AngleUsing packedAngle = AngleUsing(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 packedAngle = AngleUsing(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 packedAngle = AngleUsing(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 packedAngle = AngleUsing(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) {