I2C MPU6050 works with EKF.

Notice :

In first use, All sensors need to be calibrated done.

Signed-off-by: cctsao1008 <chiacheng.tsao@gmail.com>