minor changed to I2C_Controller codes
added process magnetometer, need to fix bug related to compass rotational angle