Changed navigator to properly separate xy and z distance to waypoint

src/modules/navigator/mission_block.cpp

@@ -312,7 +312,7 @@ MissionBlock::is_mission_item_reached()
 
 			}
 
-			if (dist >= 0.0f && dist <= mission_acceptance_radius
+			if (dist_xy >= 0.0f && dist_xy <= mission_acceptance_radius
 			    && dist_z <= _navigator->get_altitude_acceptance_radius()) {
 				_waypoint_position_reached = true;
 			}