当前位置:   article > 正文

智能送药小车完整版【电赛、课设】开源(含源代码)_送药小车csdn

送药小车csdn

目录

任务要求

摘要

1、前言

2、系统方案设计

3、理论分析与计算

3.1 病房选择:

3.2 电机引脚及状态

3.3 灰度传感器及电机状态

4、系统电路设计与仿真

4.1系统硬件框图

4.2 单片机最小板电路

4.3 驱动电路设计

4.4 灰度传感器设计

5、系统软件设计

6、系统测试及结果分析

6.1 系统指标参数

6.1.1 STC89C52指标参数

6.1.2 灰度传感器参数

6.1.3 电机驱动模块参数

6.2 测试内容与方法

6.2.1 软件测试

6.2.2 硬件测试

6.3 实物外观

6.4 实物功能测试

6.5 测试结果分析

7、结论


任务要求:

 

摘要

       本设计完成了基于STC89C52的智能送药小车控制系统的设计过程,此系统主要包括51最小开发板、按键控制电路、电机驱动电路、灰度检测传感电路等电路组合而成。以STC89C52为主控芯片及其外围扩展电路实现系统整体功能,用灰度传感器实现小车循迹功能,使用STC89C52驱动L298N芯片控制电机,由PWM控制小车速度,从而使小车顺利通过直线、转弯、识别十字路口并正确转向功能。在硬件设计的基础上实现了电机控制功能以及小车简单循迹的软件设计方案。

关键词:单片机  循迹 PWM  L298N  智能送药小车

1、前言

       随着人工智能和自动化技术的迅速发展,各种高科技以及前沿技术开始广泛运用于智能小车领域,使智能小车越来越多样化。作为集多种高科技于一身的高薪技术集成产物,它融合了传统机械、传感器、单片机、软件与人工智能技术等多个学科的知识。智能小车的研究和开发正成为广泛关注的焦点。智能化小车是未来人们生活中的重要工具,将会给我们的生活生产带来很大的便利。本设计基于单片机为核心设计了一款智能送药小车,以多路灰度传感器实现循迹、路口识别、终点识别功能,通过 PWM 调整小车姿态。能够在规定医院的药房和病房间根据指令在药房与病房间往返送药。本设计采用STC89C52芯片实现其智能控制功能,通过五路灰度传感器判断小车运行状态及小车位置,经单片机判断后驱动电机驱动模块对小车进行控制。采用的数字量灰度传感器可对被测面的两种颜色差异进行调节比较,对于本设计中病房要求的白红线循迹识别精度高、抗干扰能力强。

2、系统方案设计

        本课程设计要求设计智能送药小车,模拟完成在医院药房与病房的药物送取。病房分为近端、中端、远端三部分,要求小车分别送往三端病房并返回,并且运送和返回时间均不超过40秒。

         小车系统+7V电源为L298N电机驱动提供电源,经L298N驱动模块内置的稳压模块输出+5V电源为其他模块供电,通过由发光二极管和光敏二极管组成的灰度传感器循迹模块对白色底板和红线对光的反射率不同来实现循迹、转弯和十字路口的判断。由STC98C52通过对I/O口控制驱动L298N模块改变四个直流电机的工作状态,通过四个电机驱动模块和调节PWM输出实现小车前进、后退、转向、掉头、加速、减速功能。

系统软件框图如图2.1所示,当传感器检测到红色轨道后开始判断是否读取到房间信息,进而驱动L298N电机驱动模块来驱动电机运作,使小车前往对应病房。

 、

                                                              图2.1 系统软件框图

        系统硬件框图如图2.2所示,使用+7V电压源为L298N电机驱动模块供电,经L298N内部稳压管输出+5V电压为单片机及其他模块供电。单片机通过I/O口读取灰度传感器和按键数据对小车进行控制。

3、理论分析与计算

3.1 病房选择:

目标病房选择说明示意图如表3.1按键对应病房所示,当按下不同按键使对应端口接地时,通过读取I/O端口,通过按键判断函数进行判断从而执行不同的子程序来进行病房之间的往返,从而达到智能送药的目的。

