Minor changes. Head hold tested. It work.
Level stabilization work.
Dynamic stabilization work.
Baro altitude hold work.
Head hold work.
All tests passed.