Clean up main.c, Move GY-801 sensor code to corresponding .c file

Sensor code on main.c is moved to gy801.c named `GY801_Task`.
Helper function moved to misc.c, declaration at main.h.
Clean up some I2C function for the use of operating system(not done)
Seperate read and processing task, switch to FIFO mode.