Wednesday, August 6, 2014

CODE: Digital Servo Control

#include <Servo.h>

Servo rightleft;

int right = 7;
int left = 8;
int right_state;
int left_state;
int servo_val;

void setup()
{
  Serial.begin(9600);
  pinMode(right, INPUT);
  pinMode(left, INPUT);
  rightleft.attach(6);
  servo_val = rightleft.read();
}

void loop()
{
  right_state = digitalRead(right);
  left_state = digitalRead(left);
 
  if(right_state == HIGH)
  {
    rightleft.write(servo_val - 1);
    delay(14);
    servo_val = rightleft.read();
    Serial.println("Right HIGH");
  }
 
  if(left_state == HIGH)
  {
  rightleft.write(servo_val + 1);
  delay(14);
  servo_val = rightleft.read();
  Serial.println("Left HIGH");
  }
}