蓝牙控制舵机

15275285755

要做一个项目，用一个蓝牙模块控制3个舵机做不同的运转，求大神帮忙

1. 
   
2. #include <Servo.h>
   
3. Servo myservo1;
   
4. Servo myservo2;
   
5. Servo myservo3;
   
6. 
   
7. int MotorRight1=2;
   
8. int MotorRight2=4;
   
9. int MotorLeft1=7;
   
10. int MotorLeft2=8;
    
11.   
    
12. char val0;
    
13. char val1;
    
14. char val2;
    
15. char val3;
    
16. 
    
17. void setup()
    
18. {  
    
19.   Serial.begin(9600);
    
20.   pinMode(MotorRight1, OUTPUT);  // 腳位2 (PWM)
    
21.   pinMode(MotorRight2, OUTPUT);  // 腳位 4 (PWM)
    
22.   pinMode(MotorLeft1,  OUTPUT);  // 腳位 7 (PWM)
    
23.   pinMode(MotorLeft2,  OUTPUT);  // 腳位 8 (PWM)
    
24.   myservo1.attach(3);
    
25.   myservo2.attach(5);
    
26.   myservo3.attach(6);
    
27. 
    
28.   
    
29. }
    
30. 
    
31. void go()// 前進
    
32. {
    
33.         digitalWrite(MotorRight1,LOW);
    
34.         digitalWrite(MotorRight2,HIGH);
    
35.         digitalWrite(MotorLeft1,LOW);
    
36.         digitalWrite(MotorLeft2,HIGH);
    
37.       
    
38. }
    
39. 
    
40. void left() //右轉
    
41. {
    
42.       digitalWrite(MotorRight1,HIGH);
    
43.       digitalWrite(MotorRight2,LOW);
    
44.       digitalWrite(MotorLeft1,LOW);
    
45.       digitalWrite(MotorLeft2,HIGH);
    
46.   
    
47. }
    
48. void right() //左轉
    
49. {
    
50.       digitalWrite(MotorRight1,LOW);
    
51.       digitalWrite(MotorRight2,HIGH);
    
52.       digitalWrite(MotorLeft1,HIGH);
    
53.       digitalWrite(MotorLeft2,LOW);
    
54.      
    
55. }
    
56. void stop() //停止
    
57. {
    
58.      digitalWrite(MotorRight1,LOW);
    
59.      digitalWrite(MotorRight2,LOW);
    
60.      digitalWrite(MotorLeft1,LOW);
    
61.      digitalWrite(MotorLeft2,LOW);
    
62.    
    
63. }
    
64. void back() //後退
    
65. {
    
66.         digitalWrite(MotorRight1,HIGH);
    
67.         digitalWrite(MotorRight2,LOW);
    
68.         digitalWrite(MotorLeft1,HIGH);
    
69.         digitalWrite(MotorLeft2,LOW);;
    
70.       
    
71. }
    
72.         
    
73. void loop()
    
74. {
    
75.   char val0 = Serial.read();
    
76.   Serial.write(val0);
    
77.   if (-1 != val0) {
    
78.     if ('W' == val0)
    
79.     go();
    
80.     else if ('A' ==val0)
    
81.     left();
    
82.     else if ('D' == val0)
    
83.     right();
    
84.     else if ('S' == val0)
    
85.     back();
    
86.     else if ('Q' == val0)
    
87.       stop();
    
88.     delay(500);
    
89.     }
    
90.   else
    
91.   {
    
92.     //stop();
    
93.     delay(500);
    
94.   }
    
95.   {                                                     // 每次步进一度
    
96.     myservo1.write(val1);        // 指定舵机转向的角度
    
97.     delay(15);                       // 等待15ms让舵机到达指定位置
    
98.   }
    
99.   {                                                     // 每次步进一度
    
100.     myservo2.write(val2);        // 指定舵机转向的角度
     
101.     delay(15);                       // 等待15ms让舵机到达指定位置
     
102.   }
     
103.   {                                                     // 每次步进一度
     
104.     myservo3.write(val3);        // 指定舵机转向的角度
     
105.     delay(15);                       // 等待15ms让舵机到达指定位置
     
106.   }
     
107.   
     
108. }  
     

复制代码

绿林网页

这小舵机的机械臂，能支撑自身不，能拿东西么

15275285755

绿林网页 发表于 2014-12-16 20:17
这小舵机的机械臂，能支撑自身不，能拿东西么

只是用来做个模型，不是真正做什么实验

天天向上/tp

哈哈。这个是个不错的主意！！！！！