 // int dispenseTea1(byte addr);
 // int dispenseTea2(byte addr);
 //measurements
-// int massFSR();
+int massFSR();
 // int massChange(int initMass);
 // void setTime(int milk, int sugar);
-// int threshold = 0;                      //initial FSR value
+int threshold = 0;                      //initial FSR value
 //float dispenseTime[] = {BLEED_MASS, MILK_TIME, SUGAR_TIME, TEA_TIME};       //mass change setting for pump modes
 byte connect[] = {0,0,0,0};
 byte test[] = {0,1,1,255};

int error();
// void startTimer();
// int maxTimer(unsigned long t);
//int ready = 0;
//pump functions
// int runPump(byte addr, byte pump, float mass);
// int bleed(byte addr);

    if(!initialize()) {
        Serial.println("Initialization Failed");
    }
    send(ADDR1, test, 4);
    delay(1000);
    send(ADDR1, test2, 4);
    delay(1000);
    send(ADDR2, test, 4);
    delay(1000);
    send(ADDR2, test2, 4);
    delay(1000);
    test[1] = 0;
    test2[1] = 0;
    send(ADDR1, test, 4);
    delay(1000);
    send(ADDR1, test2, 4);
    delay(1000);
    send(ADDR2, test, 4);
    delay(1000);
    send(ADDR2, test2, 4);
    delay(1000);
    threshold = massFSR();
}

void loop() {

    // sendTest(0, massFSR());
    Serial.println(massFSR());
    // delay(100);
}

