From 2a221a0c22945e9d07f7ea41bc7c799293f3078a Mon Sep 17 00:00:00 2001
From: Pascal Serrarens <pascal@passervr.com>
Date: Thu, 18 Apr 2024 17:24:20 +0200
Subject: [PATCH] Update perceived objects

---
 Roboid.cpp | 9 ++++++++-
 1 file changed, 8 insertions(+), 1 deletion(-)

diff --git a/Roboid.cpp b/Roboid.cpp
index 34d4f7e..16db4f6 100644
--- 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);