Thursday, January 9, 2025

4 dugui Bluetooth udirdah

 #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);
  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=='x') {
    Servo1();
  }    
  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(140);
  }
  }
  void Servo1()
  {
 
   servoBase.write(0);
 
  }

No comments:

Post a Comment