效果視頻
硬件:
Arduino x1
雙舵機云臺 x1
自制LED燈盤 x1
代碼:
#include <Servo.h>
Servo myservo1; //第一個舵機
Servo myservo2; //第二個舵機
#define LED 4 //第一個LED正極接引腳4
int pos1 = 0; // 該變量用與存儲舵機1角度位置
int pos2 = 0; // 該變量用與存儲舵機2角度位置
int sd=20; //速度
void setup()
{
pinMode(LED,OUTPUT); //定義輸入
myservo1.attach(2); // 該舵機由arduino第2腳控制
myservo2.attach(3); // 該舵機由arduino第3腳控制
myservo1.write(0); // 指定舵機1轉(zhuǎn)向的角度
myservo2.write(0); // 指定舵機2轉(zhuǎn)向的角度
}
void loop()
{
for(pos1 = 0; pos1 < 180; pos1 += 1){ // 從0度到180度運動 每次步進一度
if (pos1%2==1)digitalWrite(LED,HIGH);else digitalWrite(LED,LOW); //LED燈盤閃爍
myservo1.write(pos1); // 指定舵機1轉(zhuǎn)向的角度
delay(sd); // 等待sdms讓舵機到達指定位置
if(pos1 < 90){
myservo2.write(pos1); // 指定舵機2轉(zhuǎn)向的角度 0-90
delay(sd); // 等待sdms讓舵機到達指定位置
}else{
myservo2.write(180-pos1); // 指定舵機2轉(zhuǎn)向的角度 90-0
delay(sd); // 等待sdms讓舵機到達指定位置
}
}
for(pos1 = 180; pos1 >=0 ; pos1 -= 1){ // 從0度到180度運動 每次步進一度
if (pos1%2==1)digitalWrite(LED,HIGH);else digitalWrite(LED,LOW); //LED燈盤閃爍
myservo1.write(pos1); // 指定舵機1轉(zhuǎn)向的角度
delay(sd); // 等待sdms讓舵機到達指定位置
if(pos1 > 90){
myservo2.write(180-pos1); // 指定舵機2轉(zhuǎn)向的角度 0-90
delay(sd); // 等待sdms讓舵機到達指定位置
}else{
myservo2.write(pos1); // 指定舵機2轉(zhuǎn)向的角度 180-90
delay(sd); // 等待sdms讓舵機到達指定位置
}
}
}
* 改成流水燈盤可能效果更好.
|
