Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- int x; // Variaveis Para armazenar os valores do JOYSTICK
- int y;
- int EX;
- int EY; // Variaveis dos valores mapeados do JOYSTICK
- int A;
- int B;
- int C; // Variaveis dos Botões do Shield Joystick
- int D;
- int E;
- int F;
- byte MD; // MOTOR DIREITO
- byte ME; // MOTOR ESQUERDO
- int led_direito = 10;
- int led_esquerdo = 9;
- void setup() {
- Serial.begin(9600); // Inicia a comunicação serial
- pinMode(led_direito, OUTPUT);
- pinMode(led_esquerdo, OUTPUT);
- }
- void loop() {
- x = analogRead(A1); // LEITURA A DOS EIXOS X E Y DO JOYSTICK
- y = analogRead(A2);
- EX = map(x,0,1023,0,255); // MAPEANDO OS EIXOS DE 0-1023 PARA 0-255
- EY = map(y,0,1023,0,255);
- A = digitalRead(2);
- B = digitalRead(3);
- C = digitalRead(4); // Leitura dos pinos digitais do Shield Joystick
- D = digitalRead(5);
- E = digitalRead(6);
- F = digitalRead(7);
- // |----------------------------|
- // | FUNÇÃO VAREDURA DO JOYSTICK|
- // |----------------------------|
- if ( (EX == 125 || EX == 126)&&(EY == 124 || EY == 125) ){ // CONDIÇÃO DOS MOTORES PARADOS
- MD = 0;
- ME = 0;
- //analogWrite(led_direito, MD);
- //analogWrite(led_esquerdo, ME);
- //Serial.println("parado");
- Serial.println(MD);
- Serial.println(ME);
- // delay(1000);
- }
- if ((EX == 125 || EX == 124) && (EY < 124)){ // INDO PRA FRENTE
- MD = ((123 + (EY*(-1))) + 132);
- ME = ((123 + (EY*(-1))) + 132);
- //analogWrite(led_direito, MD);
- //analogWrite(led_esquerdo, ME);
- // Serial.println("frente");
- Serial.println(MD);
- Serial.println(ME);
- // delay(1000);
- }
- if ((EX == 125 || EX == 124) && (EY > 125)){ // DANDO A RÉ
- MD = EY;
- ME = EY;
- //analogWrite(led_direito, MD);
- //analogWrite(led_esquerdo, ME);
- // Serial.println("re");
- Serial.println(MD);
- Serial.println(ME);
- // delay(1000);
- }
- if ( (EY == 124 || EY == 125) && (EX < 125)){ // DIREITA
- MD = ((124 + (EX*(-1))) + 130);
- ME = ((124 + (EX*(-1))) + 130);
- //analogWrite(led_direito, MD);
- //analogWrite(led_esquerdo, ME);
- // Serial.println("direita");
- Serial.println(MD);
- Serial.println(ME);
- // delay(1000);
- }
- if ( (EY == 124 || EY == 125) && (EX > 126)){ // ESQUERDA
- MD = EX;
- ME = EX;
- //analogWrite(led_direito, MD);
- //analogWrite(led_esquerdo, ME);
- //Serial.println("esquerda");
- Serial.println(MD);
- Serial.println(ME);
- // delay(1000);
- }
- if ((EX < 125)&&(EX > 0 || EX == 0)&&(EY < 124)&&(EY > 0 || EY == 0)){ // VIRANDO A DIREITA - FRENTE
- MD = (EX);
- ME = (EY + 130);
- //analogWrite(led_direito, MD);
- //analogWrite(led_esquerdo, ME);
- //Serial.println("direita - frente");
- Serial.println(MD);
- Serial.println(ME);
- // delay(1000);
- }
- if ((EX > 126)&&(EX < 255 || EX == 255)&&(EY > 0 || EY == 0)&&(EY < 124)){ // VIRANDO A ESQUERDA - FRENTE
- MD = (EY + 130);
- ME = (255 - EX);
- //analogWrite(led_direito, MD);
- //analogWrite(led_esquerdo, ME);
- // Serial.println("esquerda-frente");
- Serial.println(MD);
- Serial.println(ME);
- // delay(1000);
- }
- if ((EX > 0 || EX == 0)&&(EX < 125)&&(EY > 125)&&(EY < 255 || EY == 255)){ // VIRANDO A DIREITA - TRÁS
- MD = EX;
- ME = ((255-EY)+123);
- //analogWrite(led_direito, MD);
- //analogWrite(led_esquerdo, ME);
- //Serial.println("direita - tras");
- Serial.println(MD);
- // Serial.println(ME);
- // delay(1000);
- }
- if ((EX < 255 || EX == 255)&&(EX > 126)&&(EY > 125)&&(EY < 255 || EY == 255)){ // VIRANDO A ESQUERDA - TRÁS
- MD = EX;
- ME = (EY - 125);
- //analogWrite(led_direito, MD);
- //analogWrite(led_esquerdo, ME);
- //Serial.println("esquerda - tras");
- Serial.println(MD);
- Serial.println(ME);
- // delay(1000);
- }
- /*if (E == 0){
- Serial.println("Botão E pressionado");}
- if (A == 0){
- Serial.println("Botão A pressionado");}
- if (B == 0){
- Serial.println("Botão B pressionado");} // COMANDOS A SEREM INSERIDOS PARA OS BOTÕES
- if (C == 0){
- Serial.println("Botão C pressionado");}
- if (D == 0){
- Serial.println("Botão D pressionado");}
- if (F == 0){
- Serial.println("Botão F pressionado");}*/
- } // Fechamento Loop
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement