设为首页收藏本站
开启辅助访问 切换到宽版

 找回密码
 立即注册

QQ登录

只需一步，快速开始

热门： 51单片机 | 24小时必答区 | 单片机教程 | 单片机DIY制作 | STM32 | Cortex M3 | 模数电子 | 电子DIY制作 | 音响/功放 | 拆机乐园 | Arduino | 嵌入式OS | 程序设计

搜索
»论坛 › 嵌入式/单片机论坛 › 51单片机 › 搬运色块 巡游景点 巡线机器人小车的设计资料下载
返回列表 发新帖
查看: 4136|回复: 1
打印 上一主题 下一主题
收起左侧

搬运色块 巡游景点 巡线机器人小车的设计资料下载

[复制链接]
跳转到指定楼层
楼主
ID:214361 发表于 2017-6-25 01:19 | 只看该作者 |只看大图 回帖奖励 |倒序浏览 |阅读模式
如题！！！！！！！！！！！！！


包含以下资料：
示例程序\
2017春《计算机编程能力实训》安排.doc
QTI巡线传感器说明及寻线策略.docx
《计算机编程能力实训》动员-基于教育机器人.ppt
任务书1_智能搬运机器人的设计与实现_17春.doc
任务书2-巡游机器人设计与实现_17春.doc

程序包含：
threeQTI-3个QTI传感器的巡线程序.c
巡游-一个景点-基于数组实现.c
巡游-一个景点-非数组实现.c
搬运-E点黑色.c

