步进电机驱动问题，懂的帮忙解决下

BlackCat

先上代码。

1. #include <Stepper.h>
   
2. const int stepsPR = 200;
   
3. 
   
4. Stepper myStepper1(stepsPR,30,31,32,33);
   
5. Stepper myStepper2(stepsPR,50,51,52,53);
   
6. 
   
7. int xpotPin = 2;
   
8. int ypotPin = 3;
   
9. int bpotPin = 4;
   
10. int xval = 0;
    
11. int yval = 0;
    
12. int bval = 0;
    
13. 
    
14. void setup(){
    
15.   myStepper1.setSpeed(60);
    
16.   myStepper2.setSpeed(60);
    
17.   Serial.begin(9600);
    
18. }
    
19. 
    
20. void loop(){
    
21. xval = analogRead(xpotPin);
    
22. yval = analogRead(ypotPin);
    
23. bval = analogRead(bpotPin);
    
24. 
    
25. if (xval<250){
    
26.     Serial.print("go");
    
27.    myStepper1.step(stepsPR);
    
28.    myStepper2.step(stepsPR);
    
29. }
    
30.   if (xval>650){
    
31.     Serial.print("back");
    
32.    myStepper1.step(-stepsPR);
    
33.    myStepper2.step(-stepsPR);
    
34. }
    
35.   if (yval<250){
    
36.     Serial.print("left");
    
37.    myStepper1.step(stepsPR);
    
38.    myStepper2.step(-stepsPR);
    
39. }
    
40.    if (yval>650){
    
41.     Serial.print("right");
    
42.    myStepper1.step(-stepsPR);
    
43.    myStepper2.step(stepsPR);
    
44. }
    
45. }

复制代码

目的，PS2摇杆控制2个步进电机A和B
PS2      电机A    电机B
x+       +            +
x-        -              -
y+       +            -
y-         -             +


也就是说
摇杆x轴向上，A,B电机同时正向转动
摇杆X轴向下，A,B电机同时反向转动
摇杆Y轴向左，A电机反转，B电机正转
摇杆Y轴向右，A电机正转,B电机反转

但是实际操作中，当A电机 转动完成后B电机才转。

问题：如何让两个电机同步转动。

希望懂的朋友帮忙解答一下，谢谢。

pww999

算法不对，冲突了吧？

BlackCat

能解释的详细点吗？

pww999

假设这2个同时工作,  摇杆x轴向上摇杆Y轴向左
会出现什么问题？

改成这样试试
if

else if

else if


else

BlackCat

pww999 发表于 2012-6-28 19:31
假设这2个同时工作,  摇杆x轴向上摇杆Y轴向左
会出现什么问题？

没效果，还是一个转完了另一个才转。

BlackCat

自己写成这样的话，两个步进电机可以同时转动，估计是库的运行问题吧

不知道谁能帮忙，用自带库写出同时驱动两个电机的办法，不然得自己写库了。

1. #include "Arduino.h"
   
2. 
   
3. void setup (){
   
4. 
   
5.   pinMode(50,OUTPUT);
   
6.   pinMode(51,OUTPUT);
   
7.   pinMode(52,OUTPUT);
   
8.   pinMode(53,OUTPUT);
   
9.   pinMode(30,OUTPUT);
   
10.   pinMode(31,OUTPUT);
    
11.   pinMode(32,OUTPUT);
    
12.   pinMode(33,OUTPUT);
    
13. 
    
14. }
    
15. 
    
