APM firmware for copter