more wpm changes
try to find out if position is published or not
setpoint 0 set leads to local_sp_change, waypoint reached and change to next still to verify
working distance calc in local_tangent_plane, but workaround for local_pos_sp, cur does not work propperly
Merge branch 'gps_control_wednesday_lorenz' of https://github.com/daregger/Firmware into inertial_nav