找回密码
 立即注册

QQ登录

只需一步,快速开始

搜索
查看: 1676|回复: 0
打印 上一主题 下一主题
收起左侧

2003智能小车(全国大学生电子设计竞赛)程序

[复制链接]
跳转到指定楼层
楼主
ID:624278 发表于 2020-7-18 12:37 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
  1. #include<reg51.h>
  2. #include"Config.h"
  3. #include"IOCfg.c"
  4. #include"TimeDLY.h"
  5. #include"StepMot.h"
  6. #include"Follow.h"

  7. //寻线函数:Follow()
  8. void  Follow(void)
  9. {
  10.         INT8U temp;
  11.         temp = Follow_L;
  12.         temp = (temp<<1)|Follow_M;
  13.         temp = (temp<<1)|Follow_R;
  14.         switch(temp&0x07)
  15.         {
  16.                 //没检测到黑线时,原地打转
  17.                 case 0x00:  LMotRun(LSPEED);RMotStop();     break;
  18.                 //仅右边检测到黑线时,左电机快转,右电机慢转
  19.                 case 0x01:  LMotRun(HSPEED);RMotRun(LSPEED);break;
  20.                 //仅中间检测到黑线时,正常,左右电机都快转
  21.                 case 0x02:  LMotRun(HSPEED);RMotRun(HSPEED);break;
  22.                 //中间以及右边检测到黑线时,左电机快转,右电机慢转
  23.                 case 0x03:  LMotRun(HSPEED);RMotRun(LSPEED);break;
  24.                 //仅左边检测到黑线时,左电机慢转,右电机快转
  25.                 case 0x04:  LMotRun(LSPEED);RMotRun(HSPEED);break;
  26.                 case 0x05:  break;  //不可能出现此情况
  27.                 //中间以及左边检测到黑线时,左电机慢转,右电机快转
  28.                 case 0x06:  LMotRun(LSPEED);RMotRun(HSPEED);break;       
  29.                 //中间,左右边都检测到黑线时,原地打转
  30.                 case 0x07:  LMotRun(LSPEED);RMotStop();     break;
  31.                 default: break;
  32.                 }
  33.         }
复制代码


2003智能小车(全国大学生电子设计竞赛).rar

44.83 KB, 下载次数: 14, 下载积分: 黑币 -5

分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏1 分享淘帖 顶 踩
回复

使用道具 举报

您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表