Changed timing to be more accurate in main loop. Still need to switch to micros(). Left that for Tridge. This gets rid of six floating point calcs *250. Nice!
ArduCopterMega -> ArduCopter added archives directory for old code