MONSTER BOT (3 / 4 stap)

Stap 3: CODE voor MONSTER BOT

# INCLUDEN < SoftwareSerial.h > / / Inicialización de El El El El El El los pins bluetoothTx int = 1; bluetoothRx int = 0; / / Variabelen Que la ONU correspond alfiler CADA pin de la Arduino 0 y el pin 1 nl Si de de de de de de han omitido ya Que se utilizan en la Comunicación serie nl Si Establece Entre pin2 int Arduino y el module Bluetooth = 2; pin3 int = 3; int pin4 = 4; pin5 int = 5; pin6 int = 6; pin7 int = 7; pin8 int = 8; pin9 int = 9; PIN10 int = 10; PIN11 int = 11; PIN12 int = 12; Pin13 int = 13; / / El control de de de de de Varables utilizado Parr Controlar la VELOCIDAD del motor de la CC int VELOCIDAD = 255; snelheden2 int = 255; Bluetooth SoftwareSerial (bluetoothTx, bluetoothRx); / / Declaracion de los Métodos Que usaremos void vooruit (); Vacío inversa (); VOID giro_derecha (); VOID giro_izquierda (); VOID pararMotorTraccion (); VOID pararMotorDireccion (); void (encenderLuz); void (apagarluz); void (encenderComponente); void (apagarComponente); void (encenderComponente2); void (apagarComponente2); void (encenderComponente3); void (apagarComponente3); void modificarVelocidad (int NIVEL); void setup () {/ / Comienza la serie Comunicación Con El USB y Han de DE COMO pinos de Salida Que utilizaremos Serial.begin (9600); pinMode (pin2, OUTPUT); pinMode (pin3, OUTPUT); pinMode (pin 4, OUTPUT); pinMode (pin5, OUTPUT); pinMode (pin6, OUTPUT); pinMode (pin7, OUTPUT); pinMode (contacto 8, OUTPUT); pinMode (pin9, OUTPUT); pinMode (PIN10, OUTPUT); pinMode (PIN11, OUTPUT); pinMode (PIN12, OUTPUT); pinMode (Pin13, OUTPUT); / / Configuracion de La Conexión nl serie de estafa bluetooth bluetooth.begin android (115.200), bluetooth.print ("$ $ $"), de retardo (100); bluetooth.println ("U 9600, N "); Bluetooth.begin (9600); } Bucle Void () {/ / Leer y ESCRIBIR nl el Bluetooth de serie si (bluetooth.available ()) {recibido = Carácter bluetooth.read (); Tosend charlas = (char), bluetooth.read (); Serial.Print (Tosend); } / / Si el arduino android sends Algo Que este método Tiene el Carácter Que Yo os mando / / y Sí Basa nl Que se ejecuta el Método Deseado als (Serial.available ()) {Tosend charlas = (char) Serial.read (); bluetooth.print (Tosend); Interruptor (Tosend) {/ / si si output Una C entra en el Modo de control de la Pantalla Cardux Casó 'C': / / Lea el siguiente pin y estafa de la base de de de de nl El Número o letra luces pin Correspondiente si (). de serie beschikbaar ()) {toSend2 char = (char) Serial.read (); bluetooth.print (toSend2); Interruptor (toSend2) {pulseren El Botã³n / / Forward Casó 'W': Adelante (pin5, pin6); mameluco; Atrás Botã³n Presionado / / case is ': Marcha Atrás (pin5, pin6); mameluco; Caso pulseren / / IZQUIERDA 'A': giro_izquierda (PIN2-, pin 3); mameluco; / / Botón Caso presionado derecho zou ': giro_derecha (PIN2-, pin 3); mameluco; / / Este Método SE ENCUENTRA está nl Marcha Parr DEJAR de presionar El Botã³n de Avance o Retroceso Casó 'Z': pararMotor (pin5, pin6); mameluco; / / Este Método Caso SE ENCUENTRA CUANDO SE ejecuta suelta El Botã³n de la Derecha o Izquierda Hacia la 'X': pararMotor (PIN2-, pin 3); Rompen; / / Cuando Cambian las luces está nl Estado Caso Encendido 'Ik': encenderLuz (pin4); Rompen; / / Cuando Las Luces Cambian al Estado Apagado Casó ' o ': apagarluz (pin4); mameluco; / / Caso de de de 'H' de de de Cuando el Interruptor kent nl la comp1 Estado: encenderComponente (contacto 8); rompo; / / Cuando el Interruptor está nl Estado ik comp1 uit zaak "B": apagarComponente (contacto 8); mameluco; / / Caso de de de de de Cuando el Interruptor kent nl la comp2 Estado 'J': encenderComponente (pin9); rompo; / / Cuando el Interruptor está nl Estado I COMP2 Caso uit 'N': apagarComponente (pin9); mameluco; / / Caso de de de de de de Cuando el Interruptor kent nl la comp3 Estado 'K': encenderComponente (PIN10); rompo; / / Cuando el Interruptor está nl Estado I COMP3 uit zaak ben ': apagarComponente (PIN10); mameluco; / / Si la Aplicación está nl pausa, POR EJEMPLO, Parr salir de la Aplicación o CUANDO Una abstract de Los Motores Que se conectan een los pinos el 5 y 6 y Los Pinos continuo 2 y 3 / / Para Evitar HACER giro y el control de de de de el de el del Tiene Que Proyecto, si USTED QUIERE vuelta dar Pecado Algo Más SÓLO Tiene Que ESQUEMA ESQUEMA ESQUEMA ESQUEMA ESQUEMA ESQUEMA Añadir la línea de Cã³digo Que DESEA Caso ejecutar 'x': pararMotor (pin5, pin6); pararMotor (PIN2-, pin 3); mameluco; / / Procedimiento De Control de tracción de Velocidad del motor nl el carro Casó 'V': als (Serial.available ()) {toSend3 char = (carbón de leña) Serial.read (); bluetooth.print (toSend3); Interruptor (toSend3) {/ / basado nl el valor Que el el el el el el usted búsqueda es la VELOCIDAD Que el cesta caminando 64 es El Más Bajo Y 255 El Más Alto ' 0 Casó ': modificarVelocidad (64); mameluco; Caso 1 ": modificarVelocidad (96); mameluco; Caso 2": modificarVelocidad (128); mameluco; Caso '3': modificarVelocidad (172); mameluco; Caso '4': modificarVelocidad (255); mameluco; }} Onderbreking; } / / Fin de Interruptor toSend2} / / Fin de Si Se Rompen; } Adelante Void (int Pin1, PIN2-int) {analogWrite (Pin1, laag); analogWrite (PIN2-, VELOCIDAD); digitalWrite (Pin13, hoge);} Inversa Void (int Pin1, PIN2-int) {analogWrite (Pin1, VELOCIDAD); analogWrite (Pin2, laag); digitalWrite (Pin13, hoge);} Vacío PararMotor (int Pin1, PIN2-int) {digitalWrite (Pin1, laag); digitalWrite (pin2, laag); digitalWrite (Pin13, laag);} Void ModificarVelocidad (int NIVEL) {VELOCIDAD = vel;} Void ModificarVelocidad2 (int NIVEL) {snelheden2 = vel;} Void Giro_izquierda (int Pin1, PIN2-int) {digitalWrite (pin2, laag); digitalWrite (Pin1, snelheden2); digitalWrite (Pin13, hoge);} Void Giro_derecha (int Pin1, PIN2-int) {digitalWrite (Pin2, snelheden2); digitalWrite (Pin1, laag); digitalWrite (Pin13, hoge);} Vacío encenderLuz (int pin) {digitalWrite (pin, hoge);} Void Apagarluz (int pin) {digitalWrite (pin, laag);} Void EncenderComponente (int pin) {digitalWrite (pin, hoge);} Void ApagarComponente (int pin) {digitalWrite (pin, laag);} Vacío EncenderPin (int pin) {digitalWrite (pin, hoge);} Void ApagarPin (int pin) {digitalWrite (pin, laag);}