Update perceived objects

2024-04-18 17:24:20 +02:00 · 2024-04-18 17:24:20 +02:00 · 2a221a0c22
commit 2a221a0c22
parent 70b068f870
1 changed files with 8 additions and 1 deletions
--- a/Roboid.cpp
+++ b/Roboid.cpp
@ -44,8 +44,15 @@ void Roboid::Update(float currentTimeMs) {
  if (perception != nullptr)
    perception->Update(currentTimeMs);

-  if (propulsion != nullptr)
+  if (propulsion != nullptr) {
    propulsion->Update(currentTimeMs);
+    SetPosition(this->worldPosition +
+                this->worldOrientation * Vector3::forward *
+                    this->propulsion->GetVelocity().distance);
+    SetOrientation(this->worldOrientation *
+                   Quaternion::AngleAxis(this->propulsion->GetAngularVelocity(),
+                                         Vector3::up));
+  }

  if (networkSync != nullptr)
    networkSync->NetworkUpdate(this);