WP_Nav: bug fix to  spline support

Origin was not set properly for existing straight line wpnav controller
Copter: fix to integration of spline

Fixes incorrect checks re whether there are delays at origin or
destination
Copter: minor format change