跪求大神，我想用Arduino编程控制3个舵机独立运行互不干扰，第二个舵机控制不了。。。

张雪梦

本人是新人小白，学校比赛做的一个监控小车，用的二自由度的云台，需要通过Arduino控制云台的两个舵机还有小车的舵机，小车的舵机（程序里为舵机1）通过程序，蓝牙发送到手机单独可以使用，但是云台上的舵机（舵机2）没有反应，哪位大神可以帮我看一下程序哪里出错了吗？

1. #include <SoftwareSerial.h>
   
2. #include <Servo.h>
   
3. Servo myservo1;
   
4. Servo myservo2;
   
5. 
   
6. SoftwareSerial mySerial(10, 11); // RX, TX
   
7. 
   
8. 
   
9. char tmp1;
   
10. 
    
11. 
    
12. int pos1 = 0;
    
13. 
    
14. 
    
15. void setup() {
    
16.   pinMode(3, OUTPUT);
    
17.   pinMode(4, OUTPUT);
    
18.   pinMode(5, OUTPUT);
    
19. 
    
20.   myservo1.attach(9);
    
21.   delay(50);
    
22.   myservo2.attach(7);
    
23.   delay(50);
    
24. 
    
25.   
    
26.   myservo1.write(40);
    
27.   delay(50);
    
28.   myservo2.write(30);
    
29.   delay(50);
    
30. 
    
31. 
    
32.   digitalWrite(5, LOW);
    
33.   digitalWrite(4,  LOW);
    
34. 
    
35.   mySerial.begin(9600);
    
36.   mySerial.println("我是大傻瓜");
    
37. 
    
38.   
    
39. 
    
40. }
    
41. 
    
42. void loop()
    
43. {
    
44. qianjin( );
    
45.   houtui();
    
46.   shache();
    
47.   songyoumen();
    
48.   zuozhuan();
    
49.   huizheng();
    
50.   youzhuan();
    
51.   huizheng2();
    
52. 
    
53.   d2();
    
54.   
    
55.   if (mySerial.available()) {
    
56.     tmp1 = mySerial.read();
    
57.   }
    
58. }
    
59. 
    
60. void qianjin( )  //前进
    
61. {
    
62.   if (tmp1 == 'a')
    
63.   {
    
64.     tmp1 = 0;
    
65.     myservo1.write(43);
    
66.     analogWrite(3, 55);//255  85/255*5
    
67.     digitalWrite(5, LOW);
    
68.     digitalWrite(4, HIGH);
    
69.   }
    
70. }
    
71. void houtui()  //后退
    
72. {
    
73.   if (tmp1 == 'b')
    
74.   {
    
75.     tmp1 = 0;
    
76.     myservo1.write(43);
    
77.     analogWrite(3, 55);//255  85/255*5
    
78.     digitalWrite(5, HIGH);
    
79.     digitalWrite(4,  LOW);
    
80.   }
    
81. }
    
82. void shache()  //刹车
    
83. {
    
84.   if (tmp1 == 'c')
    
85.   {
    
86.     tmp1 = 0;
    
87. 
    
88.     analogWrite(3, 0);//255  85/255*5
    
89.   }
    
90. }
    
91. void songyoumen()   //松油门
    
92. {
    
93.   if (tmp1 == 'd')
    
94.   {
    
95.     tmp1 = 0;
    
96. 
    
97.     analogWrite(3, 0);//255  85/255*5
    
98.     digitalWrite(5, HIGH);
    
99.     digitalWrite(4, HIGH);
    
100.   }
     
101. }
     
102. void zuozhuan()   //舵机1左转
     
103. {
     
104.   if (tmp1 == 'e')
     
105.   {
     
106.     tmp1 = 0;
     
107.     for (pos1 = 45; pos1 <= 75; pos1 += 1)
     
108.     {
     
109.       myservo1.write(pos1);
     
110.       delay(15);
     
111.     }
     
112.    }
     
113. }
     
114. void huizheng()  //舵机1回正
     
115. {
     
116.    if (tmp1 == 'f')
     
117.   {
     
118.     tmp1 = 0;
     
119.      for (pos1 = 75; pos1 >= 45; pos1 -= 1)
     
120.     {
     
121.       myservo1.write(pos1);
     
122.         delay(15);
     
123.      }
     
124. }
     
125. }
     
126. void youzhuan()  //舵机1右转
     
127. {
     
128. 
     
129.    if (tmp1 == 'g')
     
130.   {
     
131.     tmp1 = 0;
     
132.     for (pos1 = 45; pos1>=20; pos1 -= 1)
     
133.     {
     
134.       myservo1.write(pos1);
     
135.       delay(15);
     
136.     }
     
137.    }
     
138. }
     
139. void huizheng2()    //舵机1右转的回正
     
140. {   
     
141. if (tmp1 == 'h')
     
142.   {
     
143.     tmp1 = 0;
     
144.      for (pos1 =20; pos1 <= 49; pos1 += 1)
     
145.     {
     
146.       myservo1.write(pos1);
     
147.         delay(15);
     
148.      }
     
149.   }
     
150. }
     
151. void d2() //舵机2号右转
     
152. {
     
153. if (tmp1 == '1')
     
154.   {
     
155.     tmp1 = 0;
     
156.      for (pos1 =20; pos1 <= 49; pos1 += 1)
     
157.     {
     
158.       myservo2.write(pos1);
     
159.         delay(15);
     
160.      }
     
161.   }
     
162. }
     
163. 
     
164.    

复制代码

zjz5717

7针脚不是pwm口，控制舵机需要使用带有pwm功能的针脚

张雪梦

zjz5717 发表于 2016-10-16 10:50
7针脚不是pwm口，控制舵机需要使用带有pwm功能的针脚

谢谢我去试试