Had to make small changes to headers in quad inc

Readback on setpoints. This means that nav setpoints update when changed
in control graph view.

Now they do a good job of defaulting to the right setpoints