Paso 19: programa
Aquí es un programa que se ejecuta todos los servos y un altavoz pequeño:////////////////////////// ARDUINO /////////////////////
las pruebas de los servos y el sonido
#include < Servo.h >
Servo armRight; crear objeto servo para controlar un servo
int pos = 0; variable para almacenar la posición del servo
Servo armLeft;
Cabeza del servo;
Servo Wheelwright;
Servo wheelLeft;
int soundPin = 3;
int de paso;
void setup()
{
armRight.attach(11);
Head.Attach(10);
armLeft.attach(9);
wheelRight.attach(6);
wheelLeft.attach(5);
}
void loop()
{
para (pos = 0; pos < 180; pos += 1) / / va desde 0 grados a 180 grados
{/ / en pasos de 1 grado
armLeft.write(pos);
armRight.write(pos); Dile el servo a la posición en la variable 'pos'
Head.Write(POS);
wheelRight.write(pos);
wheelLeft.write(pos);
Pitch = mapa (pos 0, 180, 31,4978); mapa de posición a tono
tono (soundPin, campo, 200); ¿PIN, nota, tiempo?
Delay(15); espera 15ms para el servo a la posición
}
para (pos = 180; pos > = 1; pos-= 1) / / va de 180 grados a 0 grados
{
armLeft.write(pos);
armRight.write(pos); Dile el servo a la posición en la variable 'pos'
Head.Write(POS);
wheelRight.write(pos);
wheelLeft.write(pos);
Pitch = mapa (pos 0, 180, 31,1000);
tono (soundPin, campo, 200); ¿PIN, nota, tiempo?
Delay(15);
} / / espera 15ms para el servo a la posición
}