机器人设计.pdf

《机器人设计.pdf》由会员分享，可在线阅读，更多相关《机器人设计.pdf（10页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、1/10 智能控制与程序设计-宝贝车机器人 课程报告 班 级：电信学院 13306 人 员：王丽春 同组人员：陈天、刘棒锦 时 间：2015.11.14 指导教师：杨杰、汤博文 地 点：工业中心 30212/10 一、课程目的、任务及要求 1.1 课程目的 通过训练，了解一个完整的、可以运动的机器人应由那几部分组成。理解每一个机器人都是根据特定要求而设计的，设计的第一步就是将使用要求分析清楚，确定设计时需要考虑的参数，包括：机器人的运动路径、定位精度，重复定位精度、任务执行参数等。了解目前机器人的能量供给的各种形式，掌握控制部分和执行部分的供电方式。理解机器人的运动系统的构成及其原理。了解机器

2、人探测周边环境的传感器有那些，掌握传感器的信号如何传送给单片机的。理解机器人是如何根据传感器的信息做出决策。掌握机器人如何运动，并且了解机器人运动的其它方法。理解机器人与用户交换信息的各种方法。培养团队协作和独立工作能力。1.2 课程任务及要求 陈述清楚宝贝机器人如何实现运动。掌握宝贝机器人的控制部分和运动部分的供电方式，并画出这两部分的电路示意图。理清宝贝机器人的人机交互关系，陈述清楚宝贝机器人如何实现人机交互（通过串口调试软件实现人机交互）。陈述清楚宝贝机器人有那些传感器，传感器的信息是如何传送到单片机的。完成宝贝机器人的触觉导航，并陈述清楚其原理。能在实验中迅速排除各种故障。鼓励创新，在

3、完成前八个任务的前提下，尽量能做出新的开发，如果现有硬件条件不满足，可以陈述清楚创新原理。二、课程准备 2.1 实验设备 硬件：PC 机一台、AT89S52 型单片机、机器人组件、ISP 下载电缆、串口线、电池 软件：Keil uVision4 IDE 集成开发环境、progisp172 软件下载工具、串口调试软件 2.2 机器人的组装和软件的安装及初步应用 2.2.1 组装宝贝车机器人“宝贝车”是由许多部件组成的一款机器人，在使用及编程控制其运动之前，首先要进行组装，步骤如下：(1)安装机器人底盘硬件 零件列表：宝贝车底盘、螺柱、盘头螺钉、13/32 英寸的橡胶圈 1.将 13/32 英寸的

4、橡胶套圈插到宝贝车底盘中心的孔内，确保底盘中心孔的边缘嵌在橡胶圈的凹槽中；2.用 4 个螺钉将螺柱固定在底盘上。(2)拆除伺服喉，将电机安装在底盘上 零件列表：宝贝车底盘（已部分组装好）、连续旋转电机、螺钉 3/8 英寸 4-40、螺母 4-40 1.用螺钉和螺母将电机固定在底盘上，为了最好性能，需从里面将电机放入底盘。由于3/10 底盘空间小，螺钉也小，所以螺丝起子不容易进去，螺钉的安装需要有一定的耐心；2.用标签纸表示左右电机轮。(3)安装电池盒和轮子 零件列表：宝贝车底盘、平头螺钉 3/8 英寸 4-40、螺母 4-40、带有插头的电池盒、开口销、球状尾轮、橡皮圈、塑胶轮子 1.安装电池

5、盒比较简单，注意的就是在将电源线和伺服电机线穿过橡胶圈的孔时，由于两条线的接头比较大，可先将橡胶圈取出便于穿出，当线穿过之后再将橡胶圈安在底盘的空上；2.安装尾轮，用开口销作为轴，穿过底盘左侧、尾轮、底盘右侧的孔，将球状尾轮固定在底盘上，并将开口销的一端弯曲；安装驱动轮，只要将两个轮子有凹槽的一面压在输出轴上，并用螺钉固定即可，注意给轮子安橡胶圈时，为了便于安装将橡胶圈可裁窄一些。(4)安装教学底板 零件列表：宝贝车机器人底盘、平头螺钉、带控制器的教学板 2.2.2 安装软件及其初步应用 1.本次实验需要用到 3 款软件：Keil uVision4 IDE 集成开发环境、PROGISP172

