機械手臂自動展示

使用arduino 燒錄

自動展示程式碼:

#include <Servo.h>//匯入servo這個library

Servo spin, claw, x, y;// 建立 spin(底部), claw(夾子), x(前後), y(上下)這些 Servo 物件

int claw_open = 45;//設定夾爪開啟的角度

int claw_close = 85;//設定夾爪關閉的角度

void setup() {

spin.attach(7);// 左右為pin7

claw.attach(8);// 夾子為pin8

x.attach(9);// 前後右臂為pin9

y.attach(10);// 上下左臂為pin10

}

void loop() {

for (int i = 0; i<90; i++) { //使伺服馬達spin一度一度由 0 度旋轉到 90 度

spin.write(i);

delay(30);

}

for(int i = 80; i<180; i++) { //使伺服馬達y一度一度由80度旋轉到 180 度

y.write(i);

delay(30);

}

for (int i = 0; i<3; i++) { //使爪子開關三次

claw.write(claw_close);

delay(200);

claw.write(claw_open);

delay(200);

}

delay(2000);

claw.write(claw_close); //關爪子

delay(100);

for(int i = 90; i>1; i--) { //使伺服馬達spin一度一度由 90 度旋轉到 0 度

spin.write(i);

delay(30);

}

for(int i = 180; i>80; i--) { //使伺服馬達Y一度一度由 180 度旋轉到 80 度

y.write(i);

delay(30);

}

claw.write(claw_open); //開爪子

delay(500);

}