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 {
PositionVector direction = new PositionVector(targetPosition);
direction.subtract(currentPosition);
direction.normalize();
topologyComponent.updateCurrentDirection(direction);
direction.multiplyScalar(velocity * timefactor);
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