查看: 718|回复: 3

[未解决] 循迹小车程序怎么改

[复制链接]

该用户从未签到

发表于 2019-8-17 21:07 | 显示全部楼层 |阅读模式
void setup() {
  // put your setup code here, to run once:

}

void loop() {
  // put your main code here, to run repeatedly:

}
void motor(char pin,char pwmpin,char state,int val)
{
    pinMode(pin, OUTPUT);   

  if(state==1)
  {  
    analogWrite(pwmpin,val);
    digitalWrite(pin,1);
   }
  else if(state==2)
{  
   analogWrite(pwmpin,val);
   digitalWrite(pin,0);
}
else if(state==0)
{
    analogWrite(pwmpin,0);
    digitalWrite(pin,0);
}
}

void runfoward(int i)   //
{
  motor(4,5,1,i);
  motor(7,6,1,i);
}
void runback(int j)    //
{
   motor(4,5,2,j);
   motor(7,6,2,j);
}
void turnL(int m)     //
{
  motor(4,5,1,m);
  motor(7,6,0,0);
}
void turnR(int n)      //
{
  motor(4,5,0,0);
  motor(7,6,1,n);
}
void stop()            //
{
  motor(4,5,0,0);
  motor(7,6,1,0);
}
void setup()      //
{
  pinMode(10,INPUT);//,
  pinMode(11,INPUT);//
  pinMode(12,INPUT);//
  Serial.begin(9600);
}
void loop()
{
  char num1,num2,num3;

  num1=digitalRead(12);
  num2=digitalRead(11);
  num3=digitalRead(10);  

   if((num1==0)&&num2&&num3)
   {
    turnL(120);          //
    delay(2);
    while(1){
    num2=digitalRead(11);         //
    if(num2==1)
    {  turnL(120);                     //
     delay(2);}
     else
     break;                      //
   }                                       //
   }   

  else if(num2&&num1&&(num3==0))
   {
    turnR(120);
    delay(2);
    while(1)
    {
     num2=digitalRead(11);
    if(num2==1){
      turnR(120);   
     delay(2);}
     else
      break;
    }
   }
  else
  {
    runfoward(120);
    delay(2);
  }
}

QQ图片20190817210839.jpg

  • TA的每日心情
    奋斗
    2020-1-18 10:38
  • 签到天数: 21 天

    [LV.4]偶尔看看III

    发表于 2019-8-18 08:56 | 显示全部楼层
    谁看的懂你的啊啊啊
  • TA的每日心情
    奋斗
    2020-1-13 09:17
  • 签到天数: 176 天

    [LV.7]常住居民III

    发表于 2019-8-18 09:11 | 显示全部楼层
    你没发现你程序里有两个setup函数吗

    该用户从未签到

    发表于 2019-8-18 11:05 | 显示全部楼层
    把没用的那个setup函数删掉就好了
    您需要登录后才可以回帖 登录 | 立即注册

    本版积分规则

    热门推荐

    创客火首发无人机编队套装,开启不一样的人工智能教育
    创客火首发无人机编队套装
    2017年国务院发布《新一代人工智能发展规划》,提出要广泛开展人工智能科普活动,在中
    【干货分享】mega2560原理图PCB图纸altium designer18
    【干货分享】mega2560原理
    分享一下mega2560的板子 AD版本 **** 本内容被作者隐藏 **** ergo
    无源蜂鸣器声音小
    无源蜂鸣器声音小
    声音太小,如何优化下电路
    自制WiFi天气时钟基于Blinker esp-01(8266) u8g2驱动12864 LCD屏
    自制WiFi天气时钟基于Blin
    先发个实物展示视频:https://www.bilibili.com/video/BV12k4y1679Q/ 第一次发分享
    一文教你选择Arduino开发板,小白进
    一文教你选择Arduino开发
    笔者在2016年接触了Arduino,跳了万条坑,行了千里弯,到今天也算是Arduino的一
    Copyright   ©2015-2016  Arduino中文社区  Powered by©Discuz!   
    快速回复 返回顶部 返回列表