Add a dynamic Waypoint editor according to NAV_CMD_TYPE

Continuing the work started by @azrin1972 at #276  and #277.