assistedcontrol: tested braking and auto thrust

1. adding starting velocity to pathDesired as a basis to reduce teh velocity over time via the brake rate
2. fixed stick interactions in manualcontrol.c
3. rewrote pathfollower for specific braking velocity reduction