Merge pull request #47 from pstephen43/master

sync up
fixed gyro issue
added more gyro fixes
added more pos 5 stuff
Merge pull request #216 from PJTNT11/master

snuff