Multiwii GPS firm for I2C GPS NAV MODULE