Fix I2C write function
imu demo working
Add DDSIMU example
Update README.md accordingly