|
|
- #include <Servo.h> // 聲明調(diào)用Servo.h庫
- Servo myservo; // 創(chuàng)建一個(gè)舵機(jī)對象
- int pos = 0;
- // 變量pos用來存儲舵機(jī)位置
- void setup() {
- Serial.begin(9600); //串口波特率(使用藍(lán)牙串口必需此句)
- //舵機(jī)引出三根線。一根是紅色，連到+5V上。一根棕色（有些是黑的），連到GND。
- //還有一根是黃色或者橘色，連到數(shù)字引腳9。
- myservo.attach(9); // 將引腳9上的舵機(jī)與聲明的舵機(jī)對象連接起來
- }
- void loop() {
- while(Serial.available()) //判斷緩沖器狀態(tài)。
- {
- char c=Serial.read(); //讀取串口
- if(c=='A') //判斷串口是否等于A
- {
- for(pos = 0; pos < 60; pos += 1){ // 舵機(jī)從0°轉(zhuǎn)到180°，每次增加1°
- myservo.write(pos); // 給舵機(jī)寫入角度
- delay(15); // 延時(shí)15ms讓舵機(jī)轉(zhuǎn)到指定位置
- }
- Serial.println("LEFT");// 串口輸出數(shù)據(jù)并帶回車符。
- }
- if(c=='B') //判斷串口是否等于B
- {
- for(pos = 60; pos>=1; pos-=1) { // 舵機(jī)從180°轉(zhuǎn)回到0°，每次減小1°
- myservo.write(pos); // 寫角度到舵機(jī)
- delay(15); // 延時(shí)15ms讓舵機(jī)轉(zhuǎn)到指定位置
- }
- Serial.println("RIGHT");// 串口輸出數(shù)據(jù)并帶回車符。
- }
- }
- }
|
|
