Plane: Fixed bug where NAV_LOITER_TO_ALT was not verifying heading.

NAV_LOITER_TO_ALT now verifying that the plane was heading
towards the next waypoint before breaking out of loiter IF the
first parameter of the mavlink message is not 0.