标题: 寻迹小车程序 [打印本页]

---

作者: sun136    时间: 2018-5-29 17:33
标题: 寻迹小车程序

#define uintunsigned int/*宏定义将unsigned int 定义为uint*/

#define ucharunsigned char/*宏定义 将unsigned char 定义为uchar*/

sbit led1 =P1^0;

sbit led2 =P1^1;//两路光电传感器定义

sbit in1 =P1^2;

sbit in2 =P1^3;

sbit in3 =P1^4;

sbit in4 =P1^5;//电机驱动模块4个端口定义

voiddelay(uint z) /*1ms延时函数*/

{

        uint x,y;

        for(x = z;x > 0;x--)

            for(y = 114;y > 0;y--);

}

/*光电传感器检测到黑线为1*/

void main()/*主函数*/

{

        while(1)/*循环函数*/

        {

            if(led1 == 0&led2 == 0)/*判断两个光电传感器都没检测到黑线*/

            {

                in1 = in3 = 1;

                in2 = in4 = 0;

/*两个轮子正转*/

            }

            if(led1 == 1&led2 == 0)/*判断左侧传感器检测到黑线右侧没有*/

            {

                in2 = in3 = 1;

                in1 = in4 = 0;

/*左轮反转 右轮正转*/

            }

            if(led1 == 0&led2 == 1)

            ……

        }

}

---

欢迎光临 (http://www.51hei.com/bbs/)

Powered by Discuz! X3.1