Try to avoid gimball lock in compass
Adjust timer
Add FreeIMU algorithm
Test FreeIMU algorithm