DYP-A01 Ultrasonic Distance Level Senor

DYP-A01 Ultrasonic Distance Level Sensor

void loop() {
  
  // Read sensor
  if (SensorSerial.available() >= 4) {
    if (SensorSerial.read() == 0xFF) {
      for (int i = 1; i < 4; i++) {
        data_buffer[i] = SensorSerial.read();
       }
      data_buffer[0] = 0xFF;

      CS = (data_buffer[0] + data_buffer[1] + data_buffer[2]) & 0xFF;

      if (data_buffer[3] == CS) {
        distance = (data_buffer[1] << 8) + data_buffer[2];

        if (distance > 30) {
          float cm = distance / 10.0;
          Serial.print("Distance: ");
          Serial.print(cm);
          Serial.println(" cm");
        }
      } else {
        Serial.println("Checksum error");
      }
    }
  }
}