查看: 290|回复: 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的每日心情
    擦汗
    2019-9-1 08:07
  • 签到天数: 13 天

    [LV.3]偶尔看看II

    发表于 2019-8-18 08:56 | 显示全部楼层
    谁看的懂你的啊啊啊
  • TA的每日心情
    奋斗
    2019-9-20 08:55
  • 签到天数: 92 天

    [LV.6]常住居民II

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

    该用户从未签到

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

    本版积分规则

    热门推荐

    求ESP8266+0.96oled的天气代码
    求ESP8266+0.96oled的天气
    新人求助
    新人求助
    仿真出错!显示原因是这个,但是找不到该出错文件
    用Arduino制作支持ROS机器人操作系统的7轴机械臂
    用Arduino制作支持ROS机器
    参赛项目:[/backcolor] 用Arduino制作支持ROS机器人操作系统的7轴机械臂[/backcolor
    为拍月亮而生的便携望远镜系统。
    为拍月亮而生的便携望远镜
    参赛项目: 便携望远镜系统 参赛组员: 1人 布丁:嵌入式软件、上位机软件、电路、结
    光敏电阻检测环境光实验
    光敏电阻检测环境光实验
    本文节选自《Arduino程序设计基础》 一些简单的电子元件就可以做传感器使用,例如我
    Copyright   ©2015-2016  Arduino中文社区  Powered by©Discuz!   ( 蜀ICP备14017632号-3 )
    快速回复 返回顶部 返回列表