Working code using Energia libraries
I2C lib now uses Wire.h from Energia

I2C interface now fully working(...?), just needs last commands.