PS2無線搖桿+雙馬達+雙舵機+LED燈 測試

cjs1748

1. 
   
2. #include <PS2X_lib.h>  //導入PS2搖桿庫v1.8
   
3. #include <Servo.h>    //導入舵機庫
   
4. PS2X ps2x;
   
5. 
   
6. int PS2 = 0;
   
7. Servo LXservo;         //建造LX舵機
   
8. Servo RXservo;         //建造LY舵機
   
9. 
   
10. const int Ain1 = 4;    // direction pin 1
    
11. const int Ain2 = 9;    // direction pin 2
    
12. const int enA = 6;    // PWM pin 控制轉速用
    
13. const int Bin1 = 7;    // direction pin 1
    
14. const int Bin2 = 8;    // direction pin 2
    
15. const int enB = 5;    // PWM pin 控制轉速用,我用minipro D9 PWM 無法使用,所以跟D5互換
    
16. 
    
17. int fspeedLY;           // 指定LY轉速變數
    
18. int fspeedRY;           // 指定RY轉速變數
    
19. 
    
20. void setup(){
    
21.   LXservo.attach(2);  // 指定LX舵機接D2腳位
    
22.   RXservo.attach(3);  // 指定RX舵機接D2腳位
    
23.   
    
24.   PS2 = ps2x.config_gamepad(13,11,10,12, true, true);   //指定PS2搖桿腳位及類比搖桿開啟
    
25.   
    
26.   pinMode(Ain1, OUTPUT);      // connection to TB6612FNG
    
27.   pinMode(Ain2, OUTPUT);      // connection to TB6612FNG
    
28.   pinMode(enA, OUTPUT);       // connection to TB6612FNG
    
29.   pinMode(Bin1, OUTPUT);      // connection to TB6612FNG
    
30.   pinMode(Bin2, OUTPUT);      // connection to TB6612FNG
    
31.   pinMode(enB, OUTPUT);       // connection to TB6612FNG
    
32.   pinMode(A0, OUTPUT);   // 三角和圓形控制的LED
    
33.   pinMode(A1, OUTPUT);   // 四方和X控制的LED
    
34.   pinMode(A2, OUTPUT);   // LY軸控制的LED燈
    
35.   pinMode(A3, OUTPUT);   // RY軸控制的LED燈
    
36.   pinMode(A4, OUTPUT);   // LX軸控制的LED燈
    
37.   pinMode(A5, OUTPUT);   // LX軸控制的LED燈
    
38.   pinMode(A6, OUTPUT);   // RX軸控制的LED燈 無作用
    
39.   pinMode(A7, OUTPUT);   // RX軸控制的LED燈 無作用
    
40.   
    
41. }
    
42. 
    
43. void loop(){
    
44.   ps2x.read_gamepad();
    
45.   
    
46.    if(ps2x.ButtonPressed(PSB_CIRCLE)) digitalWrite(A0, LOW);
    
47.    if(ps2x.ButtonPressed(PSB_TRIANGLE)) digitalWrite(A0, HIGH);
    
48.    if(ps2x.ButtonPressed(PSB_CROSS)) digitalWrite(A1, LOW);  
    
49.    if(ps2x.ButtonPressed(PSB_SQUARE)) digitalWrite(A1, HIGH);
    
50.    
    
51.    if (ps2x.Analog(PSS_LY) == 128) analogWrite(enA, 0);
    
52.    if (ps2x.Analog(PSS_LY) > 128){
    
53.     fspeedLY = map(ps2x.Analog(PSS_LY), 129, 255, 0, 150);  // LY搖桿對應馬達驅動的值 0~150即可以達到全速(配合電壓及馬達樣式調整)
    
54.     digitalWrite(Ain1, LOW);
    
55.     digitalWrite(Ain2, HIGH);
    
56.     analogWrite(enA, fspeedLY);
    
57.     digitalWrite(A2, HIGH);
    
58.   }
    
59.    if (ps2x.Analog(PSS_LY) < 128){
    
60.     fspeedLY = map(ps2x.Analog(PSS_LY), 0, 127, 150, 0);
    
61.     digitalWrite(Ain1, HIGH);
    
62.     digitalWrite(Ain2, LOW);
    
63.     analogWrite(enA, fspeedLY);
    
64.     digitalWrite(A2, LOW);
    
65.   }
    
66.    if (ps2x.Analog(PSS_RY) == 128) analogWrite(enB, 0);
    
67.    if (ps2x.Analog(PSS_RY) > 128){
    
68.     fspeedRY = map(ps2x.Analog(PSS_RY), 129, 255, 0, 150);
    
69.     digitalWrite(Bin1, LOW);
    
70.     digitalWrite(Bin2, HIGH);
    
71.     analogWrite(enB, fspeedRY);
    
72.     digitalWrite(A3, HIGH);
    
73.   }
    
74.    if (ps2x.Analog(PSS_RY) < 128){
    
75.     fspeedRY = map(ps2x.Analog(PSS_RY), 0, 127, 150, 0);
    
76.     digitalWrite(Bin1, HIGH);
    
77.     digitalWrite(Bin2, LOW);
    
78.     analogWrite(enB, fspeedRY);
    
79.     digitalWrite(A3, LOW);
    
80.   }
    
81.   
    
82.   LXservo.write(map(ps2x.Analog(PSS_LX), 0, 255, 20, 160));  // LX搖桿對應舵機角度 20~160
    
83. 
    
84.   RXservo.write(map(ps2x.Analog(PSS_RX), 0, 255, 20, 160));
    
85.   
    
86.     if (ps2x.Analog(PSS_LX) < 120){
    
87.     digitalWrite(A4, HIGH);
    
88.     digitalWrite(A5, LOW);
    
89.   }
    
90.     if (ps2x.Analog(PSS_LX) > 150){
    
91.     digitalWrite(A4, LOW);
    
92.     digitalWrite(A5, HIGH);
    
93.   }  
    
94.     if (ps2x.Analog(PSS_LX) > 120 && ps2x.Analog(PSS_LX) < 150){
    
95.     digitalWrite(A4, LOW);
    
96.     digitalWrite(A5, LOW);
    
97.   }
    
98.     if (ps2x.Analog(PSS_RX) < 120){
    
99.     digitalWrite(A6, HIGH);
    
100.     digitalWrite(A7, LOW);
     
101.   }
     
102.     if (ps2x.Analog(PSS_RX) > 150){
     
103.     digitalWrite(A6, LOW);
     
104.     digitalWrite(A7, HIGH);
     
105.   }  
     
106.     if (ps2x.Analog(PSS_RX) > 120 && ps2x.Analog(PSS_RX) < 150){
     
107.     digitalWrite(A6, LOW);
     
108.     digitalWrite(A7, LOW);
     
109.   }
     
110.   
     
111.   delay(50);
     
112. }   
     

复制代码

之前做過六個舵機的測試,結果時間一久就都忘了!!又重新測試!!
所以趕快留一個紀錄!!下次就不用再撞牆了!!

1.外部電源12V1.5A 對馬達驅動板及MINIPRO RAW腳
2.馬達驅動板邏輯電源及PS2接收器接3.3V
3.UNO 及 MINIPRO 都測試成功

董董soul

占个沙发，顶一个！如果有具体的硬件连接图就更好了

cjs1748

董董soul 发表于 2017-3-17 16:45
占个沙发，顶一个！如果有具体的硬件连接图就更好了

下午才在爬您的文說.....
您來這發言真是我這個菜鳥的榮幸!!
.
.
本來是要畫圖的,但是fritzing找不到TB6612FNG的圖,所以就放棄了....
基本上,接腳在程式內都有說明,待會再嘗試畫畫看!!

duanyz

没接触过这个ps2的无线摇杆，楼主能给点资料吗？

Ansifa

建议直接用5v电源供电，这种马达耗电不大，画图用cadsoft的eagle元件库非常丰富，多到你怕，适合进一步学习

cjs1748

Ansifa 发表于 2017-3-19 23:01
建议直接用5v电源供电，这种马达耗电不大，画图用cadsoft的eagle元件库非常丰富，多到你怕，适合进一步学习

5V我有使用過(UNO),但是減速馬達沒動作!!

cjs1748

duanyz 发表于 2017-3-19 22:53
没接触过这个ps2的无线摇杆，楼主能给点资料吗？

http://geek-workshop.com/thread-172-14-1.html
站內大神的教學~~
或是自己搜索 PS2 搖桿
資料真的是很多~~

cjs1748

使用NANO加擴充版也測試OK!!
注意喔!! PS2搖桿的電源輸入腳是沒接線的.....
但是可以正常使用.
不過D9的PWM一樣不太正常..

jasonwang1208

3Q for sharing.
無線搖桿那裡買的有連結嗎?

cjs1748

我在沒屋頂買的，不過應該也是淘寶網過來的。

悠然小调

搖桿庫下载不了啊

cjs1748

可以去外面找找看，我也不知道為何下載不了

弘毅

悠然小调 发表于 2017-3-29 14:31
搖桿庫下载不了啊

我去检查下。。。。

弘毅

cjs1748 发表于 2017-3-30 00:04
可以去外面找找看，我也不知道為何下載不了

已经修复好论坛bug了。。。莫名其妙论坛后台配置被人改了。。。结果附件失效，郁闷了。。如果可以的话看看能重传下附件吗

cjs1748

感謝熱心的弘毅兄~