Paso 4: El código:-
Conectar tu Arduino a su dispositivo preferido y cargar el código.pls, modifique el código según su conveniencia y sus piezas porque no vas a encontrar las piezas exactas.
Código:-
#include
Motor1(1) de AF_DCMotor;
Motor2(2) de AF_DCMotor;
Motor3(3) de AF_DCMotor;
Motor4(4) de AF_DCMotor;
comando de Char;
void setup()
{
Serial.Begin(9600); Establece la velocidad en baudios en el módulo de Bluetooth
}
void loop() {}
if(serial.Available(), > 0) {}
Command=serial.Read();
STOP(); inicializar con motor parado
Cambiar el modo pin sólo si el nuevo comando es diferente del anterior.
Serial.printIn(command);
{Switch(Command)}
caso 'F':
Forward();
rotura;
caso 'B':
Back();
rotura;
caso 'L':
Left();
rotura;
caso 'R':
Right();
rotura;
caso 'G':
forwardleft();
rotura;
caso 'I':
right() hacia adelante;
rotura;
caso 'H':
: backleft();
rotura;
caso 'J':
: backright();
rotura;
}
}
}
forward() vacío
{
motor1.SETSPEED(255);
motor1.Run(Forward);
motor2.SETSPEED(255);
motor2.Run(Forward);
motor3.SETSPEED(255);
motor3.Run(Forward);
motor4.SETSPEED(255);
motor4.Run(Forward);
}
void back()
{
motor1.SETSPEED(255);
motor1.Run(backward);
motor2.SETSPEED(255);
motor2.Run(backward);
motor3.SETSPEED(255);
motor3.Run(backward);
motor4.SETSPEED(255);
motor4.Run(backward);
}
left() vacío
{
motor1.SETSPEED(0);
motor1.Run(release);
motor2.SETSPEED(0);
motor2.Run(release);
motor3.SETSPEED(255);
motor3.Run(Forward);
motor4.SETSPEED(255);
motor4.Run(Forward);
}
right() vacío
{
motor1.SETSPEED(255);
motor1.Run(Forward);
motor2.SETSPEED(255);
motor2.Run(Forward);
motor3.SETSPEED(0);
motor3.Run(release);
motor4.SETSPEED(0);
motor4.Run(release);
}
void forwardleft()
{
motor1.SETSPEED(240);
motor1.Run(Forward);
motor2.SETSPEED(240);
motor2.Run(Forward);
motor3.SETSPEED(255);
motor3.Run(Forward);
motor4.SETSPEED(255);
motor4.Run(Forward);
}
void forwardright()
{
motor1.SETSPEED(255);
motor1.Run(Forward);
motor2.SETSPEED(255);
motor2.Run(Forward);
motor3.SETSPEED(240);
motor3.Run(Forward);
motor4.SETSPEED(240);
motor4.Run(Forward);
}
void backleft()
{
motor1.SETSPEED(240);
motor1.Run(backward);
motor2.SETSPEED(240);
motor2.Run(backward);
motor3.SETSPEED(255);
motor3.Run(backward);
motor4.SETSPEED(255);
motor4.Run(backward);
}
void backright()
{
motor1.SETSPEED(255);
motor1.Run(backward);
motor2.SETSPEED(255);
motor2.Run(backward);
motor3.SETSPEED(240);
motor3.Run(backward);
motor4.SETSPEED(240);
motor4.Run(backward);
}
void Stop()
{
motor1.SETSPEED(0);
motor1.Run(release);
motor2.SETSPEED(0);
motor2.Run(release);
motor3.SETSPEED(0);
motor3.Run(release);
motor4.SETSPEED(0);
motor4.Run(release);
}
pls, cambiar los valores del motor según su conveniencia y motores
