navigator: support combined position and speed setpoint commands

@julianoes: this extends the setpoint to velocity and acceleration, just as an input for your navigator rewrite