Updated bit masking errors, fixed (mostly) the state machine)
Added FLOPS test to the makefile
Continued testing of MPU library and I2C function
Added PID loops