#pragma config(Sensor, S1,     ,               sensorI2CCustom)

const tSensors kSc8Port       = S1;   

task main()
{
   ubyte sc8Msg[5];
 
 position=1200;

  // Build the I2C message
  sc8Msg[kMsgSize]          = 3;
  sc8Msg[kSc8Address]       = 0xC2;
  sc8Msg[kSc8Servo]         = 63;
  sc8Msg[kData_low]         = (ubyte)position;

  while (nI2CStatus[kSc8Port] == STAT_COMM_PENDING)
  {
   // Wait for I2C bus to be ready
  }
  // when the I2C bus is ready, send the message you built
  sendI2CMsg(kSc8Port, &sc8Msg[0], 0);
 
  wait10Msec(100);
 
  position=1700;
 
    // Build the I2C message
  sc8Msg[kMsgSize]          = 3;
  sc8Msg[kSc8Address]       = 0xC2;
  sc8Msg[kSc8Servo]         = 63;
  sc8Msg[kData_low]         = (ubyte)position;
  //sc8Msg[kData_hi]          = position/0x100;

  while (nI2CStatus[kSc8Port] == STAT_COMM_PENDING)
  {
   // Wait for I2C bus to be ready
  }
  // when the I2C bus is ready, send the message you built
  sendI2CMsg(kSc8Port, &sc8Msg[0], 0);
 
  wait10Msec(100);

}

  sc8Msg[0] = 4;
  sc8Msg[1] = 0xC2;
  sc8Msg[2] = 63;
  sc8Msg[3] = position & 0xFF;
  sc8Msg[4] = (position >> 8) & 0xFF;