A lightweight autopilot software for Pixhawk