int servoPin1=12;
int servoPin2=13;
int speedpinA=20;
int val;
void setup()
{
Serial.begin(9600);//设置波特率9600,与蓝牙模块一致
pinMode(servoPin1,OUTPUT);//定义该接口为接口为输出接口
pinMode(servoPin2,OUTPUT);
pinMode(speedpinA,OUTPUT);
}
void loop(){
val=Serial.read();
if(val=='w')
{for(int i=0;i<=3; i++)
{Serial.println("Stop!");
digitalWrite(servoPin1,HIGH);
delayMicroseconds(1300);
digitalWrite(servoPin1,LOW);
delay(20);
digitalWrite(servoPin2,HIGH);
delayMicroseconds(1700);
digitalWrite(servoPin2,LOW);
delay(20);
}}
if(val=='l')
{
for(int i=0;i<=3; i++)
{
digitalWrite(servoPin1,HIGH);
delayMicroseconds(1300);
digitalWrite(servoPin1,LOW);
delay(20);
digitalWrite(servoPin2,HIGH);
delayMicroseconds(1300);
digitalWrite(servoPin2,LOW);
delay(20);}}
if(val=='r')
{
for(int i=0;i<=3; i++)
{
digitalWrite(servoPin1,HIGH);
delayMicroseconds(1700);
digitalWrite(servoPin1,LOW);
delay(20);
digitalWrite(servoPin2,HIGH);
delayMicroseconds(1700);
digitalWrite(servoPin2,LOW);
delay(20);}}
if(val=='b')
{
for(int i=0;i<=3; i++)
{
digitalWrite(servoPin1,HIGH);
delayMicroseconds(1700);
digitalWrite(servoPin1,LOW);
delay(20);
digitalWrite(servoPin2,HIGH);
delayMicroseconds(1300);
digitalWrite(servoPin2,LOW);
delay(20);
}}
if(val=='p')
{for(int i=0;i<=3; i++)
{
digitalWrite(servoPin1,HIGH);
delayMicroseconds(1300);
digitalWrite(servoPin1,LOW);
delay(20);
digitalWrite(servoPin2,HIGH);
delayMicroseconds(1570);
digitalWrite(servoPin2,LOW);
delay(20);}}
if(val=='q')
{for(int i=0;i<=3; i++)
{
digitalWrite(servoPin1,HIGH);
delayMicroseconds(1490);
digitalWrite(servoPin1,LOW);
delay(20);
digitalWrite(servoPin2,HIGH);
delayMicroseconds(1700);
digitalWrite(servoPin2,LOW);
delay(20);}
}}
这个是我的程序,以前上大学的时候试过可以用,但是过了很久了,忘了怎么接法了。。。我把arduino上面的12 13接口分别接上L298P电机驱动的PWMA PWMB上面,电源也接了,但是发送数据的时候轮子不动。。是哪里出错了呢
|