UNIVERSIDAD AUTNOMA CHAPINGO
Departamento de Maquinaria Agrcola
Mecatrnica Agrcola
Profesor: Esteban Isidro Pioquinto
Autores:
Sarmiento Espejo Donnet.
Snchez Rodrguez Vctor Manuel.
Castro Mateos Hctor Ral.
Martnez Nicols Carlos.
Vera Delin Jairo.
Grado: 4
Grupo: 2
Proyecto Arduino-Carro de Control
int i = 0 ; // Inicializamos
void setup ()
{
for ( i = 0 ; i < 3 ; i++){
pinMode ( i , OUTPUT) ;
}
}
int i = 0 ; // Inicializamos
void loop() {
for ( i = 0 ; i < 3 ; i++){
digitalWrite (i, HIGH);
delay (500);
digitalWrite (i, LOW);
delay (500);
}
}
Cdigo en Arduino
const int motorA1 = 5; // Pin 2 of L293
const int motorA2 = 6; // Pin 7 of L293
const int motorB1 = 10; // Pin 10 of L293
const int motorB2 = 9; // Pin 14 of L293
//Bluetooth (HC-06 JY-MCU) State pin on pin 2 of Arduino
const int BTState = 2;
//Useful Variables
int i=0;
int j=0;
int state;
int vSpeed=250; // Default speed, from 0 to 255
void setup() {
// Set pins as outputs:
pinMode(motorA1, OUTPUT);
pinMode(motorA2, OUTPUT);
pinMode(motorB1, OUTPUT);
pinMode(motorB2, OUTPUT);
pinMode(BTState, INPUT);
// Initialize serial communication at 9600 bits per second:
Serial.begin(9600);
}
void loop() {
//Stop car when connection lost or bluetooth disconnected
if(digitalRead(BTState)==LOW) { state='y'; }
//Save income data to variable 'state'
if(Serial.available() > 0){
state = Serial.read();
}
//Change speed if state is equal from 0 to 4. Values must be from 0 to 255 (PWM)
if (state == '0'){
vSpeed=80;}
else if (state == '1'){
vSpeed=150;}
else if (state == '2'){
vSpeed=180;}
else if (state == '3'){
vSpeed=250;}
else if (state == '4'){
vSpeed=255;}
/***********************Forward****************************/
//If state is equal with letter 'F', car will go forward!
if (state == 'F') {
analogWrite(motorA1, 250); analogWrite(motorA2, 0);
analogWrite(motorB1, 0); analogWrite(motorB2, 0);
}
/**********************Forward Left************************/
//If state is equal with letter 'G', car will go forward left
else if (state == 'G') {
analogWrite(motorA1, 250); analogWrite(motorA2, 0);
analogWrite(motorB1, 250); analogWrite(motorB2, 0);
}
/**********************Forward Right************************/
//If state is equal with letter 'I', car will go forward right
else if (state == 'I') {
analogWrite(motorA1, 250); analogWrite(motorA2, 0);
analogWrite(motorB1, 0); analogWrite(motorB2, 250);
}
/***********************Backward****************************/
//If state is equal with letter 'B', car will go backward
else if (state == 'B') {
analogWrite(motorA1, 0); analogWrite(motorA2, 250);
analogWrite(motorB1, 0); analogWrite(motorB2, 0);
}
/**********************Backward Left************************/
//If state is equal with letter 'H', car will go backward left
else if (state == 'H') {
analogWrite(motorA1, 0); analogWrite(motorA2, 250);
analogWrite(motorB1, 250); analogWrite(motorB2, 0);
}
/**********************Backward Right************************/
//If state is equal with letter 'J', car will go backward right
else if (state == 'J') {
analogWrite(motorA1, 0); analogWrite(motorA2, 250);
analogWrite(motorB1, 0); analogWrite(motorB2, 250);
}
/***************************Left*****************************/
//If state is equal with letter 'L', wheels will turn left
else if (state == 'L') {
analogWrite(motorA1, 0); analogWrite(motorA2, 0);
analogWrite(motorB1, 250); analogWrite(motorB2, 0);
}
/***************************Right*****************************/
//If state is equal with letter 'R', wheels will turn right
else if (state == 'R') {
analogWrite(motorA1, 0); analogWrite(motorA2, 0);
analogWrite(motorB1, 0); analogWrite(motorB2, 250);
}
/************************Stop*****************************/
//If state is equal with letter 'S', stop the car
else if (state == 'S'){
analogWrite(motorA1, 0); analogWrite(motorA2, 0);
analogWrite(motorB1, 0); analogWrite(motorB2, 0);
}
