Mindboards

Code: Select all

 
byte CMD_Read[] = {0x90, 0x84};
 byte CMD_StartWrite[] = {0x91};
 byte cnt = 18;
 byte inBuffer[];
 char result;
 bool BResult;
 string resultBuffer;

 task main() {
      SetSensorLowspeed(S1);
      result = I2CWrite(S1, 2, CMD_Read);
      Wait(10);
      if (result == NO_ERR){
       TextOut(0, LCD_LINE1, "Write OK!");
      }
      BResult = I2CBytes(S1, CMD_StartWrite, cnt, inBuffer);
      result = I2CStatus(S1, cnt);
      if (result == NO_ERR){
       TextOut(0, LCD_LINE2, "Bytes OK!");
      }
      resultBuffer = ByteArrayToStr(inBuffer);
      TextOut(0, LCD_LINE4, resultBuffer);
      Wait(SEC_5);
 }

Code: Select all

void MyI2CRead(byte port, byte addr, byte reg, byte cnt, byte& outbuf[])
{
  byte cmdbuf[];  // register number holder
	int             loop;
	byte            nByteReady = 0;

  ArrayBuild(cmdbuf, addr, reg);

  loop = STAT_COMM_PENDING;              //Wait until bus is free
  while (loop == STAT_COMM_PENDING ){    //        ''
    loop = I2CStatus(port, nByteReady);  //        ''
  }                                      //        ''

  I2CBytes(port, cmdbuf, cnt, outbuf)    //Read the registers
}

void MyI2CWrite(byte port, byte addr, byte reg, byte data[])
{
  byte cmdbuf[];                         //register data
  int loop, n, nByteReady;

  ArrayBuild(cmdbuf, addr, reg, data);

  loop = STAT_COMM_PENDING;              //Wait until bus is free
  while (loop == STAT_COMM_PENDING ){    //        ''
    loop = I2CStatus(port, nByteReady);  //        ''
  }                                      //        ''
  
  n = I2CWrite(port, 0, cmdbuf);        //When the I2C bus is ready, send the message you built
  while (I2CStatus(port, nByteReady) ==  STAT_COMM_PENDING); //Wait until bus is free
}