Large number of changes

- Changed the format of SENSORLIB; it now closely matches the Adafruit
library
- Changed the way we were implementing the fourth order filter, it now
should work.
- Changed various formatting in Quadcopter.h