Replace to use mpu6050 read/write function
Add mpu6050 reset function
Remove the old i2c read/write function
Fix the mpu6050 data byte high/low mapping issue
Rename the mpu6050 read raw data function
Revert "Fix the moving average FIFO not weighting issue"

This reverts commit 7c54273b4fe1bda462ce8e728fab2b5f49e20797.
Set the I2C1 clock speed to be 400,000 (400k)