Add IMU init and reset function

- This is IMU initialization is required due to the hardware change
- Not Implemented in firmware
- Add Pin IMU_EN(P1_0)
Merge pull request #3 from zhaoruibing/upstream

Add IMU init and reset functions.