按键

KEY1

KEY2

KEY3

KEY4

KEY5

KEY6

KEY7

KEY8

病房号

按键状态

0

1

1

1

1

1

1

1

1

1

0

1

1

1

1

1

1

2

1

1

0

1

1

1

1

1

3

1

1

1

0

1

1

1

1

4

1

1

1

1

0

1

1

1

5

1

1

1

1

1

0

1

1

6

1

1

1

1

1

1

0

1

7

1

1

1

1

1

1

1

0

8

表3.1 按键对应病房

3.2 电机引脚及状态

        L298N真值表如图3.2所示,ENA为使能引脚,通过单片机输出PWM信号使能ENA来调整电机转速。IN1和IN2分别为高、低和低、高电平时电机对应正转、反转,IN1和IN2同时为低电平或同时为高电平时电机制动。ENA为低电平时使能IN1、IN2引脚无法对电机进行控制。

3.3 灰度传感器及电机状态

本设计采用五路灰度传感器L2、L1、M、R1、R2,当中间三个传感器L1、M、R1检测到红线时认为小车处于红线上,允许启动按键模块,启动后进行自动循迹和路口、终点识别。当M测到红线,L1、R1均未测到时,小车正常前进。当L1和M同时测到红线时,小车小幅度偏离轨道,此时左轮小幅度减速调整姿态直到L1检测不到红线。当L1测到红线而M未测到红线时小车大幅偏离轨道,此时左轮大幅度减速调整小车姿态直到L1和M同时测到红线,此时小车姿态恢复到小幅度偏离状态,左轮由大幅度减速改为小幅度减速至L1未测到红线而M测到红线。右边通过M、R1检测同理。此方法仅通过改变小车左右轮PWM进行姿态调整,且根据小车偏离的情况设置不同的差速,可以让小车在循迹过程中行进路线更为平滑稳定且不易偏离轨道。循迹过程L1、M、R1状态对应小车几种姿态如表3.3.1所示。

L1、M、R1输出状态

小车姿态

000

小车未在红线上

001

小车大幅度左偏

010

小车在红线中间

011

小车小幅度左偏

100

小车大幅度右偏

110

小车小幅度右偏

表3.3.1 循迹过程传感器状态对应的几种小车姿态

L2和R2传感器用于判断小车是否到达路口及终点,当五个传感器同时识别到红线则表示到达路口,五个传感器同时识别不到红线则表示小车通过终点虚线到达终点白色区域。对于远端病房T型路口则是检测L2、L1或者R2、R1识别到红线而对应R2、L2识别不到红线。路口、终点识别传感器状态如表3.3.2所示。

L2、L1、M、R1、R2输出状态

路口、终点判定

11111

到达路口

00000

到达终点

0XX11

T型路口(需右转)

11XX0

T型路口(需左转)

表3.3.2 路口、终点识别传感器状态

4、系统电路设计与仿真

4.1系统硬件框图

系统硬件如图4.1所示,由电源部分为L298N电机驱动供电,L298N电机驱动输出的5V电压为单片机和灰度传感器供电。由STC89C52控制L298N来驱动电机转动,通过灰度传感器采集到的不同的样本数据来控制小车处于不同的运动状态,再通过影响小车的运动状态反过来影响采样的数据。

图4.1 系统硬件框图

4.2 单片机最小板电路

本设计采用市场常见51最小开发板,搭配STC89C52芯片,是一个低功耗,高性能的51内核的CMOS 8位单片机,具有在线编程功能,使用简单价格低廉。51最小开发板电路图如图4.2所示。

4.3 驱动电路设计

在小车电机驱动方案的选择上,选择了市面上常见的电机驱动模块L298N双H桥直流电机驱动模块,此驱动板体积小,重量轻,具有强大的驱动能力:2A的峰值电流和46V的峰值电压;内置DC to DC稳压(LM2596稳压管),可提供5V电压为其他模块供电。L298N电路原理图如图4.3所示。

 

图4.3 L298N电路原理图

4.4 灰度传感器设计

