用 Arduino制作机器人眼球

第4步安装伺服电机

传感器安装好之后，把伺服电机安装在扩展板的脚9上，编程测试。

软件程序：

#include<Servo.h> // include servo library
Servo pescoco; // create servo object tocontrol a servo
int pos =0;
int irdireita = 10;
int iresquerda = 12;
int ircentro = 11;
int tempo = 50;

void setup (){
pescoco.attach(9); // attaches the servo on pin 9to the servo object
pinMode (irdireita, INPUT); // set pin irdireita(pin10) as input
pinMode (iresquerda, INPUT); // set piniresquerda (pin12) as input
pinMode (ircentro, INPUT); // set pin ircentro(pin11) as input
}
void loop(){
int valdireita = digitalRead (irdireita);
int valesquerda = digitalRead (iresquerda);
int valcentro = digitalRead (ircentro);

if (valdireita == LOW){
pescoco.write(180);
pos = (180);
delay (tempo);
}
else if(valesquerda == LOW){
pescoco.write (0);
pos =(0);
delay (tempo);
}
else if (valcentro == LOW){
pescoco.write (90);
pos = (90);
delay (tempo);
}
else {
pescoco.write (pos);
delay (tempo);
}
}