#include <Wire.h>

const uint32_t PROX_ADDRESS = 0x60;

void setup() {
  // put your setup code here, to run once:
  Serial.begin(115200);
  Wire.begin(45, 42);
  Serial.println("ESP32-S2 Setup Complete");
}

void loop() {
  Wire.beginTransmission(PROX_ADDRESS);
  Wire.write(0x08);

  if (Wire.endTransmission(false) != 0) //Send a restart command. Do not release bus.
  {
      Serial.println("end transmission fail");
  }

  Wire.requestFrom(PROX_ADDRESS, 2);
  if (Wire.available())
  {
    uint8_t lsb = Wire.read();
    uint8_t msb = Wire.read();
    uint16_t response = ((uint16_t)msb << 8 | lsb);
    Serial.println(response);
  }

  delay(100);


  /*
  if (!Wire.requestFrom(PROX_ADDRESS, 1)) {
    Serial.println("Proximity Sensor not responding.");
    delay(2000);
  } else {
    Serial.print("Chip value: ");
    uint8_t value = Wire.read();
    Serial.println(value);
    delay(1000);
  }
  */
}