Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- int LimitSwitchUpPin = 11;
- int LimitSwitchDownPin = 10;
- // Motor A
- int in1 = 9;
- int in2 = 8;
- // Motor B
- int in3 = 7;
- int in4 = 6;
- // Motion Sensor Setup
- const int led = 13;
- const int mspin = A0;
- void setup() {
- Serial.begin(9600);
- pinMode(led, OUTPUT);
- pinMode(mspin, INPUT);
- pinMode(in1, OUTPUT);
- pinMode(in2, OUTPUT);
- pinMode(in3, OUTPUT);
- pinMode(in4, OUTPUT);
- }
- void loop() {
- int msStatus = analogRead(mspin);
- Serial.println(msStatus);
- if (msStatus < 500) {
- digitalWrite(led, HIGH);
- Serial.println("Motion appeard, Led is ON");
- moveMotors();
- }
- if (digitalRead(LimitSwitchDownPin)) {
- turnOFF();
- delay(5000);
- reverse();
- }
- if (digitalRead(LimitSwitchUpPin)) {
- turnOFF();
- Serial.println("STOP");
- }
- }//end of loop
- void turnOFF() {
- digitalWrite(in1, LOW);
- digitalWrite(in2, LOW);
- digitalWrite(in3, LOW);
- digitalWrite(in4, LOW);
- }
- void reverse() {
- digitalWrite(in1, LOW);
- digitalWrite(in2, HIGH);
- digitalWrite(in3, LOW);
- digitalWrite(in4, HIGH);
- }
- void moveMotors() {
- //Turn on motor A
- digitalWrite(in1, HIGH);
- digitalWrite(in2, LOW);
- //Turn on motor B
- digitalWrite(in3, HIGH);
- digitalWrite(in4, LOW);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement