I2C major improvements for telosb

This is the I2C improvement done by Steve Ayer for the Shimmer platform
and now modified for the telosb platform.
Tested with LM75 temperature sensor.