Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <Servo.h>
- int HEADER_LEN = 2;
- const char seqHeader[] = {'~','!'};
- Servo BOLA1; //Creación de servos
- Servo BOLA2;
- Servo BOLA3;
- Servo BOLA4;
- int i = 0;
- int incomingByte[8];
- int val1;
- int val2;
- int val3;
- int val4;
- void setup()
- {
- BOLA1.attach(9); // Asignación de pines
- BOLA2.attach(10);
- BOLA3.attach(11);
- BOLA4.attach(12);
- Serial.begin(115200);
- }
- void loop()
- {
- if (Serial.available() >= 4) // Canales de Entrada al Arduino
- {
- for (int i=0; i<8; i++) { // Lectura del último byte en el buffer
- incomingByte[i] = Serial.read();// Lectura de cada byte
- }
- //BOLA1
- val1 = incomingByte[0];
- val1 = map(val1, 0, 255, 0, 90 ); // Valor posición mínima y posición máxima del servo
- BOLA1.write(val1);
- delay(15);
- //BOLA2
- val2 = incomingByte[1];
- val2 = map(val2, 0, 255, 0, 90 );
- BOLA2.write(val2);
- delay(15);
- //BOLA3
- val3 = incomingByte[2];
- val3 = map(val3, 0, 255, 0, 90 );
- BOLA3.write(val3);
- delay(15);
- //BOLA4
- val4 = incomingByte[3];
- val4 = map(val4, 0, 255, 0, 90 );
- BOLA3.write(val4);
- delay(15);
- }
- }
Add Comment
Please, Sign In to add comment