摇杆有 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);