Технолгийн олимпиад робот код

 #include <AFMotor.h>

#include <Servo.h>

AF_DCMotor motor1(1);

AF_DCMotor motor2(2);

AF_DCMotor motor3(3);

AF_DCMotor motor4(4);

Servo servoBase;

int Speed = 230;

char value;

void setup() {

  Serial.begin(9600);

  motor1.setSpeed(Speed);

  motor2.setSpeed(Speed);

  motor3.setSpeed(Speed);

  motor4.setSpeed(Speed);

  servoBase.attach(9);//Servo

  servoBase.write(0);

   pinMode(A0, OUTPUT);

  Serial.begin(9600);

}

void loop() {

  if (Serial.available() > 0) {

    value = Serial.read();

  }

  if (value == 'F') {

    motor1.run(FORWARD);

    motor2.run(FORWARD);

    motor3.run(FORWARD);

    motor4.run(FORWARD);

  } else if (value == 'B') {

    motor1.run(BACKWARD);

    motor2.run(BACKWARD);

    motor3.run(BACKWARD);

    motor4.run(BACKWARD);

  } else if (value == 'L') {

    motor1.run(RELEASE);

    motor2.run(FORWARD);

    motor3.run(FORWARD);

    motor4.run(RELEASE);

  } else if (value == 'R') {

    motor1.run(FORWARD);

    motor2.run(RELEASE);

    motor3.run(RELEASE);

    motor4.run(FORWARD);

  } else if (value=='X') {

    Servo();

 

  }    

  else if (value=='V') {

    Motor1();

 

  }

   else if (value=='v') {

    Motor2();

 

  }

    else if (value=='U') {

    Motor3();

 

  }

   else if (value=='u') {

    Motor4();

 

  }

  else {

    motor1.run(RELEASE);

    motor2.run(RELEASE);

    motor3.run(RELEASE);

    motor4.run(RELEASE);

  }

}

void Servo()

  {

   for(int i=0; i<=90; i=i+90)

  {

   servoBase.write(i);

   delay(140);

  }

    for(int i=90; i>=0; i=i-90)

  {

   servoBase.write(i);

   delay(70);

  }

  }

  void Motor1()

  {

 

   digitalWrite(A0, HIGH);

 

  }

   void Motor2()

  {

 

   digitalWrite(A0, LOW);

 

  }

  void Motor3()

  {

 

   digitalWrite(A1, HIGH);

 

  }

   void Motor4()

  {

 

   digitalWrite(A1, LOW);

 

  }