6、下载软件、串口调试软件。在软件安装好以后，应有串口的连接和ISP 下载线的连接，以实现编程和交互。Keil uVision4 软件的使用：启动 Keil uVision4 ProjectNew Project在文件名中输入“001”，保存在想保存的位置选择 AT89S52，确定选择不加载“否”单击新建按钮，将编号的程序写入 保存 001.c 在项目文件夹 在目标工程项目中，右键“Source Group1”单击 Add Files to Group Source Group1Add右键 Target1选择 Option for targetTarget1单击 output，选择 Create

7、HEX Fi:确定运行，没有错误即创建成功文件名为 001.hex，这个文件就是将来可以烧录到 C51 单片机中的可执行程序。PROGISP172 下载软件的使用：串口调试软件的使用：打开串口调试终端，选择 COM1 后单击“打开串口”，在程序运行时，在接收区就会看到单片机向 PC 发出的信息。此软件用来显示单片机与计算机的交互信息，在硬件上要有串行接口或 USB 接口来与单片机教学板的串口连接。三、课程任务 3.1 伺服电机的控制 3.1.1 单片机的输出测试 单片机的输出测试是通过控制单灯闪烁实现的根据图1 搭建 LED 电路：图 1 4/10 通过编程控制单灯闪烁、两灯同时闪烁和两灯交替

8、闪烁，以及其闪烁的时间，只要让两个 LED 灯分别接到 P1_0 和 P1_1，电路连接方式相同，通过对 P1_0 和 P1_1 赋值，并改变 delay_nms(time)即可实现以上各种控制，例如两灯交替闪烁，间隔时间为1s，程序如下：#include#include int main(void)uart_Init();printf(The LED conneced to P1_0 is blinking!n);while(1)P1_1=1;delay_nus(1500);P1_1=0;delay_nus(200);3.1.2 伺服电机的标定 在测试控制伺服电机转速的信号之前，一定要对伺服

9、电机标定（调零），其程序如下：对右轮标定#include#include int main(void)uart_Init();/初始化串口 printf(The LED connected to P1_0 is blinking!n);while(1)P1_0=1；/P1_0 输出高电平 delay_nus(1500);/延时 1.5ms P1_0=0;/P1_0 输出低电平 delay_nms(20);/延时 20ms 此程序使左轮静止不动，如果左轮缓慢动，应用起子对其调整，具体步骤：将教学底板上的三位开关扳到 2，调整底盘下边伺服电机的调零螺钉，调整时要缓慢，直到标定的轮子静止不动。对左轮

10、标定#include#include int main(void)uart_Init();/初始化串口 printf(The LED connected to P1_0 is blinking!n);while(1)P1_1=1；/P1_1 输出高电平 delay_nus(1500);/延时 1.5ms P1_1=0;/P1_1 输出低电平 delay_nms(20);/延时 20ms 5/10 此程序使右轮静止不动，如果右轮缓慢转动，同样应用起子对其调整，具体步骤同左轮的标定。遇到的问题及解决办法:分别标定两个伺服电机比较浪费时间，可以将两个程序写在一起，同时对左右电机进行标定，可节省时间。

11、3.1.3 对电机控制信号的测试 控制电机的速度的是高电平持续时间，当高电平持续时间为 1.3ms 时，电机顺时针全速旋转，当高电平持续时间 1.7ms 时，电机逆时针全速旋转 注意的问题：顺时针和逆时针是从所测试的轮子的外面轴向看过去的旋转方向。图 2 为电机转速为 0 的控制信号时序 图 2 图 3 为 1.3ms 的控制脉冲序列使电机顺时针全速旋转 图 3 图 4 为 1.7ms 的控制脉冲序列使电机逆时针全速旋转 图 4 心得体会:电机转动方向及速度的调节可以通过改变 delay_nus()；括号中数值来实现调节。实际测试小车时，合理的速度及左右轮方向的配合可以使小车行走时更可靠，这需

