diff --git a/Roboid.cpp b/Roboid.cpp index 29a05ed..a98cad1 100644 --- a/Roboid.cpp +++ b/Roboid.cpp @@ -30,7 +30,6 @@ Roboid::Roboid(Propulsion *propulsion) : Roboid() { propulsion->roboid = this; } -#include void Roboid::Update(unsigned long currentTimeMs) { if (perception != nullptr) perception->Update(currentTimeMs); @@ -41,12 +40,12 @@ void Roboid::Update(unsigned long currentTimeMs) { float deltaTime = (float)(currentTimeMs - lastUpdateTimeMs) / 1000; this->linearVelocity = this->propulsion->GetVelocity(); - this->angularVelocity = this->propulsion->GetAngularVelocity(); Spherical16 translation = this->orientation * this->linearVelocity * deltaTime; SetPosition(this->position + translation); + this->angularVelocity = this->propulsion->GetAngularVelocity(); SwingTwist16 rotation = SwingTwist16::AngleAxis(this->angularVelocity.distance * deltaTime, this->angularVelocity.direction);