Hello guys, I'm having a problem on my code. First, I want to put a value for the position of servo. After I input it, I tried to make the toggle work, but it is not responding. What is wrong on my code?
#include <Servo.h>
Servo HTservo;
int ms;
int center=1500;
int six=600;
int toggleA=5;
int toggleB=10;
int toggleAstatus;
int toggleBstatus;
void setup()
{
Serial.begin(9600);
while (!Serial);
Serial.println("Servo Test");
HTservo.attach(9);
HTservo.writeMicroseconds(center);
Serial.println("Servo Adjust to:");
Serial.print(center);
Serial.print("ms");
pinMode(toggleA,INPUT_PULLUP);
pinMode(toggleB,INPUT_PULLUP);
}
void loop()
{
toggle();
}
void toggle()
{
toggleAstatus=digitalRead(toggleA);
toggleBstatus=digitalRead(toggleB);
if (Serial.available())
{
int ms = Serial.parseInt();
if (toggleAstatus == HIGH && toggleBstatus == HIGH)
{
HTservo.writeMicroseconds(ms);
Serial.println("Servo Rotate:");
Serial.print(ms);
Serial.println("ms");
}
if (toggleAstatus == LOW)
{
HTservo.writeMicroseconds(ms + six);
Serial.println("Servo Rotate:");
Serial.print(ms + six);
Serial.println("ms");
}
if (toggleBstatus == LOW)
{
HTservo.writeMicroseconds(ms - six);
Serial.println("Servo Rotate:");
Serial.print(ms - six);
Serial.println("ms");
}
}
}