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);


發表評論
所有評論
還沒有人評論,想成為第一個評論的人麼? 請在上方評論欄輸入並且點擊發布.
相關文章