部分单片机源程序预览如下:
  1. /************************************************
  2. 程序功能：搬运1个色块: E点，黑色
  3. 舵机连接：左轮 P1_1
  4.           右轮 P1_0
  5. QTI传感器连接：从左至右 P2_4 P2_3 P2_2 P2_1

  7. 程序编写调试：王淑鸿 2016-6
  8. ************************************************/

  10. #include <Boebot.h>
  11. #include <uart.h>
  12. #define uint unsigned int
  13. #define uchar unsigned char

  15. void fastforward(void);            //快速前进1步
  16. void slowforward(void);            //慢速前进1步
  17. void slowerback(void);                  // 慢速后退1步
  18. void turn_left(uint n);             //左转
  19. void turn_right(uint n);            //右转
  20. void zhixing(int n);                                //向前直行
  21. void daotui(int i);                        //后退
  22. void check_left(void);              //小幅向左  
  23. void check_right(void);             //小幅向右
  24. void Get_QTI_State(void);            //获取传感器返回值
  25. void Follow_Line(void);                //巡线
  26. void Get_E(void) ;                   //取E点物块，取到中心线上
  27. void Put_Black(void);                         // 将中心线上的黑色色块推到目标位置
  28. void BackToZero(void);                                 //从中心线回到起始区域


  31. uchar QTIState;

  33. uint RIGHT90=20;
  34. uint RIGHT45=10;
  35. uint RIGHT180=35;

  37. uint LEFT90=25;
  38. uint LEFT45=13;




  43. void fastforward(void)                //快速前进
  44. {
  45.         P1_0=1;
  46.         delay_nus(1350);
  47.         P1_0=0;
  48.         delay_nms(20);
  49.         P1_1=1;
  50.         delay_nus(1650);      
  51.         P1_1=0;
  52.         delay_nms(20);
  53. }

  55. void slowforward(void)          //慢速前进
  56. {        P1_0=1;
  57.         delay_nus(1450);        
  58.         P1_0=0;
  59.         delay_nms(20);
  60.         P1_1=1;
  61.         delay_nus(1550);
  62.         P1_1=0;
  63.         delay_nms(20);
  64. }

  66. void slowerback(void)                // 慢速后退
  67. {
  68.         P1_0=1;
  69.         delay_nus(1550);        
  70.         P1_0=0;
  71.         delay_nms(20);
  72.         P1_1=1;
  73.         delay_nus(1450);
  74.         P1_1=0;
  75.         delay_nms(20);
  76. }

  78. void turn_left(uint n)              //左转
  79. {
  80.          int i;
  81.      for(i=0;i<=n;i++)
  82.        {
  83.                 P1_0=1;
  84.                 delay_nus(1450);
  85.                 P1_0=0;
  86.                 delay_nms(20);
  87.                 P1_1=1;
  88.                 delay_nus(1450);
  89.                 P1_1=0;
  90.                 delay_nms(20);
  91.            }
  92. }

  94. void turn_right(uint n)            //右转  
  95. {
  96.          int i;
  97.      for(i=0;i<=n;i++)
  98.        {
  99.                 P1_0=1;
  100.                 delay_nus(1550);
  101.                 P1_0=0;
  102.                 delay_nms(20);
  103.                 P1_1=1;
  104.                 delay_nus(1550);
  105.                 P1_1=0;
  106.                 delay_nms(20);
  107.            }
  108. }





  114. void zhixing(int n)                          //直行
  115. {
  116.         int a;
  117.         for(a=0;a<=n;a++)
  118.         fastforward();
  119. }


  122. void daotui(int n)                        //慢速倒退
  123. {
  124.         int a;
  125.         for(a=0;a<=n;a++)
  126.         slowerback();
  127. }

  129. void check_left(void)     //小幅向左
  130. {       
  131.             P1_0=1;
  132.             delay_nus(1400);         
  133.                  P1_0=0;
  134.             delay_nms(20);
  135.                 P1_1=1;
  136.                 delay_nus(1500);
  137.                 P1_1=0;
  138.                 delay_nms(20);
  139. }

  141. void check_right(void)    //小幅向右
  142. {
  143.           P1_1=1;
  144.           delay_nus(1600);         
  145.           P1_1=0;
  146.           delay_nms(20);
  147.           P1_0=1;
  148.           delay_nus(1500);
  149.           P1_0=0;
  150.           delay_nms(20);  
  151. }



  155. void Get_QTI_State(void)                       //获取传感器返回值
  156.         {
  157.                 QTIState=P2&0x1e;                     //P2_4  P2_3  P2_2  P2_1
  158.                 QTIState=QTIState/2;                  //右移1位               
  159.         }



  163. void Follow_Line(void)                //巡线
  164. {
  165.                                                    

  167.                 Get_QTI_State();

  169.         switch(QTIState)                         
  170.                 {
  171.                 case 4: check_left() ;break;                        //传感器返回值：0100
  172.                 case 2: check_right();break;                        //传感器返回值：0010
  173.                 case 8: check_left() ;break;                        //传感器返回值：1000
  174.                 case 12: check_left() ;break;                        //传感器返回值：1100
  175.                 case 14: check_left() ;break;                        //传感器返回值：1110
  176.                 case 1: check_right();break;                        //传感器返回值：0001
  177.                 case 3: check_right();break;                        //传感器返回值：0011
  178.                 case 7: check_right();break;                        //传感器返回值：0111
  179.                 default: slowforward();break;
  180.                 }
  181. }


  184. void Get_E(void)                          //取E点物块，取到中心线上
  185. {
  186.         int i;
  187.         while(QTIState!=0x0f)                 //当不是全黑时，巡线
  188.         Follow_Line();
  189.         zhixing(6);                                                          //直行一小段，调整位置
  190.         turn_right(RIGHT90);                  //右转90度
  191.         while(QTIState!=0x00)                 //当不是全白时，巡线
  192.         Follow_Line();
  193.         zhixing(6);
  194.     turn_right(RIGHT180);
  195.         while(QTIState!=0x0f)                 //当不是全黑时，巡线
  196.         Follow_Line();
  197.         zhixing(6);
  198.         turn_left(LEFT90);                                          //左转90度
  199.         for(i=0;i<40;i++)
  200.                 Follow_Line();
  201.     turn_right(RIGHT180);                  
  202. }

  204. void Put_Black(void)                                 // 将中心线上的黑色色块推到目标位置
  205. {
  206.         int i;        
  207.         while(QTIState!=0x0f)                 //当不是全黑时，巡线
  208.         Follow_Line();
  209.         zhixing(6);
  210.         turn_right(RIGHT45);
  211.         while(QTIState!=0x00)                 //当不是全白时，巡线
  212.         Follow_Line();
  213.         zhixing(6);
  214.         while(QTIState!=0x0f)                 //当不是全黑时，巡线
  215.         Follow_Line();
  216.         daotui(20);
  217.         turn_right(RIGHT180);  
  218.         while(QTIState!=0x00)                 //当不是全白时，巡线
  219.         Follow_Line();
  220.         zhixing(6);
  221.         while(QTIState!=0x0f)                 //当不是全黑时，巡线
  222.     Follow_Line();
  223.         zhixing(6);
  224.         turn_left(LEFT45);
  225. ……………………

  227. …………限于本文篇幅 余下代码请从51黑下载附件…………
复制代码

所有资料51hei提供下载:
课程设计-自通-机器人-17春.rar (1.59 MB, 下载次数: 32)


机器人, 课程
分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏1 分享淘帖 顶顶 踩踩

相关帖子
回复

使用道具 举报

沙发
ID:1 发表于 2017-6-25 02:39 | 只看该作者
好资料，51黑有你更精彩!!!
回复

使用道具 举报

返回列表 发新帖
高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

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

Powered by 单片机教程网

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