2013中国教育机器人大赛智能搬运比赛演示程序说明.docVIP

2013中国教育机器人大赛 智能搬运竞赛演示程序说明 深圳市中科鸥鹏智能科技有限公司 2013年7月 目录 第一章 智能搬运比赛简介 3 1.1 比赛任务介绍 3 第二章 组装智能搬运机器人 4 2.1 智能搬运机器人零件 4 2.2 智能搬运机器人安装说明 4 第三章 超声波传感器测试说明 6 3.1 超声波传感器技术参数介绍 6 3.2 超声波测试程序 7 第四章 QTI线跟踪传感器测试说明 9 4.1 QTI传感器技术参数介绍 9 4.2 QTI传感器测试程序 9 第五章 智能搬运算法说明及程序 10 5.1 智能搬运算法说明 10 5.2 智能搬运程序 11 第一章 智能搬运比赛简介 智能搬运是“中国教育机器人比赛”的一个比赛项目，智能搬运比赛是基于8位单片机的小型机器人比赛项目。在比赛场地里移动，并将不同颜色的色块分类搬运到对应的位置。比赛的记分根据机器人搬运物体安置位置的精度和完成任务时间来决定分值的高低。该比赛模拟了工业自动化过程中自动化物流系统的实际工作过程，使参赛队员在实践中了解自动化物流系统的制作过程。 1.1 比赛任务介绍 图1.1 智能搬运场地图 如图1.1所示绿色区域为智能搬运场地的出发区。机器人从出发区出发，到达物料储存区后，分拣其赛前1小时抽签决定好的任务，即先从5个预知颜色色块（黄、白、红、黑、蓝）按照顺序抽取4个颜色色块分别依次放到A，B，D，E位置，然后将剩下的1个色块通过抽签放到F、G、H和I中的一个位置。在1小时内修改和调整程序，控制机器人运动，以便将5个颜色色块准确地搬运到对应的5个颜色中心区域内，最后回到出发区。 第二章 组装智能搬运机器人 2.1 智能搬运机器人零件 宝贝车车体 一套 搬运手爪 一个 超声波传感器 一个 QTI线跟踪套件 四个 C51+AVR教学板 一个 导线和连接线 若干 螺钉、螺母、铜柱和固定架 若干 5-8V电源 一个 以下为部分智能搬运机器人零件的实物图。 图2.1 宝贝车车体图 图2.2搬运手爪图 图2.3 C51+AVR教学板图 图2.4 QTI线跟踪套件图 图2.5超声波传感器图 2.2 智能搬运机器人安装说明 参照《基础机器人制作与编程》文档第29至32页的要求组装宝贝车和C51+AVR教学板（注：该文档的宝贝车上装BASIC Stamp 微控制器，将BASIC Stamp 微控制器换成C51+AVR教学板即可，安装要求教学板上的面包板在车体前方。）。以下用表格描述各传感器与教学板的电路连接方式。 表2.1 电机、QTI线跟踪套件、超声波传感器与C51教学板的电路连接 设备名称 设备端口 C51教学板端口 右电机 白线 P10 红线 Vin 黑线 GND 左电机 白线 P11 红线 Vin 黑线 GND QTI1 SIG P00 QTI2 SIG P01 QTI3 SIG P02 QTI4 SIG P03 超声波传感器 Trlg P20 Echo P21 VCC 5V GND GND 表格补充说明，以宝贝车的车体前方为正方向，则对应的左右两边为左右电机，如图2.6所示。4个QTI线跟踪传感器的命名顺序是从右边第一个开始为QTI1，第二个为QTI2，第三个为QTI3，第四个为QTI4。 图2.6 智能小车左右电机标明图 按照上面描述的安装方法完成智能小车安装，安装完成的小车效果图，如图2.7、图2.8、图2.9所示。 图2.7 智能小车安装效果俯视图 图2.8 智能小车安装效果正面图 图2.9 智能小车安装效果小车下方图 超声波传感器测试说明 3.1 超声波传感器技术参数介绍 DM-S28018-B超声波提供了精确的、非接触式的距离测量，测量范围从2cm到5m，它非常方便的与单片机连接，只需要两个IO口就可以控制。 (1) 使用方法为： 采用IO触发测距，给TRIG至少10us的高电平信号。 模块自动发送8个40KHz的方波，自动检测是否有信号返回。 有信号通过ECHO返回，ECHO输出一高电平，高电平持续的时间就是超声波从发射到返回的时间。 (2) 产品特性： 使用电压：DC 5V； 静态电流：小于2mA； 电平输出：高电平VCC0.2V，低电平0.2V； 感应角度：不大于15度； 探测距离：0.02m-5m； 探测精度