灭火机器人课程设计 (2)

由于电机功率较大，并要求能实现双向、可调速运行，本文设计了半桥式电力MOSFET管，成功实现了对电机的控制。如图6-2所示，2路PWM信号通过IR2104半桥驱动器（half-bridge driver）和相应保护电路连接至型号为IFR2807的MOSFET管，控制电源与电机连接线路的通与断，达到控制电机速度的目的。当PWM信号占空比较大时，线路导通时间较长，电机速度大；相反，当PWM占空比较小时，线路导通时间短，电机速度小。4个MOSFET管在不同时刻导通组合，实现控制电机转动方向：当MOSFET管1和4导通时，电机端口1为正、2为负，电机正转；当MOSFET管2和3导通时，电机端口2为正、1为负，电机反转。
图5-1控制器电源
6
驱动输出部分主要包括机器人行走使用的大功率伺服直流电机、灭火风扇用普通直流电机。
电机的驱动流程如图6-1所示。
PWM信号
方向信号
图6-1电机的驱动流程图
6.1
设计中，机器人要在避免碰撞的前提下尽可能提高速度，因此要求具有更大功率的驱动器和更敏捷的控制方式。为此本设计采用的电机驱动电压为16.8V，直流为20V；采用占空比范围为0-95%的4路PWM信号控制直流电机，以实现精确的调速。
（1）要求设计一个具有火灾预警灭火功能的机器人；
（2）要求设计机器人的行走机构，控制系统、传感器类型的选择及排列布局。
（3）要求机器人具有火灾预警功能，避障功能（不能撞到障碍物上），模拟灭火功能。
1.2.3
自由发挥。
本次设计的题目是灭火机器人，基于ARM9实现机器人在启动后对多个房间进行自主寻找用蜡烛模拟的火源，用伺服电机驱动，到达火源附近后，用风扇将其吹灭，然后停止工作。机器人的整体结构如图2-1所示，主要由控制器、传感输入、驱动输出等模块组成。
2、控制器电源采用8.4V锂电池，并提供电压采样端口，以供电池检测，电路如图5-1所示。
为获得CPU各端口电路所需要的不同等级电压，本设计采用一个LM317T三端稳压器和2个AMS1117低压差线性电压调整器，并通过其附属电路，得到稳定精确的5V、3.3V、1.8V三种电压；采用1个发光二极管LD1和限流电阻R5作为电源指示灯，以显示电源开关的状态；为实时采样电源电压，防止锂电池过放或过充，设计中通过R1和R2分压，引出AD19端口作为电源采样端口。
3通过学习，具体掌握智能机器人的控制技术，并使机器人能独立执行一定的任务。
1.2基本要求
1要求设计一个能灭火的机器人（灭火的环境布局参考国际灭火机器人大赛的环境布局）；
2要求设计机器人的行走机构，控制系统、传感器类型的选择及排列布局。
3要有寻找火源的策略（软件流程图）。
1.3发挥部分
可以增加其它的功能。
沈阳工程学院
课程设计
设计题目：灭火机器人设计
系别自控系班级测控本091
学生姓名庄国庆学号**********
指导教师祝尚臻职称讲师
起止日期：2012年7月9日起——至2012年7月13日止
沈阳工程学院
课程设计任务书
课程设计题目：灭火机器人设计
系别自动控制工程系班级测控本091
学生姓名庄国庆
学号**********
2装订顺序：封面、任务书、成绩评审意见表、中文摘要、关键词、目录、正文（设计题目、设计任务、设计思路、设计框图、各部分电路及相应的详细的功能分析和重要的参数计算、工作过程分析、元器件清单、主要器件介绍）、小结、参考文献、附录（总体设计框图与电路原理图）。
3时间进度安排
顺序
阶段日期
计划完成内容
备注
1
2012.7.9
ａ
图7-3 PSD传感器布置方式
沿墙行进规则：
在软件设计上,利用沿墙行进规则，简捷地编辑主程序实现机器人的沿墙壁行进。因为机器人在系统结构设计上满足双向行进，前后两侧均可探测并熄灭火源，故可分解为前方沿左、右墙，以及后方沿左、右墙行进规则。该规则要求机器人能够沿某墙壁快速无碰撞行进，在墙壁转折处或无墙壁时，智能机器人可以自动沿着某墙壁转弯进行。以沿右墙新进为例，如图7-4所示。
1
1.1
火灾预警机器人设计。
1.2
1.2.1
（1）了解机器人技术的基本知识以及有关电工电子学、单片机、机械设计、传感器等相关技术。
（2）初步掌握机器人的运动学原理、基于智能机器人的控制理论，并应用于所设计的机器人中。
（3）通过学习，具体掌握机器人的控制技术，并使机器人能独立执行一定的任务。
1.2.2
评价
内容
具体要求
权重
评分
加权分
查阅
文献
查阅文献有一定广泛性；有综合归纳资料的能力
0.2
5
4
3
2
工作量
工作量饱满，难度适中。
0.5
5
4
3
2
说明书的质量
说明书立论正确，论述充分，结论严谨合理，文字通顺，技术用语准确，符号统一，编号齐全，图表完备，书写工整规范。
0.3
5
4
3
2
评阅教师评审成绩
（加权分合计乘以8）
指导教师祝尚臻职称讲师
课程设计进行地点：F430
任务下达时间：2012年7月9日
起止日期：2012年7月9日起——至2012年7月13日止
教研室主任年月日批准
灭火机器人设计
1设计主要内容及要求
1.1设计目的：
1了解机器人技术的基本知识以及有关电工电子学、单片机、机械设计、传感器等相关技术。
2初步掌握机器人的运动学原理、基于智能机器人的控制理论，并应用于实践。
（4）额定转速：额定转速是指电机在额定电压、额定电流和输出额定功率的情况下运行时，电机的旋转速度，单位为rpm(转/分)。
7
7.1
红外测距传感器是机器人的视觉器官，通过不断读取其数值并进行判断，才能够确定机器人所处位置环境，以确定机器人下一步该执行什么命令不至于碰撞，并按照规定的理想路线行走。课设中采用SHARP公司的GP2D12PSD传感器（后面简称PSD），其有效测距范围为10CM-80CM。其原理图如7-1图所示。
图4-1 ARM微处理器与辅助单片机
5
电源是保证机器人稳定、可靠运行的关键部件，它直接影响着机器人的性能的好坏。由于本机器人的电机驱动和控制器采用两种不同等级电压的电源，为避免2个电源互相干扰，本机器人采用双电源供电系统：
1、电机电源采用高放电倍率聚合物锂电池，容量为2500MAH，工作电压为24V，能够提供40A的稳定供电电流，是普通电池的10倍。
直流电动机的结构如图6-4所示：
图6-4直流电机结构图
PWM脉冲宽度调制如图6-5所示：
图6-5 PWM脉冲宽度调制
直流电机的机械特性如图6-6所示：
图6-6直流电机的机械特性
（1）额定功率：是指轴上输出的机械功率，单位为kW。
（2）额定电压：安全工作的最大外加电压或输出电压，单位为V(伏)。
（3）额定电流：允许流过的最大电流，单位为A(安)。
0.2
5
4
3
2
工作量
按期圆满完成规定的设计任务，工作量饱满，难度适宜。
0.2
5
4
3
2
说明书的质量
说明书立论正确，论述充分，结论严谨合理，文字通顺，技术用语准确，符号统一，编号齐全，图表完备，书写工整规范。
0.5
5
4
3
2
指导教师评审成绩
（加权分合计乘以12）
分
加权分合计
指导教师签名：
年月日
评阅教师评审意见
图6-2伺服电机驱动电路
6.2
机器人采用风扇灭火，前后两端各有一个直流电机带动，直流电机由主板上的D0扩展端口驱动。
6.3
6.3.1 H
所谓H桥驱动电路是为了直流电机而设计的一种常见电路，它主要实现直流电机的正反向驱动，其典型电路形式如图6-3所示。
Us
K1 K2
K3 K4
图6-3 H桥驱动电路
开关K1、K4接通，电机为正向转动。
比赛用灭火机器人需要机器人有智能较高的自动控制性能与可靠的机械控制性能的同时保证，才能在短时间内准确寻找到火源并灭火回家。在此以ARM9处理器为核心，对基于嵌入式系统的智能灭火机器人进行了设计。本文将从硬件和软件方面讲述智能灭火机器人控制器的实现方法，并且给出了机器人灭火的具体实验，验证了方案的可行性，为智能灭火机器人的进一步研究提供了平台。
开关K2、K3接通，电机为反向转动。
刹车——将K2、K4开关（或K1、K3）接通，则电机惯性转动产生的电势将被短路，形成阻碍运动的反电势，形成“刹车”作用。
惰行—— 4个开关全部断开，则电机惯性所产生的电势将无法形成电路，从而也就不会产生阻碍运动的反电势，电机将惯性转动较长时间。
6.3.2
输出或输入为直流电能的旋转电机，称为直流电机，它是能实现直流电能和机械能互相转换的电机。当它作电动机运行时是直流电动机，将电能转换为机械能；作发电机运行时是直流发电机，将机械能转换为电能。
中心线 发射光 反射光中心线
D透镜
红外发射管f
CCD
XＬ
图7-2 PSD传感器三角测量原理图
本设计采用6个红外测距传感器，其位置如图7-3所示。该传感器的有效测距范围是10-80CM，故PSD安装在距离机器人外围a为10cm的位置来躲避传感器的盲区。6个PSD分别位于机器人的左前、正前、右前、右后、正后及左后位置，其中四角处PSD均可检测机器人2个方位的障碍物情况，左右两侧可不必安装PSD，既经济又可靠，可对机器人周围各方向的障碍物进行测距，以此来调整其前进方向，实现了机器人的全方位避障和导航功能。
沈阳工程学院
机器人技术及其应用课程设计成绩评定表
系（部）：自控系班级：测控本091班学生姓名：庄国庆
指导教师评审意见
评价
内容
具体要求
权重
评分
加权分
调研
论证
能独立查阅文献,收集资料；能制定课程设计方案和日程安排。
0.1
5
4
3
2
工作能力
态度
工作态度认真，遵守纪律，出勤情况是否良好，能够独立完成设计工作，
分
加权分合计
评阅教师签名：
年月日
课程设计总评成绩
分
中
控制器是智能机器人处理和控制信息的主体，它直接决定了机器人的行为和性能。近几年来随着高性能微控制器和嵌入式系统技术的不断进步，为各类实时控制应用提供了解决方案。
嵌入式系统(ES)是计算机技术、通信技术、半导体技术、微电子技术、语音图像数据传输技术，甚至传感器等先进技术和具体应用对象相结合后的系统，其是硬件和软件紧密捆绑在一起的系统。将嵌入式系统应用于灭火机器人的设计中，对机器人的性能智能化、网络化、小型化都有了明显提高。
图7-1红外测距传感器内部电路图
传感器采用三角测量的原理，由红外发光二极管发出红外光束，当红外光束遇到前方的障碍物时，一部分反射回来，通过透镜聚焦到后面的线性电性耦合器件CCD上，会获得一个偏移量L，在知道了发射角度a,偏移量L，中心距X，以及滤镜的焦距f以后，利用三角关系就可以算出传感器到物体的距离D，如7-2图所示
讲解主要设计内容，学生根据任务书做出原始框图
打分
2
2012.7.10
检查框图及初步原理图完成情况，讲解及纠正错误
打分
3
2012.7.11
检查逻辑图并指出错误及纠正；讲解原理图绘制及报告书写
打分
4
2012.7.12
继续修正逻辑图，源自文库导原理图绘制方法，布置答辩
打分
5
2012.7.13
答辩、写报告
打分
2012-7-9
图2-1机器人整体结构
3软件流程图
N
Y
N
Y
N
Y
图3—1主程序方框图
4
为实现机器人高速精确地按照规定的路径行走，要求机器人的CPU能够实现迅速地读取多个传感器端口数值，并在较短的时间内完成对各端口数值的存储、运算和输出等多种任务。由于嵌入式微处理器对实时任务具有较强的支持能力，能够完成多任务并具有较短的中断响应，因此在设计过程中选用嵌入式微处理器ARM9为核心的控制器，其内部采用哈佛结构，每秒可执行一亿一千万条的机器指令。
2设计过程及论文的基本要求：
2.1设计过程的基本要求
1基本部分必须完成，发挥部分可任选；
2符合设计要求的报告一份，其中包括总体设计框图、电路原理图各一份；
3设计过程的资料、草稿要求保留并随设计报告一起上交；报告的电子档需全班统一存盘上交。
2.2课程设计论文的基本要求
1参照毕业设计论文规范打印，包括附录中的图纸。项目齐全、不许涂改，不少于3000字。图纸为A4，所有插图不允许复印。
为提高端口数值的读取速度，使机器人能够对周围环境信息做出迅速判断，笨设计在主芯片上设置了ADC0-ADC7（P4.0-P4.7）8路数据输入端口，每秒可实现50万次数据采集；另外又设置20路数据输入端口，通过AT-MEGA816—PC辅助单片机连接到主芯片上，如图4-1,用以读取远红外传感器组及检测端口的数值，每秒可实现1000次数据采集。本设计还设置了4路PWM控制信号输出端口，用以驱动4路大功率直流电动机，实现对转速的精确调节；此外，还设置了7路D0数据输出端口，用以驱动伺服电机、蜂鸣器、继电器、发光二极管等。为了给庞大和复杂的程序提供更多的执行空间，本设计附加设置了100KB的数据存储器（RAM）和512KM的程序存储器（Flash Rom）,用以存储更多的数据和命令。