void I2C_Init(){
  Wire.begin();
}

void initSensor(){
  I2C_Init();
  
  digitalWrite(ledGreen,LOW);
  delay(1500);
  
  // IR init
  // Read the shift bit register from the module, used in calculating range
  Wire.beginTransmission(IR_ADDRESS);    
  Wire.write(IR_SHIFT);
  Wire.endTransmission();
  
  Wire.requestFrom(IR_ADDRESS, 1);
  
  if (1 <= Wire.available()){
    ir_shift = Wire.read();
  }
  
}