[Arduino]Day-8-Servo_Motor

利用Com埠送控制命令
控制Servo Motor

一如往常，組機構與找螺絲鎖孔的時間占了九成....

機構孔徑大小不合，鎖孔位置只能將就，基本上就是能鎖就好，其他就不要多要求。

=======================================================
#include <Servo.h>

#define MotorA_in1     8  //定義 馬達A in 1
#define MotorA_in2     9  //定義 馬達A in 2
#define MotorB_in1    10  //定義 馬達B in 1 to L298N IN3
#define MotorB_in2    11  //定義 馬達B in 2 to L298N IN4
#define MotorA_PWNA    5  //定義 ENA (PWM) 接腳
#define MotorB_PWNB    6  //定義 ENB (PWM) 接腳

// 伺服馬達(舵機)
#define Servo_Pin      2  // 定義伺服馬達輸出腳位(PWM)
#define servo_delay  250  // 伺服馬達轉向後的穩定時間
Servo myservo;            // 宣告伺服馬達變數
int val;
int dir;
void setup()
{
  pinMode(MotorA_in1,OUTPUT);
  pinMode(MotorA_in2,OUTPUT);
  pinMode(MotorB_in1,OUTPUT);
  pinMode(MotorB_in2,OUTPUT);
  pinMode(MotorA_PWNA,OUTPUT);
  pinMode(MotorB_PWNB,OUTPUT);

  myservo.attach(Servo_Pin);
  Serial.begin(9600);//
  Serial.println("servo=o_seral_simple ready" ) ;
}

void loop()
{

val=Serial.read();//
if(val>'0'&&val<='9')
{
  val=val-'0';
  dir=val*(180/9);//
  Serial.print("moving servo to ");
  Serial.print(dir,DEC);
  Serial.println();
  myservo.write(dir);
  delay(servo_delay);  // 等待伺服馬達穩定
}

}