PaulMyao 发表于 2013-7-21 23:56 
求舵机控制的代码 - #include <Servo.h>
- Servo servo1;
- Servo servo2;
- int x,y,s;
- void setup()
- {
- pinMode(11, OUTPUT);
- pinMode(12, OUTPUT);
- Serial.begin(9600);
- servo1.attach(9);
- servo2.attach(10);
- x=90;
- y=90;
- servo1.write(x);
- servo1.write(y);
- }
-
- void loop()
- {
- if (Serial.available())
- {
- s = Serial.read();
-
- if (s==48)
- {
- x=x+1;
- }
- if (s==49)
- {
- x=x-1;
- }
-
- if (s==50)
- {
- y=y+1;
- }
- if (s==51)
- {
- y=y-1;
- }
-
- if (s==52)
- {
- digitalWrite(11, HIGH);
- }
- if (s==53)
- {
- digitalWrite(12, HIGH);
- }
- if (s==54)
- {
- digitalWrite(11, LOW);
- }
- if (s==55)
- {
- digitalWrite(12, LOW);
- }
-
- servo1.write(x);
- servo2.write(y);
- Serial.print(x);
- Serial.print(",");
- Serial.println(y);
- }
- }
复制代码 |