Commit f5763f3f authored by Julian Zobel's avatar Julian Zobel 🦄
Browse files

Set Direction in simple movement model

parent 12e538a4
...@@ -99,6 +99,7 @@ public class SimpleMulticopterMovement implements UAVMovementModel { ...@@ -99,6 +99,7 @@ public class SimpleMulticopterMovement implements UAVMovementModel {
PositionVector direction = new PositionVector(targetPosition); PositionVector direction = new PositionVector(targetPosition);
direction.subtract(currentPosition); direction.subtract(currentPosition);
direction.normalize(); direction.normalize();
topologyComponent.updateCurrentDirection(direction);
direction.multiplyScalar(velocity * timefactor); direction.multiplyScalar(velocity * timefactor);
PositionVector newPosition = new PositionVector(currentPosition); PositionVector newPosition = new PositionVector(currentPosition);
......
Markdown is supported
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment