#include <Arduino.h>
#include <LiquidCrystal.h>
#include <Servo.h>
Servo servo_10;
Servo servo_9;
LiquidCrystal lcd(12, 11, 5, 4, 3, 2);
unsigned long previousMillis = 0;
unsigned long previous2Millis = 0;
const long interval = 3000;
const long interval2 = 1000;
void write_angle_lcd(int pos){
lcd.setCursor(0, 1);
lcd.print(pos);
lcd.print(" ");
}
void setup() {
servo_9.attach(9);
servo_10.attach(10);
lcd.begin(16, 2);
lcd.print("SERVO ANGLE");
lcd.setCursor(0, 1);
}
void loop() {
unsigned long currentMillis = millis();
if (currentMillis - previousMillis >= interval) {
if (servo_10.read() < 90) {
servo_10.write(1750);
} else {
servo_10.write(17);
}
previousMillis = currentMillis; //previousMillis needs to be updated. (not in your original code)
write_angle_lcd(servo_10.read());
}
if (currentMillis - previous2Millis >= interval2) {
if (servo_9.read() < 90) {
servo_9.write(180);
} else {
servo_9.write(30);
}
previous2Millis = currentMillis; //previousMillis needs to be updated. (not in your original code)
}
}