12、要反复调试程序。3.2 机器人巡航控制 6/10 3.2.1 基本巡航动作 这个任务主要是改变机器人的前进方向，实现向前、向左、向右、向后、原地转、绕支点转，并结合上一任务循环次数的控制来控制运动时间。机器人的转向问题无非是通过控制机器人的两个轮子逆时针、顺时针旋转来实现。表 1 说明了机器人在标定电机后在不同脉冲序列的情况下的运动形式。表 1 左轮 右轮 转向 P1_1=1;delay_nus(1700);P1_1=0;delay_nms(20);左轮逆时针转 P1_0=1；delay_nus(1300);P1_0=0;delay_nms(20);右轮顺时针 前进(全速)P1_1=1;del

13、ay_nus(1300);P1_1=0;delay_nms(20);左轮顺时针转 P1_0=1；delay_nus(1700);P1_0=0;delay_nms(20);右轮逆时针 后退（全速）P1_1=1;delay_nus(1300);P1_1=0;delay_nms(20);左轮顺时针转 P1_0=1；delay_nus(1300);P1_0=0;delay_nms(20);右轮顺时针 双轮左转 P1_1=1;delay_nus(1700);P1_1=0;delay_nms(20);左轮逆时针转 P1_0=1；delay_nus(1700);P1_0=0;delay_nms(20);右轮

14、逆时针 双轮右转 P1_1=1;delay_nus(1500);P1_1=0;delay_nms(20);左轮停止 P1_0=1；delay_nus(1300);P1_0=0;delay_nms(20);右轮顺时针 以左轮为支点左转 P1_1=1;delay_nus(1700);P1_1=0;delay_nms(20);左轮逆时针 P1_0=1；delay_nus(1500);P1_0=0;delay_nms(20);右轮停止 以右轮为支点右转 注意：伺服电机的控制线连接在教学板的单片机上，通过给单片机控制器编程，使单片机的 P1 端口的第一引脚 P1_1 和第二引脚 P1_1 来发出伺服电机

15、的控制信号，控制信号通过控制线来控制左右伺服电机的转动，从而实现机器人以不同的速度及方向运7/10 动。函数控制机器人运行程序：#include#include int main(void)int counter;uart_Init();printf(Program Runningn);for(counter=1;counter=65;counter+)P1_1=1;delay_nus(1700);P1_1=0;P1_0=1;delay_nus(1300);P1_0=0;delay_nms(20);for(counter=1;counter=26;counter+)P1_1=1;delay_n

16、us(1300);P1_1=0;P1_0=1;delay_nus(1300);P1_0=0;delay_nms(20);for(counter=1;counter=26;counter+)P1_1=1;delay_nus(1700);P1_1=0;P1_0=1;delay_nus(1700);P1_0=0;delay_nms(20);for(counter=1;counter=65;counter+)P1_1=1;delay_nus(1300);P1_1=0;P1_0=1;delay_nus(1700);P1_0=0;delay_nms(20);数组控制机器人运行程序：#include#inc

17、lude int main(void)int counter;char Navigation10=F,L,F,F,R,B,L,B,B,Q;int address=0;uart_Init();printf(program Running!n);for(counter=1;counter=65;counter+)P1_1=1;delay_nus(1700);P1_1=0;P1_0=1;delay_nus(1300);P1_0=0;delay_nms(20);for(counter=1;counter=26;counter+)P1_1=1;delay_nus(1300);P1_1=0;P1_0=1;

18、delay_nus(1300);P1_0=0;delay_nms(20);for(counter=1;counter=26;counter+3.3 机器人触觉导航)P1_1=1;delay_nus(1700);P1_1=0;P1_0=1;delay_nus(1700);P1_0=0;delay_nms(20);for(counter=1;counter=65;counter+)P1_1=1;delay_nus(1300);P1_1=0;P1_0=1;delay_nus(1700);P1_0=0;delay_nms(20);while(Navigationaddress!=Q)switch(Na

19、vigationaddress)caseF:Forward();break;caseL:Left_Turn();break;caseR:Right_Turn();break;caseB:Backward();break;address+;8/10 3.3.1 连接触觉导航电路并测试 零件列表：金属丝 2 根、平头 M322 盘头螺钉 2 个、13mm 圆形立柱 2 个、M3 尼龙垫圈2 个、3-pin 公-公接头 2 个、220 欧电阻 2 个、10k 欧电阻 2 个 安装步骤：1.拆掉连接主板到前支架的两颗螺钉；2.螺钉依次穿过尼龙垫圈和圆形立柱；3.把须状金属丝的其中一个勾在尼龙垫圈之上，

