Bug fix :
Throttle and setpoints werre not passed to PID