Flight mode functions- ready to go

I've already did a 'git fetch upstream' an merged that with my master
Flight mode code is working, there is test code for the Arduino mini side and the file with the finished functions shows an example of how to call the function.

All the MultiWii code is very different from the original stuff, we will now be using very different code if we want to use flight modes on manual flight opposed to autonomous flying using flight modes.