20、另一个勾在尼龙垫圈之下，调整位置使他们横向交叉但又不接触；4.拧紧螺钉到支架上。按照图 5 搭建电路：图 5 触须电路原理图 电路原理：由原理图可知，每条胡须都是一个常开开关。连接到每个胡须电路的 I/O引脚监视着 10k 上拉电阻上的电压变化。当胡须没有被触动时，连接胡须的 I/O 管脚的电压是 5V，当胡须被触动，I/O 短接到地，所以 I/O 管脚的电压是 0V。单片机可以读入相应的数据，进行分析、处理、控制机器人运动。在进行胡须测试之前需将串口电缆连接好，需用到调试终端以显示左右胡须状态，调用相关程序进行测试。3.3.2 胡须导航，胡须测试程序：#include#include int

21、 P1_4state(void)return(P1&0 x10)?1:0;int P2_3state(void)return(P2&0 x08)?1:0;int main(void)uart_Init();printf(WHISKER STARTESn);while(1)printf(right;%d,P1_4state();printf(left;%d,P2_3state();delay_nms(150);胡须避障程序：#include#include int P1_4state(void)return(P1&0 x10)?1:0;int P2_3state(void)return(P2&0

22、 x08)?1:0;int main(void)while(1)if(P1_4state()=0)&(P2_3state()=0)Backward();Left_Turn();Left_turn();else if(P1_4state()=0)Backward();Left_Turn();else if(P2_3state()=0)Backward();Right_Turn();else Forward();9/10 两个胡须状态有三种，需分情况讨论，需用到 if 语句。程序中应用的子程序（Ox代表十六进制数）：1.获取 P1_3 的状态,即左胡须 int P1_3state(void)ret

23、urn(P1&0 x08)?1:0;2.获取 P1_2 的状态,即右胡须 int P1_2state(void)return(P2&0 x04)?1:0;3.向前子程序 void Forward(void)4.左转子程序 void Left_Turn(void)5.右转子程序 void Right_Turn(void)6.后退子程序 void Backward(void)7.循迹左转 void Left_Turnsmall(void)8.循迹右转 void Right_Turnsmall(void)9.左拐 180 度 void Left_Turn180(void)10.右拐 180 度 vo

24、id Right_Turn180(void)11.小幅度左拐 void Left_Turn111(void)12.小幅度右拐 void Right_Turn111(void)13.停车 void Stop_car(void)注：子程序中的左右转和后退可以设定一个变量，用来代表循环次数，然后只需在主程序中更改变量的值即可实现左右转角度的改变及后退距离的改变，程序更容易修改。说明：左胡须接引脚 P1_3，右胡须接引脚 P1_2，在机器人的运动过程中，当左右胡须同时触到障碍物时，两个引脚输入全为 0，此时通过调用相应函数 Backward（）；Left_Turn（）；Left_Turn（）；实现后退

25、并转 180 度；当只有左胡须触到障碍物时，P1_4输入为 0，此时调用函数 Backward（）；Right_Turn（）；实现向后并向右转；当只有右胡须触到障碍物时，P2_3 输入为 0，此时调用函数 Backward（）；Left_Turn（）；实现向后并向左转。函数调用的过程中其实是通过连接在单片机引脚上的两个伺服电机控制线，向伺服电机发送不同的脉冲序列，从而实现电机的不同运动。10/10 四、课程总结 本学期智能控制与程序设计课程感觉收获颇多，我们这次课程设计提供了一次理论与实践结合的机会，通过这次课设我们学到的不光是单片机和C 语言编程的应用，还涉及到电路知识及机器人工程等知识，是一次很好的创新性实习，既锻炼了动手能力又培养了创新能力和团队合作精神，对我们将来开发单片机系统或从事机器人研究打下了很好的基础。通过这次实习也让我们学习到了要善于发现问题，遇到问题时，要从不同角度去思考，避免惯性思维。