16. void loop(){
    
17.   int i = 4;
    
18.   while(1)
    
19.   {
    
20.     unsigned char z;
    
21.     for(z=0;z<4;z++){
    
22.       if (z=1){
    
23.         digitalWrite(50, HIGH);
    
24.         digitalWrite(51, LOW);
    
25.         digitalWrite(52, HIGH);
    
26.         digitalWrite(53, LOW);
    
27.         digitalWrite(30, HIGH);
    
28.         digitalWrite(31, LOW);
    
29.         digitalWrite(32, HIGH);
    
30.         digitalWrite(33, LOW);
    
31.         delay(i);
    
32.       }
    
33.       if (z=2){
    
34.         digitalWrite(50, LOW);
    
35.         digitalWrite(51, HIGH);
    
36.         digitalWrite(52, HIGH);
    
37.         digitalWrite(53, LOW);
    
38.         digitalWrite(30, LOW);
    
39.         digitalWrite(31, HIGH);
    
40.         digitalWrite(32, HIGH);
    
41.         digitalWrite(33, LOW);
    
42.         delay(i);
    
43.       }
    
44.       if (z=3){
    
45.         digitalWrite(50, LOW);
    
46.         digitalWrite(51, HIGH);
    
47.         digitalWrite(52, LOW);
    
48.         digitalWrite(53, HIGH);
    
49.         digitalWrite(30, LOW);
    
50.         digitalWrite(31, HIGH);
    
51.         digitalWrite(32, LOW);
    
52.         digitalWrite(33, HIGH);
    
53.         delay(i);
    
54.       }
    
55.       if (z=4){
    
56.         digitalWrite(50, HIGH);
    
57.         digitalWrite(51, LOW);
    
58.         digitalWrite(52, LOW);
    
59.         digitalWrite(53, HIGH);
    
60.         digitalWrite(30, HIGH);
    
61.         digitalWrite(31, LOW);
    
62.         digitalWrite(32, LOW);
    
63.         digitalWrite(33, HIGH);
    
64.         delay(i);
    
65.       }
    
66.     }
    
67.   }
    
68. }
    

复制代码

BlackCat

整了会，这样用自带库也可以，并且附带了PS2摇杆控制。

1. #include "Arduino.h"
   
2. #include <Stepper.h>
   
3. 
   
4. const int stepsPerRevolution = 200;
   
5. int buttonPinX = 2;
   
6. int buttonPinY = 3;
   
7. Stepper myStepper1(stepsPerRevolution, 50,51,52,53);   
   
8. Stepper myStepper2(stepsPerRevolution, 33,32,31,30);
   
9. int stepCount = 0;         // number of steps the motor has taken
   
10. int buttonState = 0;
    
11. 
    
12. void setup(){
    
13.   Serial.begin(9600);
    
14.   pinMode(buttonPinX,INPUT);
    
15.   pinMode(buttonPinY,INPUT);
    
16. 
    
17. }
    
18. 
    
19. void loop(){
    
20.   int i,j;
    
21.   i = analogRead(buttonPinX);
    
22.   j = analogRead(buttonPinY);
    
23.   if (i>850){
    
24.     myStepper1.step(-1);
    
25.     myStepper2.step(-1);
    
26.     Serial.print("go:" );
    
27.     Serial.println(stepCount);
    
28.     stepCount++;
    
29.     delay(1);
    
30.   }
    
31.   if (i<250){
    
32.     myStepper1.step(1);
    
33.     myStepper2.step(1);
    
34.     Serial.print("back:" );
    
35.     Serial.println(stepCount);
    
36.     stepCount++;
    
37.     delay(5);
    
38.   }
    
39.   if (j>650){
    
40.     myStepper1.step(-1);
    
41.     myStepper2.step(1);
    
42.     Serial.print("left:" );
    
43.     Serial.println(stepCount);
    
44.     stepCount++;
    
45.     delay(5);
    
46.   }
    
47.   if (j<250){
    
48.     myStepper1.step(1);
    
49.     myStepper2.step(-1);
    
50.     Serial.print("right:" );
    
51.     Serial.println(stepCount);
    
52.     stepCount++;
    
53.     delay(5);
    
54.   }
    
55. }
    

复制代码

BlackCat

问题已解决，希望能帮到用得着的朋友。

pww999

我也在弄，回头试下

stepCount++;  
这个是速度递加吗？

BlackCat

我也是初学，不过串口发送的数据来看，应该是步数。你可以翻步进电机的库文件看看。

8200

记号起来好学习。
谢谢分享！