搖桿控制機器人







#include <Servo.h>

Servo base, head, base2, head2;

void setup() {
  base.attach(10);  //把伺服馬達1的橘黃色信號線連接到D10
  head.attach(11);  //把伺服馬達2的橘黃色信號線連接到D11

  base2.attach(12);  //把伺服馬達1的橘黃色信號線連接到D12
  head2.attach(13);  //把伺服馬達2的橘黃色信號線連接到D13


}

int base_degree = 90;
int head_degree = 90;
int base2_degree = 90;
int head2_degree = 90;

void loop() {
  int vrx = analogRead(A1);
  int vry = analogRead(A2);

  int vrx2 = analogRead(A3);
  int vry2 = analogRead(A4);


  base_degree = map(vrx, 0, 1023, 0, 180); //搖桿VRx接到A1
  head_degree = map(vry, 0, 1023, 0, 180); //搖桿VRy接到A2

  base2_degree = map(vrx2, 0, 1023, 0, 180); //搖桿VRx接到A3
  head2_degree = map(vry2, 0, 1023, 0, 180); //搖桿VRy接到A4


  base.write(base_degree);
  head.write(head_degree);

  base2.write(base2_degree);
  head2.write(head2_degree);



}

留言