Arduino: Ultrasonic Sensor & Motor Car

int LA=14;
int LB=15;
int RA=16;
int RB=17;
int EN1=3;
int EN2=5;
int input=9;
int output=8;


void setup()
{
  pinMode(LA,OUTPUT);
  pinMode(LB,OUTPUT);
  pinMode(RA,OUTPUT);
  pinMode(RB,OUTPUT);
  pinMode(EN1,OUTPUT);
  pinMode(EN2,OUTPUT);
  pinMode(input,INPUT);
  pinMode(output,OUTPUT);
}
void loop()
{
  if (feye()>15 && feye()<=25) pause(0.2);
  if (feye()<=15) back(0.5);
  if (feye()>25) forward(0.05);
}


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


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


void pause(float c)
{
  analogWrite(EN1,150);
  digitalWrite(LA,LOW);
  digitalWrite(LB,LOW);
  analogWrite(EN2,188);
  digitalWrite(RA,LOW);
  digitalWrite(RB,LOW);
  delay(c*1000);
}
  


float feye(){
  digitalWrite(output,LOW);
  delayMicroseconds(2);
  digitalWrite(output,HIGH);
  delayMicroseconds(10);
  digitalWrite(output,LOW);
  float fdis=pulseIn(input,HIGH);
  fdis=fdis/58;
  return(fdis);
}
  • 0
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值