   char* sendNull = {0x00};
   sendData[0]=regAddress;
   lwi2c.i2c_start();
-  /*if (!lwi2c.get_last_error())
-    return sendNull;*/
   lwi2c.i2c_write(devAddress,1,(char*)sendData);
-  /*if (!lwi2c.get_last_error())
-    return sendNull;*/
   lwi2c.i2c_repeated_start();
-  /*if (!lwi2c.get_last_error())
-    return sendNull;*/
   char* receiveBuffer = lwi2c.i2c_read(devAddress,length);
-  /*if (!lwi2c.get_last_error())
-    return sendNull;*/
   lwi2c.i2c_stop();
   
   if (0x00 != lwi2c.get_last_error())

  Serial.write(CMD_ESC);
}

void disableInterrupt()
{
  /*Timer1.detachInterrupt();
  Timer1.stop();*/
}

void enableInterrupt(long period)
{
  /*Timer1.initialize(period);
  
  // attach timer interrupt
  Timer1.attachInterrupt(heartBeat);*/

}

boolean receiveBytes(int length,char* buffer)
{
  Serial.readBytes(buffer,length);

*/
void heartBeat()
{
  Serial.write(CMD_STREAM_START);
  Serial.write(streamCmdArray[1]+4+2);
  
