El control de reguladores de velocidad con Arduino. (2 / 3 paso)

Paso 2: programación

/ / Si usted necesita cualquier ayuda a sentir a PM me gratis (simonfrfr) o correo electrónico
en newtonlabs
ReadString cadena;
#include < Servo.h >
Servo myservo;  crear objeto servo para controlar un servo
Servo myservo2; crear el segundo objeto de servo
const int izquierda = 10; perno del motor izquierdo en arduino
const int derecha = 9; perno del motor de arduino a la derecha
void setup() {}
Serial.Begin(9600);
Serial.println("servo-test-22-dual-INPUT"); así que puedo hacer un seguimiento de lo que se carga
}

void loop() {}
mientras (Serial.available()) {}
char c = Serial.read();  Obtiene un byte del buffer serial
readString += c; hace la cadena readString
Delay(2);  bucle lento para permitir que el búfer se llene con el siguiente carácter
}

Si (readString.length() > 0) {}
Serial.println(readString);  para que pueda ver la cadena capturada
Si (readString == "l") / / acfivates izquierda servo sólo
{
myservo.Attach(left); escribir tanto al motor izquierdo
myservo2.Attach(left);
}
Si (readString == "r") / / activa el servo derecho sólo
{
myservo.Attach(right); escribir tanto al motor izquierdo
myservo2.Attach(right);
}
Si (readString == "b") / / activa ambos motores
{
myservo.Attach(left); escritura al motor izquierdo
myservo2.Attach(right); escrito al motor adecuado
}
int n = readString.toInt();  readString a convertir un número

auto select valor apropiado, copiado de alguien elses código.
Si (n > = 500)
{
Serial.Print ("microsegundos de la escritura:"); pantalla serial
Serial.println(n); número
myservo.writeMicroseconds(n); escribe a puertos
myservo2.writeMicroseconds(n);
}
otra cosa
{
Serial.Print ("ángulo de escritura:"); pantalla serial
Serial.println(n); número
myservo.Write(n); escribe a puertos
myservo2.Write(n);
}

readString = ""; vacío para la siguiente entrada
}
}