run_waypoints2 should be fixed now.
Merge branch 'master' of https://github.com/crazyoldmans/picopter