srv: added setpoint pos srv