Tested and flown with ArduCopter 3.0.0-rc2

Some improvements to work with ArduCopter and cleanup.