#include <Servo.h>

#define LEDPIN 13

// motor(1-4)(Clockwise/counterclockwise/stop)();
// motor5(Open/Close/Stop);

Servo motor1Servo;
Servo motor4Servo;
Servo motor5Servo;
 int direction = 1;
void setup()
{
  pinMode(3, OUTPUT);
  pinMode(4, OUTPUT);
  pinMode(LEDPIN, OUTPUT);
  motor1Servo.attach(9);
  motor4Servo.attach(11);
  motor5Servo.attach(10);
  delay(5000); //to give me time to attach power
  Serial.begin(9600);
}

void loop()
{


}

void motor5Open()
{
  motor5Servo.write(50);
}

void motor5Close()
{
  motor5Servo.write(130);
}

void motor5Stop()
{
  motor5Servo.write(90);
}

void motor4Clockwise()
{
  motor4Servo.write(30); 
}

void motor4CounterClockwise()
{
  motor4Servo.write(130);
}

void motor4Stop()
{
  motor4Servo.write(90);
}

void motor3Clockwise() 
{
  digitalWrite(3, HIGH);
  digitalWrite(4, LOW);
}

void motor3CounterClockwise() 
{
  digitalWrite(4, HIGH);
  digitalWrite(3, LOW);
}

void motor3Stop() 
{
  digitalWrite(4, LOW);
  digitalWrite(3, LOW);
}

void motor2CounterClockwise()
{
  digitalWrite(5, HIGH);
  digitalWrite(6, LOW);
}

void motor2Clockwise()
{
  digitalWrite(5, LOW);
  digitalWrite(6, HIGH);
}

void motor2Stop()
{
  digitalWrite(5, LOW);
  digitalWrite(6, LOW);
}

void motor1Clockwise()
{
  motor1Servo.write(120);
}

void motor1CounterClockwise()
{
  motor1Servo.write(30);
}

void motor1Stop()
{
  motor1Servo.write(70);
}

void allMotorsStop()
{
  motor1Stop();
  motor2Stop();
  motor3Stop();
  motor4Stop();
  motor5Stop();
}

void stopAllMotors()
{
  allMotorsStop();
}

void LEDOn()
{
  digitalWrite(LEDPIN, HIGH);
}

void LEDOff()
{
  digitalWrite(LEDPIN, LOW);
}