BeagleDrone
BeagleDrone copied to clipboard
control (stabilize) routine
Should try and stabilize drone state around the modifiable setpoint
The PID code exists in state.c, application to motors doesnt exist and no tests yet