2016年9月27日 星期二

[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

1 則留言:

  1. 請問如何將--下列程式 Upload 到 Arduino 板子裡,然後在上電的情況下組裝機械手臂。

    回覆刪除