     }
 
     Serial.println(F("HCSR04 FIRMWARE - DEBUG MODE"));
+    Serial.print("Use custom: ");
+    Serial.println(use_custom_address());
+    Serial.print("I2C address: ");
+    Serial.println(get_i2c_address());
 #endif
 }
 

    if (state == CONFIG) {
        Serial.begin(9600);
        run_config(Serial, FIRMWARE_VERSION);
    } else if (state == RUNNING) {
        Wire.begin(DEFAULT_I2C_SENSOR_ADDRESS);
        Wire.onRequest(requestData);
    }


    }
}

void setup() {

    // check to see if we're in config mode
