Add fake wind to waypoint nav

trying to make waypoint moving more smooth
slow the circle rate down when UAV cannot catch up