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

Fixed unit test

Browse Source
This commit is contained in:
Pascal Serrarens 2024-10-24 11:37:23 +02:00
parent db644af1ca
commit 3bc1866d34
1 changed files with 3 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
Perception.cpp
View File

@ -432,7 +432,6 @@ void Perception::Update(unsigned long currentTimeMs) {
} }
} }
#include <Arduino.h>
void Perception::UpdatePose(Polar16 translation) { void Perception::UpdatePose(Polar16 translation) {
for (unsigned char thingIx = 0; thingIx < maxObjectCount; thingIx++) { for (unsigned char thingIx = 0; thingIx < maxObjectCount; thingIx++) {
InterestingThing *thing = trackedObjects[thingIx]; InterestingThing *thing = trackedObjects[thingIx];
@ -471,9 +470,9 @@ void Perception::UpdatePose(Polar16 translation) {
Vector3 oldPos = thing->position.ToVector3(); Vector3 oldPos = thing->position.ToVector3();
Vector3 newPos = newPosition.ToVector3(); Vector3 newPos = newPosition.ToVector3();
printf(" update percepted position (%f 0 %f) -> (%f 0 %f)\n", // printf(" update percepted position (%f 0 %f) -> (%f 0 %f)\n",
oldPos.Right(), oldPos.Forward(), newPos.Right(), // oldPos.Right(), oldPos.Forward(), newPos.Right(),
newPos.Forward()); // newPos.Forward());
thing->position = newPosition; thing->position = newPosition;
} }