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);