Arduino 搖桿控制 舵機

搖桿有 V H 兩個軸 和 B 一個按鈕。他們的值都是模擬量，要用模擬信號做。

其中 V H 軸 實際是一個抽頭電阻，但是一般來說數值不是非常穩定，需要設計一些近似量。

部分代碼如下。

void setup(){
  vServo.attach(vServoPin);//attach singal pin to servo;
  hServo.attach(hServoPin);//attach singal pin to servo;
  pinMode(buttonVal,INPUT);
  Serial1.begin(9600);
}
void loop(){
  //ps2 control
  vJoyVal = analogRead(vJoyPin);
  hJoyVal = analogRead(hJoyPin);
  //bJoyVal = analogRead(bJoyPin);
  if((int)((vJoyVal - 500)/100) != 0){
    vPos = vPos + (int)((vJoyVal - 500)/100);
    vServo.write(vPos);
  }
  if((int)((hJoyVal - 500)/100) != 0){
    hPos = hPos + (int)((hJoyVal - 500)/100);
    hServo.write(hPos);
  }
  delay(100);