Px4 trajectory setpoint