Instead of climbing/descending with max speed first and then fly straight, fly diagonally to new waypoint. This aligns the behavior between Mission and Hold modes.