[Servo] 指定舵機(伺服馬達)特定角度

為了在安裝機械手臂時不損壞機構件與伺服馬達，也為了在上電後不必為了不妥適的安裝而調整程式，為了避免在最壞的情況下打掉重練(拆掉重新組裝)，在將塑膠片鎖固到馬達時，建議將下列程式 Upload 到 Arduino 板子裡，然後在上電的情況下組裝機械手臂。

電路接線

伺服馬達有3條線，紅色需接 5V，棕色需接 GND，橘色為訊號線，需接 Arduino 的腳位，電路接法如下：

Arduino      伺服馬達訊號線
D2              底座馬達
D3              右馬達
D4              左馬達
D5              夾子馬達


程式碼

#include <Servo.h>
Servo s1,s2,s3,s4;

void setup()
{
  s1.attach(2);
  s2.attach(3);
  s3.attach(4);
  s4.attach(5);

  s1.write(90); // 底座馬達
  s2.write(90); // 右馬達
  s3.write(170); // 左馬達
  s4.write(90); // 夾子馬達
}

void loop() {}


相關連結

SG90 Datasheet http://www.micropik.com/PDF/SG90Servo.pdf
MG90S Datasheet http://www.electronicoscaldas.com/datasheet/MG90S_Tower-Pro.pdf