Small INAV controller and measurement system algorithm research using model aircraft.