The arduino code based on FreeIMU library