mission: fix current mission index
mission: fix current mission index

This was wrong, we should only increment the index when a new waypoint
with a location is added.

dronecore/DroneCore,dronecore/DroneCore,dronecore/DroneCore,dronecore/DroneCore