Lectura XBee Receptor para poder gobernar mi mountainboard

International Español
20

Mira yOPERO

Algo así? seguro que tengo algo mal pero no se hacer otra cosa...... mi neurona me da hasta aqui. :grin:

#include <Servo.h>

Servo servo4;
Servo servo5;
int pin_motor = 3;
int pin_rec = 2;

char array1[4] = { '0', '0', '0', '0'};

void setup()
{

Serial.begin(19200);

servo1.attach(4);
servo2.attach(5);
pinMode(pin_motor, OUTPUT);
pinMode(pin_rec, OUTPUT);
}

void loop(){

while (Serial.available() == 0) {
array1[0] = 0;
array1[1] = 0;
array1[2] = 0;
array1[3] = 0;
}

{

if (Serial.available() >= 4) {
for ( int i = 0; i < 4; i++)
array1 = Serial.read();

  • }*
  • Serial.print(array1[0]);*
  • Serial.print(array1[1]);*
  • Serial.print(array1[2]);*
  • Serial.print(array1[3]);*
  • servo1.write(array1[0]);*
  • servo2.write(array1[1]);*
  • pin_motor.write(array1[2]);*
  • pin_rec.write(array1[3]);*
    }
    }