stabilize_hil: Add HIL stabilization demo.

- The PI loops are not working 100% correctly yet.
- Works with MAVProxy's HIL module.