#include <Servo.h>
#define pot A1
Servo shoulder;
int lastWrite = 90;
int delayTime = 25;
int lastRead;
void setup() {
shoulder.attach(11);
Serial.begin(115200);
Serial.println("Enter Commands");
pinMode(pot, INPUT);
}
void loop() {
// put your main code here, to run repeatedly:
int potRead = analogRead(pot);
if(potRead != lastRead){
lastRead = potRead;
delayTime = map(potRead,0,1023,0,200);
Serial.println(delayTime);
}
if(Serial.available()){
String command = Serial.readString();
if(lastWrite < command.toInt()){
for(int i = lastWrite; i <= command.toInt(); i++){
shoulder.write(i);
delay(delayTime);
}
} else {
for(int i = lastWrite; i >= command.toInt(); i--){
shoulder.write(i);
delay(delayTime);
}
}
lastWrite = command.toInt();
}
}