Arduino Car going square

最新推荐文章于 2017-11-14 13:04:00 发布

原创最新推荐文章于 2017-11-14 13:04:00 发布 · 672 阅读

0 ·

CC 4.0 BY-SA版权

*.ino 专栏收录该内容

12 篇文章

订阅专栏

本文介绍了一段用于控制四轮电机车的代码，包括前进、后退、左转和右转等功能，并通过定时器实现动作的持续执行。

int LA=14;
int LB=15;
int RA=16;
int RB=17;
int EN1=3;
int EN2=5;

void setup()
{
pinMode(LA,OUTPUT);
pinMode(LB,OUTPUT);
pinMode(RA,OUTPUT);
pinMode(RB,OUTPUT);
pinMode(EN1,OUTPUT);
pinMode(EN2,OUTPUT);
}

void loop()
{
forward(1);
left(1);
}

void forward(int a)
{
analogWrite(EN1,150);
digitalWrite(LA,HIGH);
digitalWrite(LB,LOW);
analogWrite(EN2,164);
digitalWrite(RA,HIGH);
digitalWrite(RB,LOW);
delay(a*1000);
}

void back(int b)
{
analogWrite(EN1,150);
digitalWrite(LA,LOW);
digitalWrite(LB,HIGH);
analogWrite(EN2,188);
digitalWrite(RA,LOW);
digitalWrite(RB,HIGH);
delay(b*1000);
}

void left(int c)
{
analogWrite(EN1,0);
digitalWrite(LA,LOW);
digitalWrite(LB,LOW);
analogWrite(EN2,207);
digitalWrite(RA,HIGH);
digitalWrite(RB,LOW);
delay(c*1000);
}

void right(double d)
{
analogWrite(EN1,150);
digitalWrite(LA,HIGH);
digitalWrite(LB,LOW);
analogWrite(EN2,150);
digitalWrite(RA,LOW);
digitalWrite(RB,LOW);
delay(d*1000);
}

void square()
{
forward(1);
left(1);
forward(1);
left(1);
forward(1);
left(1);
forward(1);
left(1);
}