Initial cleanup. Typo fixed, refactoring, support for PX4 autopilot modes.