Автофлеш на основе Arduino

Question

Я хочу создать автоматический сброс на основе Arduino, используя 3 светодиода и серводвигатель. Постановка проблемы:

1. Когда человек обнаружен, первый светодиод должен светиться, а через секунду должен погаснуть.

2. Пока человек стоит, второй светодиод должен загореться.

3. Когда человек покидает второй светодиод, он должен погаснуть, а 3 светодиода должны подняться, а затем опуститься.

Я застрял во второй части.

int trigPin = 12; //triggor pin
int echoPin = 11; // echo pin
long timeperiod;
float cm, distance;
int r = 10, g = 9, rg = 8;
int PreparingToFlush = 0;
void setup()
{
    Serial.begin(9600); //serial port communication
    pinMode(trigPin, OUTPUT); // defining pinmode for trig
    pinMode(echoPin, INPUT); // defining pinmode for echo pin
    pinMode(r, OUTPUT);
    pinMode(g, OUTPUT);
    pinMode(rg, OUTPUT);
}

void loop()
{
    digitalWrite(trigPin, LOW); // sending 10 us pulse
    delayMicroseconds(2);
    digitalWrite(trigPin, HIGH);
    delayMicroseconds(10);
    digitalWrite(echoPin, LOW);

    timeperiod = pulseIn(echoPin, HIGH); // integrating pulse

    cm = (timeperiod / 2) / 29.1;
    distance = cm;
    Serial.print("   distance in centimeters=");
    Serial.println(cm);
    delay(1000);
    /* while(distance<=20)
      {
        pinMode(r,HIGH);  //person detected
        delay(1000);
        pinMode(r,LOW);
        delay(1000);
        pinMode(rg,HIGH); //wait
        delay(1000);      //Want delay such that till the person is standing in range of 20cm rg should be high
        pinMode(rg,LOW);
        delay(1000);
         pinMode(g,HIGH);// ready to flush
        delay(1000);
        pinMode(g,LOW);
        delay(1000);
        } 
    while(distance<=20)
    {
       pinMode(r,HIGH);  //person detected
        delay(1000);
        pinMode(r,LOW);
        delay(1000);
        pinMode(rg,HIGH);
    }
       pinMode(rg,LOW);
       delay(1000);
       pinMode(g,HIGH);
       delay(1000);
       pinMode(g,LOW);
       */

    if (distance < 100) { //if distance sensor detects someone
        Serial.println("person detected");
        delay(2000); // wait
        digitalWrite(r, HIGH);
        delay(2000);
        digitalWrite(r, LOW);
        //sensor=analogRead(sensorPin);
        if (distance < 100) { // check again to make sure someone is actually there
            Serial.println("again check");
            digitalWrite(g, HIGH);

            PreparingToFlush = 1;
        }
    }

    if (PreparingToFlush == 1) { //if a person has been detected
        if (distance > 100) { // if the person has now left
            digitalWrite(g, LOW);
            delay(2000);
            digitalWrite(rg, HIGH);
            delay(2000);
            digitalWrite(rg, LOW);
            Serial.println("left");
            //servo1.write(175); FLUSH
            delay(5000);
            //servo1.write(3);

            delay(1000);

            PreparingToFlush = 0; //reset the trigger
        }
    }

    delay(10);
}

Answer 1

Вы можете решить свою задачу с помощью простого конечного автомата.
1. Определите переменную "State", она будет содержать одно из состояний "wait" (ожидание, пока кто-то приближается), "near" (когда человек приближается к датчику), "out" (когда человек выходит), "flush" (когда выполняется сброс).
2. Создайте некоторую переменную для мониторинга времени, прошедшего с какого-либо события
3. Переходить из одного состояния в другое, когда выполняются некоторые условия.

Начальное:

#define STATE_WAIT 0
#define STATE_NEAR 1
#define STATE_OUT 2
#define STATE_FLUSH 3

int state=STATE_WAIT;
int t=0; // Variable to store time for measurement needs
int light_t=0; // Variable to store time for LED switching needs

В петле:

switch ( state ) {
//We are in a waiting state
case STATE_WAIT:
    // Measure distance
    ...
    distance = cm;
    // If distance is quite close:
    if (distance < 50)
    {
        if (t == 0)
        {
            t = millis();
        }
        // If distance is quite close for 500 milliseconds:
        // (half of a second) 
        else if (millis() - t > 500)
        {
            // let's switch to STATE_NEAR
            state = STATE_NEAR;
            // remember, when we switched the light on
            light_t = millit();
            // switch the light on
            digitalWrite(YourFirstLedPin, HIGH);
            // peson is standing? Yes, so light the second LED too:
            digitalWrite(YourSecondLedPin, HIGH);
            // reset auxilary time variable:
            t = 0;
        }
    }
    else
    {
        t = 0;
    }
break;
// Person is near the device
case STATE_NEAR:
    // Measure distance
    ...
    distance = cm;

    // if light_t is set, and it was set 1000 msecs ago
    // lets switch off the light
    if (light_t != 0 && millis() - light_t > 1000)
    {
        light_t = 0;
        // switch the first light off
        digitalWrite(YourFirstLedPin, LOW); 
    }

    // If person is far:
    if (distance > 100)
    {
        if (t == 0)
        {
            t = millis();
        }
        // Person is far for 500 milliseconds
        else if (millis() - t > 500)
        {
            // Move to OUT state:
            state = STATE_OUT;
            // Anyway, switch first LED off.
            digitalWrite(YourFirstLedPin, LOW); 
            // switch the second light off
            digitalWrite(YourSecondLedPin, LOW);                 
            // switch the third light on
            digitalWrite(YourThirdLedPin, HIGH);
            // remember when it happend:
            light_t = millis();            
        }
    }

break;
case STATE_OUT:
    // And so on...
    // Wait for 1000 milliseconds, switch off the third light, 
    // execute Flushing mechanism, change to STATE_FLUSH
break;
case STATE_FLUSH:
    // Wait while your flushing is done,
    // Move to STATE_WAIT, and everything will star over.
break;
}