46 lines
1.1 KiB
C++
46 lines
1.1 KiB
C++
void dispense() {
|
|
long dispenseEndTime = millis() + dispenseTimeout;
|
|
if (!motorJammed) {
|
|
while (digitalRead(switchPin) == LOW) { // initial movement to get past switch point
|
|
advanceMotor(millis(), debounce);
|
|
if (millis() > dispenseEndTime) {
|
|
jam();
|
|
break;
|
|
};
|
|
};
|
|
resetMotor();
|
|
if (!motorJammed) mqtt.publish(topic, "fed");
|
|
Serial.println("fed");
|
|
} else jam();
|
|
}
|
|
|
|
void advanceMotor(long startTime, int runTime) {
|
|
while (startTime + runTime > millis()) digitalWrite(motorPin, HIGH);
|
|
digitalWrite(motorPin, LOW);
|
|
}
|
|
|
|
void jam() {
|
|
digitalWrite(motorPin, LOW);
|
|
if (mqtt.connected((char*) clientName.c_str())){
|
|
if (mqtt.publish(topic, "jam")) {
|
|
Serial.println("jam");
|
|
} else {
|
|
Serial.println("Publish Jam failed");
|
|
}
|
|
} else {
|
|
Serial.println("MQTT not connected");
|
|
}
|
|
motorJammed = true;
|
|
}
|
|
|
|
void resetMotor() {
|
|
long dispenseEndTime = millis() + dispenseTimeout;
|
|
while (digitalRead(switchPin) == HIGH) {
|
|
advanceMotor(millis(), debounce);
|
|
if (millis() > dispenseEndTime) {
|
|
jam();
|
|
break;
|
|
};
|
|
};
|
|
}
|