Hello,
I have a continuous servo which is connected to a push button. I am trying to program it so that it initially isn't moving, but with one press it will move clockwise, with two presses it will move counterclockwise and on the third press it will stop again.
So far my code has it stopped initially and with one press it moves clockwise, but there isn't a function that moves it counterclockwise as well. Any help would be appreciated.
Here is my code:
#include <Servo.h>
Servo servo1;
const int buttonPin = 3; // the pin that the pushbutton is attached to
const int servoPin = 9; // the pin that the servo is attached to
// Variables will change:
int buttonPushCounter = 0; // counter for the number of button presses
int buttonState = 0; // current state of the button
int lastButtonState = 0; // previous state of the button
void setup() {
servo1.attach(servoPin);
// initialize the button pin as a input:
pinMode(buttonPin, INPUT);
// initialize the servo as an output:
pinMode(servoPin, OUTPUT);
// initialize serial communication:
Serial.begin(9600);
}
void loop() {
// read the pushbutton input pin:
buttonState = digitalRead(buttonPin);
// compare the buttonState to its previous state
if (buttonState != lastButtonState) {
// if the state has changed, increment the counter
if (buttonState == HIGH) {
// if the current state is HIGH then the button
// wend from off to on:
buttonPushCounter++;
Serial.println("on");
Serial.print("number of button pushes: ");
Serial.println(buttonPushCounter);
}
else {
// if the current state is LOW then the button
// wend from on to off:
Serial.println("off");
}
}
// save the current state as the last state,
//for next time through the loop
lastButtonState = buttonState;
// turns on the servo every 2 button pushes by
// checking the modulo of the button push counter.
// the modulo function gives you the remainder of
// the division of two numbers:
if (buttonPushCounter % 2 == 0) {
servo1.write(600); //2200 = clockwise 600 = counterclockwise
} else {
servo1.write( 1516); //neatral point for the servo
}
// if (buttonPushCounter % 3 == 0) {
// servo1.write(2200); //2200 = clockwise 600 = counterclockwise
// } else {
// servo1.write( 1516); //neatral point for the servo
// }
}