Offboard2 merge

This is my offboard branch on top of the navigator_rewrite and the offboard2 branch.
Sorry that I missed this during review, but this is simply incorrect! When _pos_sp_triplet.current.vz = 0 (velocity = 0) altitude will be decreased at max rate. Also deadzone is not needed here.