CXPI2C function added. Not finished!