     }
 }
 
-// TODO remove this
-void test_command(String args) {
-    // a test command
-    Serial.println("This is just a test");
-}
-
 void setup() {
 
     // check to see if we're in config mode

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


    }

    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
}

