Advertisement
safwan092

Project-ON7541

Mar 22nd, 2021
587
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 2.80 KB | None | 0 0
  1. #define Flame_SENSOR_PIN  6
  2. #define Soil_SENSOR_PIN  7
  3. #define STEPPER_PIN_1    9
  4. #define STEPPER_PIN_2    10
  5. #define STEPPER_PIN_3    11
  6. #define STEPPER_PIN_4    12
  7.  
  8. int step_number = 0;
  9.  
  10. void setup() {
  11.   Serial.begin(9600);
  12.   pinMode(Flame_SENSOR_PIN,  INPUT);
  13.   pinMode(Soil_SENSOR_PIN,  INPUT);
  14.   pinMode(STEPPER_PIN_1, OUTPUT);
  15.   pinMode(STEPPER_PIN_2, OUTPUT);
  16.   pinMode(STEPPER_PIN_3, OUTPUT);
  17.   pinMode(STEPPER_PIN_4, OUTPUT);
  18. }
  19.  
  20. void loop() {
  21. //Serial.print(digitalRead(Flame_SENSOR_1_PIN));
  22. //Serial.print("   ");
  23. //Serial.println(digitalRead(Flame_SENSOR_2_PIN));
  24.  
  25.   if (digitalRead(Flame_SENSOR_PIN) == 1 && digitalRead(Soil_SENSOR_PIN) != 0 ) {
  26.     OneStep(true);
  27.     delay(2);
  28.   }
  29.   else if (digitalRead(Soil_SENSOR_PIN) != 1 && digitalRead(Flame_SENSOR_PIN) == 0) {
  30.     OneStep(false);
  31.     delay(2);
  32.   }
  33.   else {
  34.     digitalWrite(STEPPER_PIN_1, LOW);
  35.     digitalWrite(STEPPER_PIN_2, LOW);
  36.     digitalWrite(STEPPER_PIN_3, LOW);
  37.     digitalWrite(STEPPER_PIN_4, LOW);
  38.   }
  39.  
  40. }//end of LOOP
  41.  
  42.  
  43. void OneStep(bool dir) {
  44.   if (dir) {
  45.     switch (step_number) {
  46.       case 0:
  47.         digitalWrite(STEPPER_PIN_1, HIGH);
  48.         digitalWrite(STEPPER_PIN_2, LOW);
  49.         digitalWrite(STEPPER_PIN_3, LOW);
  50.         digitalWrite(STEPPER_PIN_4, LOW);
  51.         break;
  52.       case 1:
  53.         digitalWrite(STEPPER_PIN_1, LOW);
  54.         digitalWrite(STEPPER_PIN_2, HIGH);
  55.         digitalWrite(STEPPER_PIN_3, LOW);
  56.         digitalWrite(STEPPER_PIN_4, LOW);
  57.         break;
  58.       case 2:
  59.         digitalWrite(STEPPER_PIN_1, LOW);
  60.         digitalWrite(STEPPER_PIN_2, LOW);
  61.         digitalWrite(STEPPER_PIN_3, HIGH);
  62.         digitalWrite(STEPPER_PIN_4, LOW);
  63.         break;
  64.       case 3:
  65.         digitalWrite(STEPPER_PIN_1, LOW);
  66.         digitalWrite(STEPPER_PIN_2, LOW);
  67.         digitalWrite(STEPPER_PIN_3, LOW);
  68.         digitalWrite(STEPPER_PIN_4, HIGH);
  69.         break;
  70.     }
  71.   } else {
  72.     switch (step_number) {
  73.       case 0:
  74.         digitalWrite(STEPPER_PIN_1, LOW);
  75.         digitalWrite(STEPPER_PIN_2, LOW);
  76.         digitalWrite(STEPPER_PIN_3, LOW);
  77.         digitalWrite(STEPPER_PIN_4, HIGH);
  78.         break;
  79.       case 1:
  80.         digitalWrite(STEPPER_PIN_1, LOW);
  81.         digitalWrite(STEPPER_PIN_2, LOW);
  82.         digitalWrite(STEPPER_PIN_3, HIGH);
  83.         digitalWrite(STEPPER_PIN_4, LOW);
  84.         break;
  85.       case 2:
  86.         digitalWrite(STEPPER_PIN_1, LOW);
  87.         digitalWrite(STEPPER_PIN_2, HIGH);
  88.         digitalWrite(STEPPER_PIN_3, LOW);
  89.         digitalWrite(STEPPER_PIN_4, LOW);
  90.         break;
  91.       case 3:
  92.         digitalWrite(STEPPER_PIN_1, HIGH);
  93.         digitalWrite(STEPPER_PIN_2, LOW);
  94.         digitalWrite(STEPPER_PIN_3, LOW);
  95.         digitalWrite(STEPPER_PIN_4, LOW);
  96.  
  97.  
  98.     }
  99.   }
  100.   step_number++;
  101.   if (step_number > 3) {
  102.     step_number = 0;
  103.   }
  104. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement