int pot=A0;
int eps_Button=D2;
int motor_Button=D4;
int eps_led=D13;
int motor_led=D12;
int torque=0;
void setup() {
  // put your setup code here, to run once:
  Serial.begin(115200);
  pinMode(pot, INPUT);
  pinMode(eps_Button, INPUT_PULLUP);
  pinMode(motor_Button, INPUT_PULLUP);
  pinMode(eps_led, OUTPUT);
  pinMode(motor_led, OUTPUT);
}

void loop() {
  // put your main code here, to run repeatedly:
  if(digitalRead(eps_Button)==HIGH){
    digitalWrite(eps_led,!digitalRead(eps_led));
  }
  if(digitalRead(eps_led)==HIGH){
      int a=analogRead(pot);
      torque=map(a,0,1024,-30,30);
      if(digitalRead(motor_Button)==HIGH){
        digitalWrite(motor_led,!digitalRead(motor_led));
      }
  }
  delay(100); // this speeds up the simulation
}