危险作业机器人控制系统的研究

随着科学技术的发展，移动机器人被寄予越来越高的期望，要求其具有更高的机动性、更强的环境适应及感知能力和快速反应能力。因此，研究高效的移动机构和高性能控制系统成为排爆、消防等各种地面遥操作危险作业移动机器人的共同课题。 本论文以中国科学院沈阳自动化研究所自行研发的“灵豹”反恐防暴机器人和子母消防搜救机器人(在研)为平台，对危险作业机器人的控制系统进行了较为系统的研究。 “灵豹”机器人采用轮-腿-履带复合移动机构。其轮式移动采用三轮机构，两前主动轮单独驱动，差速完成转向，后轮为万向从动脚轮，配合前轮转向，车体转向半径可实现从零到无限大。其控制系统以嵌入式控制器为核心，采用模块化方法设计构建，保证了系统体积紧凑、实时性好和可靠性高等的应用要求。 作为智能控制技术的一种，模糊控制可以对那些数学模型难以求取或无法求取的对象进行有效控制。用基于PC的可编程控制器实现模糊控制，关键在于前期处理和软件编程，因为必须充分考虑执行速度。针对实际的非完整约束三轮式移动机器人运动方向可控性差，PID控制器参数难以实现全局整定的问题，利用模糊控制器实现运动轨迹控制。 单纯用电子罗盘测量航向角作为模糊控制器输入，环境适应性较差，本文提出一种结合脚轮偏转角和罗盘航向角计算机器人角速度和航向角的算法。试验结果表明，设计的控制器能对机器人进行有效航向跟踪，能迅速缩小航向偏差，机器人转向灵活可控，且没有大的航向偏转角速度，提高了系统适应性和运动稳定性。 子母消防搜救机器人主要用于火场侦查搜救，分为子机器人和母机器人，既可单独执行任务，又可协作搜救。机器人体积小，内部空间极其有限，要求控制系统有较高的集成度，还要能耐高温、通讯可靠。火场环境一般比较复杂，尤其是在地下建筑，通讯不畅将严重影响消防搜救机器人深入到火场深处侦查。为充分保障通讯链路畅通，设计了子母机控制系统，母机和子机可互为通讯中继，有效减少通讯死角，扩大搜索范围。系统采用基于多载波调制技术的影音传输系统作为图像及语音信号的主要通信链路，采用数字电台传输指令数据。设计的通讯系统实时性好，抗干扰能力和绕射能力强。