set current waypoint on mavlink
set new current waypoint
Merge branch 'os_dev' of https://github.com/moon-bear/firmware into mavlink
Create task "gps_simulator_task"
Create the fake gps data array