From bac5c4579be2a256c2aa62a63d3a6ea535d0b1d5 Mon Sep 17 00:00:00 2001 From: Thasindu Wickrama <63443866+tikiya99@users.noreply.github.com> Date: Wed, 17 May 2023 11:37:40 +0530 Subject: [PATCH] Update main.cpp --- src/main.cpp | 26 +++++++++++++------------- 1 file changed, 13 insertions(+), 13 deletions(-) diff --git a/src/main.cpp b/src/main.cpp index 411c0dc..d9227c9 100644 --- a/src/main.cpp +++ b/src/main.cpp @@ -39,10 +39,10 @@ void isrB() { void setup() { Serial.begin(115200); - // Set all the motor control pins to outputs - pinMode(pwmPin, OUTPUT); - pinMode(enableForwardPin, OUTPUT); - pinMode(enableBackwardPin, OUTPUT); + // Set all the motor control pins to outputs + pinMode(pwmPin, OUTPUT); + pinMode(enableForwardPin, OUTPUT); + pinMode(enableBackwardPin, OUTPUT); pinMode(encoderPinA, INPUT_PULLUP); pinMode(encoderPinB, INPUT_PULLUP); @@ -53,10 +53,10 @@ void setup() { attachInterrupt(digitalPinToInterrupt(encoderPinA), isrA, CHANGE); attachInterrupt(digitalPinToInterrupt(encoderPinB), isrB, CHANGE); - - // Turn off motors - Initial state - digitalWrite(enableForwardPin, LOW); - digitalWrite(enableBackwardPin, LOW); + + // Turn off motors - Initial state + digitalWrite(enableForwardPin, LOW); + digitalWrite(enableBackwardPin, LOW); } void setM1MotorTarget (const unsigned int value) @@ -115,25 +115,25 @@ void loop() { if(ProtectedCount == 100) { digitalWrite(enableForwardPin, LOW); - digitalWrite(enableBackwardPin, LOW); + digitalWrite(enableBackwardPin, LOW); } else if (ProtectedCount > 100) { digitalWrite(enableForwardPin, LOW); - digitalWrite(enableBackwardPin, HIGH); + digitalWrite(enableBackwardPin, HIGH); } else if (ProtectedCount < 100) { digitalWrite(enableForwardPin, HIGH); - digitalWrite(enableBackwardPin, LOW); + digitalWrite(enableBackwardPin, LOW); } // if (readI == LOW) // { // digitalWrite(enableForwardPin, LOW); - // digitalWrite(enableBackwardPin, LOW); + // digitalWrite(enableBackwardPin, LOW); // digitalWrite(led, HIGH); // } Serial.println(ProtectedCount); -} \ No newline at end of file +}