Paso 12: Los códigos de Arduino (C++)
Simplemente sube el bosquejo a su Arduino. Si tienes un controlador de Motor de VNH5019 de chip, los códigos funcionaría como magia! Por cierto, usted necesitará Descargar e instalar la biblioteca en orden para los códigos de trabajo.
__________________________________________________________________
#include "DualVNH5019MotorShield.h"
DualVNH5019MotorShield md;
char dataIn = de '; determinante de char, char det; vel int = 0; Cosas de Bluetooth
int potencia = 4; Eliminar esto para activar el conmutador de Tollge #2
overdrive de int = 13; Pulsa el interruptor #1, el pin13 LED se encenderá
void setup() {}
Serial.Begin(9600);MD.init();
/ * pinMode (potencia, salida); * //toggle interruptor de función
pinMode (overdrive, salida);
}
void loop() {det = check();
mientras que (det == 'F') / / F, avanzar
{md.setSpeeds (vel, vel); det = check();}
mientras que (det == 'B') / / B, retroceder
{md.setSpeeds (- vel, - vel); det = check();}
mientras que (det == 'L') / / L, ruedas de movimiento a la izquierda
{md.setSpeeds (vel/4 vel); det = check();}
mientras que (det == 'R') / / R, ruedas de movimiento derecha
{md.setSpeeds (vel vel/4); det = check();}
mientras que (det == 'I') / / I, girar a la derecha hacia delante
{md.setSpeeds (vel vel/2); det = check();}
mientras que (det == 'J') / / J, girar a la derecha de nuevo
{md.setSpeeds (- vel, - vel/2); det = check();}
mientras que (det == 'G') / / G, girar a la izquierda hacia delante
{md.setSpeeds (vel vel/2,); det = check();}
mientras que (det == 'H') / / H, girar a la izquierda detrás
{md.setSpeeds (vel - vel/2,-); det = check();}
mientras que (det == de ') / / S, parada
{md.setSpeeds (0,0); det = check();}
---Interruptor código---/ /
/ * mientras (det == 'U')
{digitalWrite (energía, HIGH); det = check();}
mientras que (det == 'u')
{digitalWrite (energía, LOW); det = check();} */
//---------------------Mains Power------------------//
mientras que (det == 'W')
{digitalWrite (overdrive, HIGH); det = check();}
mientras que (det == 'w')
{digitalWrite (overdrive, LOW); det = check();}
}
check() int
{Si (Serial.available() > 0) {dataIn = Serial.read();
Si (dataIn == 'F') {determinante = 'F';}
else if (dataIn == 'B') {determinante = 'B';} else if (dataIn == 'L') {determinante = 'L';}
else if (dataIn == 'R') {determinante = 'R';} else if (dataIn == 'I') {determinante = 'I';}
else if (dataIn == 'J') {determinante = 'J';} else if (dataIn == 'G') {determinante = 'G';}
else if (dataIn == 'H') {determinante = 'H';} else if (dataIn == de ') {determinante = de ';}
else if (dataIn == '0') {vel = 400;} else if (dataIn == '1') {vel = 380;}
else if (dataIn == '2') {vel = 340;} else if (dataIn == '3') {vel = 320;}
else if (dataIn == '4') {vel = 280;} else if (dataIn == '5') {vel = 240;}
else if (dataIn == '6') {vel = 200;} else if (dataIn == '7') {vel = 160;}
else if (dataIn == '8') {vel = 120;} else if (dataIn == '9') {vel = 80;}
else if (dataIn == 'q') {vel = 40;} else if (dataIn == 'U') {determinante = 'U';}
else if (dataIn == 'u') {determinante = 'u';} else if (dataIn == 'W') {determinante = 'W';}
else if (dataIn == 'w') {determinante = 'w' ;}} volver determinante;}