Consolidated sensor code, Single PID mode

Put all of the code for the various sensors into one tab. Tried to use
a single PID construct to control flight during stable mode.