Some changes to ArduCopter.pde