Head hold under test.
Added head hold stabilization. Added MA filter for RC YAW input. Changed input for YAW pid from RC yaw to head hold angle. Should be tested.