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

Disabled perception update pose

Browse Source
This commit is contained in:
Pascal Serrarens 2024-12-02 09:17:00 +01:00
parent 3132912afc
commit 5c5d8b3189
1 changed files with 3 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
Roboid.cpp
View File

@ -49,13 +49,13 @@ void Roboid::Update(unsigned long currentTimeMs) {
SwingTwist16 rotation =
SwingTwist16::AngleAxis(this->angularVelocity.distance * deltaTime,
this->angularVelocity.direction);
if (perception != nullptr)
perception->UpdatePose(rotation);
// if (perception != nullptr)
// perception->UpdatePose(rotation);
SetOrientation(this->orientation * rotation);
}
if (childCount > 0 && children != nullptr) {
if (children != nullptr) {
for (unsigned char childIx = 0; childIx < this->childCount; childIx++)
children[childIx]->Update(currentTimeMs);
}
@ -108,12 +108,10 @@ void Roboid::AddChild(Thing *child) {
}
}
#include <Arduino.h>
void Passer::RoboidControl::Roboid::Release(Thing *child) {
if (RemoveChild(child) != nullptr) {
child->position = this->position;
child->orientation = this->orientation;
printf("obj distance %f\n", child->position.distance);
this->perception->AddTrackedObject(nullptr, child);
}
}