Simple mode

Kenny, feel free to deny this pull request.  I'm just testing to see how this is done.  This branch has my implementation of simple mode flying.  I commented out rate mode.  We need way to have user select which switches will enable stable/acro/simple flight modes.