本设计采用五路灰度传感器,每一组传感器均由一只发光二极管和一只光敏二极管组成,两个传感器安装在同一面上,利用不同颜色的被检测面对光的反射强弱程度 不同进行比较,从而输出对应的信号供单片机I/O口采集和控制。数字量灰度传感器可对被探测面的两种颜色差异进行调节比较,只可以用于识别任意颜色中色差较大的两种颜色(例如黑和白、白和绿,黑和红,白和蓝,黄和黑,黄和红,等等),数字量传感器带有电压比较器芯片和可调电位器;电压比较器芯片可以对接收管接收回来的信号进行放大处理,然后经过电位器功率调制,可实现识别灵敏度(或探测距 离)的调节,一般是探测到灰度值高(指接近于白色)的时候输出低电平,而探测到灰度值低(指接近于黑色)的颜色时则输出高电平;数字量为高低电平1和0两种信号状态输出,可以简化程序。灰度传感器原理图如图4.4所示。

图4.4 灰度传感器原理图

5、系统软件设计

        系统软件设计部分分为主函数、循迹调速函数、电机控制函数、定时器中端函数、按键扫描函数、前往各个房间函数、延时函数等部分组成。

        在检测到小车在红线上时开放按键许可,共8个按键、三个前往近中远病房函数,通过按下的按键确认对应函数前往不同病房。具体函数实现在后文展示。软件逻辑设计图如图5.1所示。

 

6、系统测试及结果分析

6.1 系统指标参数

6.1.1 STC89C52指标参数

      1、电源电压:5.5V~3.3V

      2、工作频率:40MHz

      3、512字节RAM,8K ROM

6.1.2 灰度传感器参数

      ①额定电压:直流电源5.0V

      ②检测高度:1-3cm

6.1.3 电机驱动模块参数

      ①输出电压:5.0V

      ②输入电机电压:5.0~36.0V

      ③输出驱动电流:2A

6.2 测试内容与方法

6.2.1 软件测试

在Keil5中进行程序的编译,检查程序是否有错误。通过不断测试调整,使得最终程序“0 Error(s), 0 Warning(s)”。将软件代码烧录进去后在跑道上进行实测,测试小车是否能检测房间、正确循线,对红黑色块的检测是否灵敏,在十字路口的识别和转弯情况 ,偏移轨迹后能不能返回轨道,还有检测、停车位置的准确度。如果有偏差,调整代码再反复调试。 

6.2.2 硬件测试

      通电前先检查连线,组装好电路后对照电路图按一定的顺序逐级检查电路连线,排查电源是否接错,电源与地线是否短路,二极管方向和电容正负是否接反,焊点是否焊牢,等等。通电后观察是否有冒烟、异常气味、元器件发烫等异象。

      先不加信号,测量各级直流工作电压和电流是否正常,一般对电路的静态工作点调试。 加上输入信号,观测电路输出信号是否符合要求。

6.3 实物外观

将小车按照电路图进行组装后,小车实物外观如图6.3所示。

图6.3 小车实物图

6.4 实物功能测试

    本设计的小车功能是从药房出发,分别到近端、中端、远端病房并

返回药房,去和返回的时间均不超过40s。

近端病房:送给小车一个近端病房的房间号,小车检测后循红线在第一个十字路口右转准确到达病房,小车走过终点虚线后停车,1s后倒车并前进,检测到十字路口后转弯返回药房。过程用时小于40s。

中端病房:送给小车中端房间号,小车在第二个十字路口左转,到达病房检   

测到超过虚线后停车,1s后倒车并前进,检测到十字路口后左转返回药房。过程用时小于40s。

远端病房:送给小车远端房间号,小车在第三个T字路口左转,第四个T字路口左转,到达病房检测到超过虚线后停车,1s后直行倒车,检测到十字路口后转弯按原路返回药房。过程用时小于40s。

6.5 测试结果分析

经过多次测试调试,整体测试结果能够达到题目要求和预期效果,并且速度远超题目所要求的40s的要求,完美的实现了整个送药的功能。

在测试过程中,小车在跑道上跑的时候车轮碾压会使跑道鼓起反光,或

