Send position setpoint via mavros

Ah about that, take a look at my response here Need help setting tf links on an iris