Modify i2c driver
Merge branch 'stable_2.6.x' of github.com:PSAScapstone2014/ChibiOS-RT into stable_2.6.x