光杆寻黑线

本文介绍了一个基于Arduino平台的简易机器人控制系统。该系统通过读取左侧(LS)和右侧(RS)传感器的状态来决定机器人的前进、停止、左转或右转。通过调整不同函数中的参数可以改变机器人的运动特性。

摘要生成于 C知道 ,由 DeepSeek-R1 满血版支持, 前往体验 >

int LA=14;
int LB=15;
int RA=16;
int RB=17;
int EN1=3;
int EN2=5;
const int LS=2;
const int RS=6;


void setup()
{
  pinMode(LA,OUTPUT);
  pinMode(LB,OUTPUT);
  pinMode(RA,OUTPUT);
  pinMode(RB,OUTPUT);
  pinMode(EN1,OUTPUT);
  pinMode(EN2,OUTPUT);
  pinMode(LS,INPUT);
  pinMode(RS,INPUT);
}
void loop()
{
  int LI=digitalRead(LS);
  int RI=digitalRead(RS);
  if (LI==LOW && RI==LOW) {forward(0.1);pause(0.2);}
   else if (LI==HIGH && RI==LOW) {right(0.25);pause(0.2);}
    else if (LI==LOW && RI==HIGH){left(0.25);pause(0.2);};
}


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 left(float c)
{
  analogWrite(EN1,0);
  digitalWrite(LA,LOW);
  digitalWrite(LB,LOW);
  analogWrite(EN2,200);
  digitalWrite(RA,HIGH);
  digitalWrite(RB,LOW);
  delay(c*1000);
}


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


void pause(float e)
{
  analogWrite(EN1,150);
  digitalWrite(LA,LOW);
  digitalWrite(LB,LOW);
  analogWrite(EN2,188);
  digitalWrite(RA,LOW);
  digitalWrite(RB,LOW);
  delay(e*1000);
}
评论 1
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值