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

Fix position send message

Browse Source
This commit is contained in:
Pascal Serrarens 2024-03-19 12:15:21 +01:00
parent 8a248814da
commit 141afa2772
2 changed files with 9 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
NetworkSync.cpp
View File

@ -9,8 +9,8 @@
void NetworkSync::SendVector3(unsigned char *data, unsigned int &startIndex,
const Vector3 v) {
SendSingle100(data, startIndex, v.x);
SendSingle100(data, startIndex += 4, v.y);
SendSingle100(data, startIndex += 8, v.z);
SendSingle100(data, startIndex, v.y);
SendSingle100(data, startIndex, v.z);
}
void NetworkSync::SendQuaternion(unsigned char *data, const int startIndex,
@ -19,7 +19,7 @@ void NetworkSync::SendQuaternion(unsigned char *data, const int startIndex,
int ix = startIndex;
SendAngle(data, ix++, angles.x);
SendAngle(data, ix++, angles.y);
SendAngle(data, ix, angles.z);
SendAngle(data, ix++, angles.z);
}
void NetworkSync::SendQuat32(unsigned char *data, int startIndex,
@ -46,7 +46,7 @@ void NetworkSync::SendAngle(unsigned char *data, const int startIndex,
data[startIndex] = packedAngle.GetValue();
}
void NetworkSync::SendSingle100(unsigned char *data, const int startIndex,
void NetworkSync::SendSingle100(unsigned char *data, unsigned int &startIndex,
float value) {
// Sends a float with truncated 2 decimal precision
Int32 intValue = value * 100;
@ -56,10 +56,10 @@ void NetworkSync::SendSingle100(unsigned char *data, const int startIndex,
// }
}
void NetworkSync::SendInt32(unsigned char *data, const int startIndex,
void NetworkSync::SendInt32(unsigned char *data, unsigned int &startIndex,
Int32 value) {
for (unsigned char ix = 0; ix < 4; ix++) {
data[startIndex + ix] = ((unsigned char *)&value)[ix];
data[startIndex++] = ((unsigned char *)&value)[ix];
}
}

5
NetworkSync.h
View File

@ -50,8 +50,9 @@ protected:
NetworkPerception *networkPerception;
void PublishTrackedObject(SendBuffer sendBuffer, InterestingThing *object);
void SendSingle100(unsigned char *data, const int startIndex, float value);
void SendInt32(unsigned char *data, const int startIndex, Int32 value);
void SendSingle100(unsigned char *data, unsigned int &startIndex,
float value);
void SendInt32(unsigned char *data, unsigned int &startIndex, Int32 value);
void SendAngle(unsigned char *data, const int startIndex, float value);
void SendVector3(unsigned char *data, unsigned int &startIndex,
const Vector3 v);