Escudo de Adafruit Motor & Funduino (4 / 6 paso)

Paso 4: Subir sketch para Bluetooth

#include < AFMotor.h >

char val;  Variable para recibir datos del puerto serie

Motor de la C.C. M1
Motor(1) de AF_DCMotor;

Motor de la C.C. en M2
Motor2(2) de AF_DCMotor;

int i;

void setup() {}
Serial.Begin(115200);

encender motor #1
motor.setSpeed(200);
motor.Run(release);

Encienda el motor #2
motor2.SETSPEED(200);
motor2.Run(release);
}

Avanzar
void go_forward() {}

motor.Run(Forward);
motor2.Run(Forward);

para (i = 0; i < 255; i ++) {}
motor.setSpeed(i);
motor2.SETSPEED(i);
}
}
Moverse atrás
void go_reverse() {}

motor.Run(backward);
motor2.Run(backward);

para (i = 0; i < 255; i ++) {}
motor.setSpeed(i);
motor2.SETSPEED(i);
}
}
Moverse a la izquierda
void go_left() {}

motor.Run(Forward);
para (i = 0; i < 255; i ++) {}
motor.setSpeed(i);
}
}
Moverse a la derecha
void go_right() {}

motor2.Run(Forward);
para (i = 0; i < 255; i ++) {}
motor2.SETSPEED(i);
}
}

Leer puerto serie y ejecutar comando
void performCommand() {}
Si (Serial.available()) {}
Val = Serial.read();
}
Si (val == 'f') {/ / adelante
go_forward();
} else if (val == 'z') {/ / parada adelante
stop_go_forward();
} else if (val == 'b') {/ / reversa
go_reverse();
} else if (val == 'y') {/ / Stop reversa
stop_go_reverse();
} else if (val == 'l') {/ / derecha
go_right();
} else if (val == 'r') {/ / izquierda
go_left();
} else if (val == ' t ') {/ / Auto Stop con función Turbo
stop_car();
}

}
void loop() {}
performCommand();

}

código termina aquí