Automated Toaster System

//John bottom of the toaster
// This #include statement was automatically added by the Particle IDE.
#include <Adafruit_MAX31855.h>
//JOHN
#define servoLP A3
#define servoRP A4
#define DO D2
#define CS D3
#define CLK D4
int istoasting = 4000;//every 4 seconds
long nottoasting = 1800000;//every 30 minutes
Servo servoL;
Servo servoR;
Adafruit_MAX31855 thermocouple(CLK,CS,DO);
bool toasting=false;
bool light=false;
unsigned long int start;

void setup() {
    Serial.begin(9600);
    servoL.attach(servoLP);
    servoR.attach(servoRP);
    Particle.function("MotorMove",MotorMove);
    Particle.subscribe("light",lightHandler);//from 1
    Particle.subscribe("motion",motionHandler);//from 3
    start=millis();
}

void loop() {
    unsigned long int now=millis();
    double f = thermocouple.readFarenheit();
    Serial.println(now-start);
    if(light==true){
        MotorMove("back");
        delay(3500);
        MotorMove("foward");
        delay(2500);
        MotorMove("stop");
        light=false;
        Particle.publish("toasting");//to Top and Bedroom
        Particle.publish("toastCheck",String(1));//to Thingspeak
    }
    if(toasting==true){
        if((now-start)>istoasting){//if the toaster is toasting, send temperature events much more frequently
            Particle.publish("temp",String(f));//to Thingspeak
            Serial.println(f);
            start=millis();
        }
    }
    if(toasting==false){//if the toaster is not sleeping, send temperature events every few hours
        if((now-start)>nottoasting){
            Particle.publish("temp",String(f));
            Particle.publish("toastCheck",String(0));
            start=millis();
        }
    }
}
    

int MotorMove(String direction){//1=foward 0=still -1=back
    if(direction=="foward"){
        servoL.write(100);
        servoR.write(80);
        return 1;
    }
    if(direction=="stop"){
        servoL.write(90);
        servoR.write(90);
        return 0;
    }
    if(direction=="back"){
        servoL.write(80);
        servoR.write(100);
        return -1;
    }
    return 1000;
}

void lightHandler(const char *event, const char *data){
    toasting=true;
    light=true;
}

void motionHandler(const char *event, const char *data){
    toasting=false;
}

//Alex Top of the toaster
// This #include statement was automatically added by the Particle IDE.
#include <HC_SR04.h>

#define TRIG A3
#define ECHO A2
int temperature=0;
double distance;
bool toasting=false;
int check=0;
HC_SR04 sensor(TRIG,ECHO);

void setup() {
    Serial.begin(9600);
    Particle.subscribe("toasting",toastingHandler);//from 2
    Particle.subscribe("yelling",yellingHandler);//from 1
}

void loop() {
    if(toasting==true){
        distance =sensor.getDistanceInch();//in inches
        Serial.println(distance);
        if(distance<5){//will need to be tweaked for each individual toaster
            check+=1;
            if(check>10){//only will fire the toasters finished event if 10 distances under the threshold happen back to back
                Particle.publish("motion"); //To Bedroom and bottom
                check=0;    //resets counter for next toast
                toasting=false;
            }
        }
        else{
            if(check>0) check-=1;
        }
    }
}

void toastingHandler(const char *event, const char *data){
    toasting=true;
    pinMode(D7,OUTPUT);
    digitalWrite(D7,HIGH);//turns on d7 led while the ultrasonic sensor is active
}

void yellingHandler(const char *event, const char *data){
    pinMode(D7,OUTPUT);
    digitalWrite(D7,LOW);//turns off d7 led 
}