智能循迹小车程序.doc

上传人:小** 文档编号:16734082 上传时间:2020-10-22 格式:DOC 页数:14 大小:76KB
返回 下载 相关 举报
智能循迹小车程序.doc_第1页
第1页 / 共14页
智能循迹小车程序.doc_第2页
第2页 / 共14页
智能循迹小车程序.doc_第3页
第3页 / 共14页
点击查看更多>>
资源描述
智能循迹小车,小车按中字笔画行驶/*“中”字笔画轨迹*/#include#include /内部包含延时函数 _nop_();#define uchar unsigned char#define uint unsigned int unsigned char dj1=0;unsigned char dj2=0;uchar t=0;uchar num1=0,num2=0,num3=0;sbit HW1=P00; /红外对管位定义sbit HW2=P01;sbit HW3=P02;sbit HW4=P03;sbit ENA=P32; /PWM输入sbit ENB=P33;sbit IN5=P24; /电机sbit IN6=P25;sbit IN7=P26;sbit IN8=P27;void delay(uint x) /延时1msuint i,j;for(i=0;ix;i+)for(j=0;j120;j+);void qianjin() /小车前进IN5=0;IN6=1;IN7=0;IN8=1;dj1=15;dj2=15;void turnleft2()/小车前进向左微调IN5=0;IN6=1;IN7=0;IN8=1;dj1=7;dj2=20;void turnright2() /小车前进向右微调IN5=0;IN6=1;IN7=0;IN8=1;dj1=20;dj2=7;void right()IN5=0;IN6=1;IN7=1;IN8=0;dj1=20;dj2=25;void left()IN5=1;IN6=0;IN7=0;IN8=1;dj1=25;dj2=20;void stop() /小车后退dj1=0;dj2=0;void init() /初始化TMOD=0x01;TH0=(65536-500)/256;TL0=(65536-500)%256;EA=1;ET0=1;TR0=1;void timer0() interrupt 1 using 1/定时器0中断TH0=(65536-500)/256;TL0=(65536-500)%256;t+;if(tdj1)ENA=1;elseENA=0;if(t=50)t=0;void main()init();while(1)if(num1=0)if(HW1=0&HW2=1&HW3=1&HW4=0)qianjin();if(HW1=0&HW2=1&HW3=0&HW4=0)turnleft2();if(HW1=1&HW2=1&HW3=0&HW4=0)turnleft2();if(HW1=1&HW2=0&HW3=0&HW4=0)turnleft2();if(HW1=0&HW2=0&HW3=1&HW4=0)turnright2();if(HW1=0&HW2=0&HW3=1&HW4=1)turnright2();if(HW1=0&HW2=0&HW3=0&HW4=1)turnright2();if(HW1=0&HW2=1&HW3=1&HW4=1)turnleft2();if(HW1=1&HW2=1&HW3=1&HW4=0)turnright2();if(num2=0&HW1=0&HW2=0&HW3=0&HW4=0)delay(500);if(num2=0&HW1=0&HW2=0&HW3=0&HW4=0)stop();delay(50);num1=1;delay(50);if(num1=1)if(num2=0&HW1=0&HW2=0&HW3=0&HW4=0)right();if(HW1=0&HW2=1&HW3=1&HW4=0)num2=1;delay(50);qianjin();if(HW1=0&HW2=1&HW3=0&HW4=0)turnleft2();if(HW1=1&HW2=1&HW3=0&HW4=0)turnleft2();if(HW1=1&HW2=0&HW3=0&HW4=0)turnleft2();if(HW1=0&HW2=0&HW3=1&HW4=0)turnright2();if(HW1=0&HW2=0&HW3=1&HW4=1)turnright2();if(HW1=0&HW2=0&HW3=0&HW4=1)turnright2();if(HW1=0&HW2=1&HW3=1&HW4=1)turnleft2();if(HW1=1&HW2=1&HW3=1&HW4=0)turnright2();if(num2=1&HW1=0&HW2=0&HW3=0&HW4=0)delay(500);if(num2=1&HW1=0&HW2=0&HW3=0&HW4=0)stop();delay(50);num1=2;delay(50); if(num1=2)if(num2=1&HW1=0&HW2=0&HW3=0&HW4=0)right();if(HW1=0&HW2=1&HW3=1&HW4=0)num2=2;delay(50);qianjin();if(HW1=1&HW2=1&HW3=0&HW4=0)turnleft2();if(HW1=0&HW2=1&HW3=0&HW4=0)turnleft2();if(HW1=1&HW2=0&HW3=0&HW4=0)turnleft2();if(HW1=0&HW2=0&HW3=1&HW4=1)turnright2();if(HW1=0&HW2=0&HW3=1&HW4=0)turnright2();if(HW1=0&HW2=0&HW3=0&HW4=1)turnright2();if(num3=0&HW1=1&HW2=1&HW3=1&HW4=1)num3=1;delay(10);stop();delay(100);qianjin();if(HW1=0&HW2=1&HW3=1&HW4=1)turnleft2();if(HW1=1&HW2=1&HW3=1&HW4=0)turnright2();if(num2=2&HW1=0&HW2=0&HW3=0&HW4=0)delay(500);if(num2=2&HW1=0&HW2=0&HW3=0&HW4=0)stop();delay(50);num1=3;delay(50);if(num1=3)if(num2=2&HW1=0&HW2=0&HW3=0&HW4=0)right();if(HW1=0&HW2=1&HW3=1&HW4=0)num2=3;delay(50);qianjin();if(HW1=1&HW2=1&HW3=0&HW4=0)turnleft2();if(HW1=0&HW2=1&HW3=0&HW4=0)turnleft2();if(HW1=1&HW2=0&HW3=0&HW4=0)turnleft2();if(HW1=0&HW2=0&HW3=1&HW4=1)turnright2();if(HW1=0&HW2=0&HW3=1&HW4=0)turnright2();if(HW1=0&HW2=0&HW3=0&HW4=1)turnright2();if(HW1=0&HW2=1&HW3=1&HW4=1)turnleft2();if(HW1=1&HW2=1&HW3=1&HW4=0)turnright2();if(num2=3&HW1=0&HW2=0&HW3=0&HW4=0)delay(500);if(num2=3&HW1=0&HW2=0&HW3=0&HW4=0)stop();delay(50);num1=4;delay(50);if(num1=4)if(num2=3&HW1=0&HW2=0&HW3=0&HW4=0)right();if(HW1=0&HW2=1&HW3=1&HW4=0)num2=4;delay(50);qianjin();if(HW1=1&HW2=1&HW3=0&HW4=0)turnleft2();if(HW1=0&HW2=1&HW3=0&HW4=0)turnleft2();if(HW1=1&HW2=0&HW3=0&HW4=0)turnleft2();if(HW1=0&HW2=0&HW3=1&HW4=1)turnright2();if(HW1=0&HW2=0&HW3=1&HW4=0)turnright2();if(HW1=0&HW2=0&HW3=0&HW4=1)turnright2();if(num3=1&HW1=1&HW2=1&HW3=1&HW4=1)num3=2;delay(10);stop();delay(100);qianjin();if(HW1=0&HW2=1&HW3=1&HW4=1)turnleft2();if(HW1=1&HW2=1&HW3=1&HW4=0)turnright2();if(num2=4&HW1=0&HW2=0&HW3=0&HW4=0)delay(500);if(num2=4&HW1=0&HW2=0&HW3=0&HW4=0)stop();delay(50);num1=5;delay(50);if(num1=5)if(num2=4&HW1=0&HW2=0&HW3=0&HW4=0)left();if(HW1=0&HW2=1&HW3=1&HW4=0)num2=5;delay(50);qianjin();if(HW1=1&HW2=1&HW3=0&HW4=0)turnleft2();if(HW1=0&HW2=1&HW3=0&HW4=0)turnleft2();if(HW1=1&HW2=0&HW3=0&HW4=0)turnleft2();if(HW1=0&HW2=0&HW3=1&HW4=1)turnright2();if(HW1=0&HW2=0&HW3=1&HW4=0)turnright2();if(HW1=0&HW2=0&HW3=0&HW4=1)turnright2();if(HW1=0&HW2=1&HW3=1&HW4=1)turnleft2();if(HW1=1&HW2=1&HW3=1&HW4=0)turnright2();if(num2=5&HW1=1&HW2=1&HW3=1&HW4=1)stop();delay(100);num1=6;delay(50);if(num1=6)if(num2=5&HW1=1&HW2=1&HW3=1&HW4=1)left();if(HW1=0&HW2=1&HW3=1&HW4=0)num2=6;delay(50);num3=3;delay(50);qianjin();if(HW1=1&HW2=1&HW3=0&HW4=0)turnleft2();if(HW1=0&HW2=1&HW3=0&HW4=0)turnleft2();if(HW1=1&HW2=0&HW3=0&HW4=0)turnleft2();if(HW1=0&HW2=0&HW3=1&HW4=1)turnright2();if(HW1=0&HW2=0&HW3=1&HW4=0)turnright2();if(HW1=0&HW2=0&HW3=0&HW4=1)turnright2();if(HW1=0&HW2=1&HW3=1&HW4=1)turnleft2();if(HW1=1&HW2=1&HW3=1&HW4=0)turnright2();if(num3=3&HW1=1&HW2=1&HW3=1&HW4=1)num3=4;delay(10);stop();delay(100);qianjin();if(num2=6&HW1=0&HW2=0&HW3=0&HW4=0)delay(500);if(num2=6&HW1=0&HW2=0&HW3=0&HW4=0)stop();delay(500);num1=7;delay(50);if(num1=7)if(num2=6&HW1=0&HW2=0&HW3=0&HW4=0)right();if(HW1=0&HW2=1&HW3=1&HW4=0)num2=7;delay(50);num3=4;delay(50);qianjin();if(HW1=1&HW2=1&HW3=0&HW4=0)turnleft2();if(HW1=0&HW2=1&HW3=0&HW4=0)turnleft2();if(HW1=1&HW2=0&HW3=0&HW4=0)turnleft2();if(HW1=0&HW2=0&HW3=1&HW4=1)turnright2();if(HW1=0&HW2=0&HW3=1&HW4=0)turnright2();if(HW1=0&HW2=0&HW3=0&HW4=1)turnright2();if(HW1=0&HW2=1&HW3=1&HW4=1)turnleft2();if(HW1=1&HW2=1&HW3=1&HW4=0)turnright2();if(num3=4&HW1=1&HW2=1&HW3=1&HW4=1)num3=5;delay(10);stop();delay(100);qianjin();if(num3=5&HW1=1&HW2=1&HW3=1&HW4=1)num3=6;delay(10);stop();delay(100);qianjin();if(num2=7&HW1=0&HW2=0&HW3=0&HW4=0)delay(100);if(num2=7&HW1=0&HW2=0&HW3=0&HW4=0)stop();delay(90000);
展开阅读全文
相关资源
正为您匹配相似的精品文档
相关搜索

最新文档


当前位置:首页 > 临时分类 > 人力资源


copyright@ 2023-2025  zhuangpeitu.com 装配图网版权所有   联系电话:18123376007

备案号:ICP2024067431-1 川公网安备51140202000466号


本站为文档C2C交易模式,即用户上传的文档直接被用户下载,本站只是中间服务平台,本站所有文档下载所得的收益归上传人(含作者)所有。装配图网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对上载内容本身不做任何修改或编辑。若文档所含内容侵犯了您的版权或隐私,请立即通知装配图网,我们立即给予删除!