者跑道所在环境光线的强度变化以及跑到表面脚印等使传感器检测不太准确,以致小车不能成功到达房间。经多次修改程序增加延迟检测以及短时间多次检测的方式可以减小极短时间的干扰。

通过多次对小车整体测试,小车性能达到设计要求,对于环境干扰有较强抵抗能力。经多次测试均能前往目的病房并原路返回,在巡线过程中未出现冲出轨道的情况,转弯和掉头时也能正确在转至中间传感器到达红线时停止。

7、结论

       在这次课程实践中,我充分的来利用了自己上大学以来学过的知识,同时加强了自己的动手能力,一切书本上的知识都应该转换成实践才有用处,所以我们应该更加重视起来实践能力,才能充分的运用自己所学的知识。当然小车还有不足之处,比如,模块性能有待提高,选用性能更强、更稳定的芯片等,功能比较少。我们应该更加的深入学习,掌握更多专业相关知识,才能做得更好,成为行业中的佼佼者。

如还需相关资料,可私信我获得,感谢支持

代码:

  1. #include<reg52.h>
  2. #include<intrins.h>
  3. unsigned char i1=0,i2=0;
  4. unsigned char Left_PWM=50,Right_PWM=50;
  5. /*L298N驱动引脚*///
  6. sbit ENA=P1^0;//L298N使能端 左轮
  7. sbit ENB=P1^1;//L298N使能端 右轮
  8. sbit IN1=P1^2;
  9. sbit IN2=P1^3;
  10. sbit IN3=P1^4;
  11. sbit IN4=P1^5;
  12. /*五路灰度传感器*///
  13. sbit IRN1=P2^0;//L2左2
  14. sbit IRN2=P2^1;//L1左1
  15. sbit IRN3=P2^2;//M中间 //黑高白低
  16. sbit IRN4=P2^3;//R1右1
  17. sbit IRN5=P2^4;//R2右2
  18. //按键1~8//
  19. sbit KEY1=P0^0;
  20. sbit KEY2=P0^1;
  21. sbit KEY3=P0^2;
  22. sbit KEY4=P0^3;
  23. sbit KEY5=P0^4;
  24. sbit KEY6=P0^5;
  25. sbit KEY7=P0^6;
  26. sbit KEY8=P0^7;
  27. /
  28. void Time_r0_Init();//定时器装载
  29. void Right_go();//右轮前进
  30. void Right_back();//右轮后退
  31. void Right_stop();//右轮停止
  32. void Left_go();//左轮前进
  33. void Left_back();//左轮后退
  34. void Left_stop();//左轮停止
  35. void Car_go();//小车前进
  36. void Car_back();//小车后退
  37. void Car_stop();//小车停止
  38. void turn_around();//小车掉头
  39. void Left_Z();//左直角转
  40. void Right_z();//右直角转
  41. void turn();//判断转弯情况
  42. void KEY();//按键扫描函数
  43. ///
  44. void go_to_near(char a1);//去近端病房 0左1右
  45. void go_to_mid(char a2);//去中端病房 0左1右
  46. void go_to_distant(char a3);//去远端病房 0左左1左右2右左3右右
  47. void delay(unsigned char delay_t);//延时函数
  48. void main(void)
  49. {
  50. P2=0xFF;
  51. Time_r0_Init();
  52. while(1)
  53. {
  54. KEY();
  55. }
  56. }
  57. void Time_r0_Init() //设置定时器0
  58. { //通过设置定时器0来调制小车的转速
  59. TMOD=0x01; //选择16位的定时器
  60. TH0=(65536-100)/256;
  61. TL0=(65536-100)%256;
  62. ET0=1; //开放定时器中断0
  63. TR0=1;
  64. EA=1;
  65. }
  66. void delay(unsigned char delay_t)
  67. {
  68. unsigned char delayi, delayj;
  69. for(delayi=delay_t;delayi>0;delayi--)
  70. {
  71. for(delayj=110;delayj>0;delayj--);
  72. }
  73. }
  74. void KEY()
  75. {
  76. while(1)
  77. {
  78. if(KEY1==0)
  79. {
  80. delay(20);
  81. if(KEY1==0)
  82. {
  83. go_to_near(0);//去近端左边
  84. break;
  85. }
  86. }
  87. else if(KEY2==0)
  88. {
  89. delay(20);
  90. if(KEY2==0)
  91. {
  92. go_to_near(1);//去近端右边
  93. break;
  94. }
  95. }
  96. else if(KEY3==0)
  97. {
  98. delay(20);
  99. if(KEY3==0)
  100. {
  101. go_to_mid(0);//去中端左边
  102. break;
  103. }
  104. }
  105. else if(KEY4==0)
  106. {
  107. delay(20);
  108. if(KEY4==0)
  109. {
  110. go_to_mid(1);//去中端右边
  111. break;
  112. }
  113. }
  114. else if(KEY5==0)
  115. {
  116. delay(20);
  117. if(KEY5==0)
  118. {
  119. go_to_distant(0);//去远端左左
  120. break;
  121. }
  122. }
  123. else if(KEY6==0)
  124. {
  125. delay(20);
  126. if(KEY6==0)
  127. {
  128. go_to_distant(1);//去远端左右
  129. break;
  130. }
  131. }
  132. else if(KEY7==0)
  133. {
  134. delay(20);
  135. if(KEY7==0)
  136. {
  137. go_to_distant(2);//去远端右左
  138. break;
  139. }
  140. }
  141. else if(KEY8==0)
  142. {
  143. delay(20);
  144. if(KEY8==0)
  145. {
  146. go_to_distant(3);//去远端右右
  147. break;
  148. }
  149. }
  150. }
  151. }
  152. void Right_back()
  153. {
  154. IN3=0;
  155. IN4=1;
  156. }
  157. void Right_go()
  158. {
  159. IN3=1;
  160. IN4=0;
  161. }
  162. void Right_stop()
  163. {
  164. IN3=0;
  165. IN4=0;
  166. }
  167. void Left_back()
  168. {
  169. IN1=0;
  170. IN2=1;
  171. }
  172. void Left_go()
  173. {
  174. IN1=1;
  175. IN2=0;
  176. }
  177. void Left_stop()
  178. {
  179. IN1=0;
  180. IN2=0;
  181. }
  182. void Car_go()
  183. {
  184. Right_go();
  185. Left_go();
  186. }
  187. void Car_stop()
  188. {
  189. Right_stop();
  190. Left_stop();
  191. }
  192. void Car_back()
  193. {
  194. Right_back();
  195. Left_back();
  196. }
  197. void Right_z()//右直角转弯
  198. {
  199. Right_PWM=0;
  200. Left_PWM=30;
  201. while(1)
  202. {
  203. if(IRN5==1)
  204. {
  205. delay(10);
  206. if(IRN5==1)
  207. {
  208. while(1)
  209. {
  210. if(IRN5==0&&IRN3==1)
  211. {
  212. Right_PWM=30;
  213. break;
  214. }
  215. }
  216. break;
  217. }
  218. }
  219. }
  220. }
  221. void Left_z()
  222. {
  223. Right_PWM=30;
  224. Left_PWM=0;
  225. while(1)
  226. {
  227. if(IRN1==1)
  228. {
  229. delay(10);
  230. if(IRN1==1)
  231. {
  232. while(1)
  233. {
  234. if(IRN1==0&&IRN3==1)
  235. {
  236. Left_PWM=30;
  237. break;
  238. }
  239. }
  240. break;
  241. }
  242. }
  243. }
  244. }
  245. void turn_around()//小车掉头
  246. {
  247. Car_stop();
  248. delay(100);
  249. Right_go();
  250. Left_back();
  251. for(i2=0;i2<3;i2++)
  252. {
  253. delay(5000);
  254. }
  255. while(1)
  256. {
  257. if(IRN1==1)
  258. {
  259. delay(10);
  260. if(IRN1==1)
  261. {
  262. while(1)
  263. {
  264. if(IRN3==1)
  265. {
  266. delay(10);
  267. if(IRN3==1)
  268. {
  269. break;
  270. }
  271. }
  272. }
  273. break;
  274. }
  275. }
  276. }
  277. Car_stop();
  278. delay(100);
  279. }
  280. void go_to_near(char a1)//去近端病房
  281. {
  282. char i6=0;
  283. while(1)
  284. {
  285. if((IRN1==0&&IRN5==0)&&(IRN3==1||IRN2==1||IRN4==1))
  286. {
  287. while(1)
  288. {
  289. if(a1==0)
  290. {
  291. if(KEY1==0)
  292. {
  293. delay(20);
  294. if(KEY1==0)
  295. {
  296. Car_go();
  297. delay(30);
  298. break;
  299. }
  300. }
  301. }
  302. if(a1==1)
  303. {
  304. if(KEY2==0)
  305. {
  306. delay(20);
  307. if(KEY2==0)
  308. {
  309. Car_go();
  310. delay(30);
  311. break;
  312. }
  313. }
  314. }
  315. }
  316. break;
  317. }
  318. }
  319. while(1)
  320. {
  321. turn();
  322. if(IRN1==1&&IRN5==1)
  323. {
  324. delay(15);
  325. if(IRN1==1&&IRN5==1)
  326. {
  327. delay(15);
  328. if(IRN1==1&&IRN5==1)
  329. {
  330. while(1)
  331. {
  332. if(IRN1==0&&IRN5==0)
  333. {
  334. if(a1==1)
  335. {
  336. Right_z();
  337. }
  338. else
  339. {
  340. Left_z();
  341. }
  342. i6++;
  343. break;
  344. }
  345. }
  346. }
  347. }
  348. }
  349. if(i6>=1)
  350. {
  351. i6=0;
  352. break;
  353. }
  354. }
  355. while(1)
  356. {
  357. turn();
  358. if(IRN1==0&&IRN2==0&&IRN3==0&&IRN4==0&&IRN5==0)
  359. {
  360. delay(20);
  361. if(IRN1==0&&IRN2==0&&IRN3==0&&IRN4==0&&IRN5==0)
  362. {
  363. delay(20);
  364. if(IRN1==0&&IRN2==0&&IRN3==0&&IRN4==0&&IRN5==0)
  365. {
  366. Car_stop();
  367. delay(100);
  368. break;
  369. }
  370. }
  371. }
  372. }
  373. turn_around();
  374. Car_go();
  375. while(1)
  376. {
  377. turn();
  378. if(IRN1==1&&IRN5==1)
  379. {
  380. delay(15);
  381. if(IRN1==1&&IRN5==1)
  382. {
  383. delay(15);
  384. if(IRN1==1&&IRN5==1)
  385. {
  386. while(1)
  387. {
  388. if(IRN1==0&&IRN5==0)
  389. {
  390. if(a1==1)
  391. {
  392. Left_z();
  393. }
  394. else
  395. {
  396. Right_z();
  397. }
  398. i6++;
  399. break;
  400. }
  401. }
  402. }
  403. }
  404. }
  405. if(i6==1)
  406. {
  407. i6=0;
  408. break;
  409. }
  410. }
  411. while(1)
  412. {
  413. turn();
  414. if(IRN1==0&&IRN2==0&&IRN3==0&&IRN4==0&&IRN5==0)
  415. {
  416. delay(15);
  417. if(IRN1==0&&IRN2==0&&IRN3==0&&IRN4==0&&IRN5==0)
  418. {
  419. delay(15);
  420. if(IRN1==0&&IRN2==0&&IRN3==0&&IRN4==0&&IRN5==0)
  421. {
  422. Car_stop();
  423. delay(100);
  424. turn_around();
  425. }
  426. }
  427. }
  428. }
  429. }
  430. void go_to_mid(char a2)//去中端病房
  431. {
  432. char i7=0;
  433. while(1)
  434. {
  435. if((IRN1==0&&IRN5==0)&&(IRN3==1||IRN2==1||IRN4==1))
  436. {
  437. while(1)
  438. {
  439. if(a2==0)
  440. {
  441. if(KEY3==0)
  442. {
  443. delay(20);
  444. if(KEY3==0)
  445. {
  446. Car_go();
  447. delay(30);
  448. break;
  449. }
  450. }
  451. }
  452. if(a2==1)
  453. {
  454. if(KEY4==0)
  455. {
  456. delay(20);
  457. if(KEY4==0)
  458. {
  459. Car_go();
  460. delay(30);
  461. break;
  462. }
  463. }
  464. }
  465. }
  466. break;
  467. }
  468. }
  469. //
  470. while(1)
  471. {
  472. turn();
  473. if(IRN1==1&&IRN5==1)
  474. {
  475. delay(15);
  476. if(IRN1==1&&IRN5==1)
  477. {
  478. delay(15);
  479. if(IRN1==1&&IRN5==1)
  480. {
  481. while(1)
  482. {
  483. if(IRN1==0&&IRN5==0)//等待通过十字路口
  484. {
  485. delay(20);
  486. if(IRN1==0&&IRN5==0)
  487. {
  488. i7++;
  489. break;
  490. }
  491. }
  492. }
  493. }
  494. }
  495. }
  496. if(i7==1)
  497. {
  498. i7=0;
  499. break;
  500. }
  501. }
  502. ///
  503. while(1)
  504. {
  505. turn();
  506. if(IRN1==1&&IRN5==1)
  507. {
  508. delay(15);
  509. if(IRN1==1&&IRN5==1)
  510. {
  511. delay(15);
  512. if(IRN1==1&&IRN5==1)
  513. {
  514. while(1)
  515. {
  516. if(IRN1==0&&IRN5==0)
  517. {
  518. if(a2==1)
  519. {
  520. Right_z();
  521. }
  522. else
  523. {
  524. Left_z();
  525. }
  526. i7++;
  527. break;
  528. }
  529. }
  530. }
  531. }
  532. }
  533. if(i7==1)
  534. {
  535. i7=0;
  536. break;
  537. }
  538. }
  539. /
  540. while(1)
  541. {
  542. turn();
  543. if(IRN1==0&&IRN2==0&&IRN3==0&&IRN4==0&&IRN5==0)
  544. {
  545. delay(15);
  546. if(IRN1==0&&IRN2==0&&IRN3==0&&IRN4==0&&IRN5==0)
  547. {
  548. delay(15);
  549. if(IRN1==0&&IRN2==0&&IRN3==0&&IRN4==0&&IRN5==0)
  550. {
  551. Car_stop();
  552. delay(1000);
  553. break;
  554. }
  555. }
  556. }
  557. }
  558. turn_around();//掉头
  559. Car_go();
  560. while(1)
  561. {
  562. turn();
  563. if(IRN1==1&&IRN5==1)
  564. {
  565. delay(15);
  566. if(IRN1==1&&IRN5==1)
  567. {
  568. delay(15);
  569. if(IRN1==1&&IRN5==1)
  570. {
  571. while(1)
  572. {
  573. if(IRN1==0&&IRN5==0)
  574. {
  575. if(a2==1)
  576. {
  577. Left_z();
  578. }
  579. else
  580. {
  581. Right_z();
  582. }
  583. i7++;
  584. break;
  585. }
  586. }
  587. }
  588. }
  589. }
  590. if(i7==1)
  591. {
  592. i7=0;
  593. break;
  594. }
  595. }
  596. while(1)
  597. {
  598. turn();
  599. if(IRN1==1&&IRN5==1)
  600. {
  601. delay(15);
  602. if(IRN1==1&&IRN5==1)
  603. {
  604. delay(15);
  605. if(IRN1==1&&IRN5==1)
  606. {
  607. while(1)
  608. {
  609. if(IRN1==0&&IRN5==0)//等待通过十字路口

 

声明:本文内容由网友自发贡献,不代表【wpsshop博客】立场,版权归原作者所有,本站不承担相应法律责任。如您发现有侵权的内容,请联系我们。转载请注明出处:https://www.wpsshop.cn/w/我家小花儿/article/detail/438564
推荐阅读
相关标签
  

闽ICP备14008679号