Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <AFMotor.h>
- // #include <VirtualWire.h>
- AF_DCMotor motor1(1);
- AF_DCMotor motor2(2);
- AF_DCMotor motor3(3);
- AF_DCMotor motor4(4);
- //-------------------------------
- void setup()
- {
- int i;
- //Configurareceptor
- // vw_set_ptt_inverted(true);
- // vw_setup(2000);
- // vw_set_rx_pin(50);//Configura o pino 30 como rx
- // vw_rx_start();// inicia recepcao
- pinMode(50, INPUT);// configura pino30 para recepcao
- Serial.begin(9600);
- }
- //---------------------------------
- void loop()
- {
- // char cod;//Cria uma variavel armazenar o dado recebido.
- // uint8_t buf[VW_MAX_MESSAGE_LEN]; //Recebe os dados e armazena na var buf
- // uint8_t buflen = VW_MAX_MESSAGE_LEN; //Armazena na tamanho dado recebido
- // if (vw_get_message(buf, &buflen)) //observa dado recebido)
- if (Serial.available() > 0)
- {
- char cod = Serial.read();
- // cod = buf[0]; //Converte em Char
- // Serial.println(cod); //para observar possiveis erros
- if (cod == 'F') // Compara a informação recebida e executa motores
- {
- Serial.print("Frente ");
- Serial.println(cod);
- motor1.setSpeed(75);
- motor2.setSpeed(75);
- motor3.setSpeed(75);
- motor4.setSpeed(75);
- motor1.run(FORWARD);
- motor2.run(FORWARD);
- motor3.run(FORWARD);
- motor4.run(FORWARD);
- }
- else if (cod == 'T')
- {
- Serial.print("Traseira ");
- Serial.println(cod);
- motor1.setSpeed(75);
- motor2.setSpeed(75);
- motor3.setSpeed(75);
- motor4.setSpeed(75);
- motor1.run(BACKWARD);
- motor2.run(BACKWARD);
- motor3.run(BACKWARD);
- motor4.run(BACKWARD);
- }
- else if (cod == 'D')
- {
- Serial.print("Direita ");
- Serial.println(cod);
- motor1.setSpeed(75);
- motor2.setSpeed(75);
- motor3.setSpeed(75);
- motor4.setSpeed(75);
- motor1.run(FORWARD);
- motor2.run(BACKWARD);
- motor3.run(FORWARD);
- motor4.run(BACKWARD);
- }
- else if (cod == 'E')
- {
- Serial.print("Esquerda ");
- Serial.println(cod);
- motor1.setSpeed(75);
- motor2.setSpeed(75);
- motor3.setSpeed(75);
- motor4.setSpeed(75);
- motor1.run(BACKWARD);
- motor2.run(FORWARD);
- motor3.run(BACKWARD);
- motor4.run(FORWARD);
- }
- else if (cod == 'X')
- {
- Serial.print("Release ");
- Serial.println(cod);
- motor1.run(RELEASE);
- motor2.run(RELEASE);
- motor3.run(RELEASE);
- motor4.run(RELEASE);
- }
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement