Only move copter if target not reached.
Refactoring done, scaleBuffer now 0.1 ms faster!

And it looks pretty!