一种基于无线传感网络的移动机器人控制系统的制作方法
【技术领域】
[0001] 本发明涉及无线传感领域，尤其是一种基于无线传感网络的移动机器人控制系 统。
【背景技术】
[0002] 随着社会经济、科学技术的发展，机器人的工作不再局限于单个机器人的控制，通 过多个机器人之间的协同作业，可完成更为复杂的、具有关联性的工作。无线传感网络由部 属在工作区域内的多个传感节点组成，通过无线通信方式形成的一个多跳的、自组织的网 络系统，十分适用于多个移动机器人的无线控制系统，可有效降低系统成本，提高系统可扩 展性。
[0003] 在机器人定位方面，虽然GPS、激光雷达、图像匹配、里程计等定位手段在某些场合 可以完成定位任务，但在成本、精度、使用便捷性方面还存在诸多不足。
【发明内容】
[0004] 为解决【背景技术】的不足，本发明的目的是提供一种基于无线传感网络的移动机器 人控制系统。
[0005] 为实现上述目的，本发明所采用的技术方案是：一种基于无线传感网络的移动机 器人控制系统，包括系统基站、信标节点和移动机器人，移动机器人包括电源模块、控制模 块、无线通信模块、感知模块和运动模块，其中，电源模块，用于为各个模块供电；无线通信 模块，用于移动机器人与系统基站、移动机器人与信标节点、移动机器人与移动机器人之间 的无线数据传输；感知模块，包括若干传感器，用于采集信息，并传送到控制模块；控制模 块，用于信息处理，并将输出的结果传送到运动模块；运动模块，用于执行控制模块输出的 结果。
[0006] 优选的是，所述控制模块包括主控电路和驱动电路，其中，主控电路用于实现信息 处理，驱动电路用于输出结果以驱动运动模块。
[0007] 优选的是，所述运动模块包括电机和车轮，驱动电路通过驱动电机来带动车轮运 转。
[0008] 优选的是，所述信标节点均匀分布在系统基站四周。
[0009] 优选的是，所述信标节点采用4个。
[0010] 一种基于无线传感网络的移动机器人控制系统的方法，包括
[0011] 1)根据信标节点架构无线传感网络中信息的位置坐标；
[0012] 2)在控制模块中预设距离阈值；
[0013] 3)移动机器人通过感知模块完成工作任务；
[0014] 4)控制模块将移动机器人自身到系统基站的距离与预设的距离阈值进行比较判 断；
[0015] 5)根据判断结果，若距离系统基站距离小于或等于该阈值，则该移动机器人将任 务数据直接传输到系统基站；若距离系统基站距离大于所设距离阈值，则移动机器人在距 离系统基站距离小于所设阈值的移动机器人中选择一个作为最优节点Node。作为其下一跳 节点，任务数据通过该最优节点传输到系统基站。
[0016] 优选的是，最优节点的选取方式是：
[0018] 其中：山是移动机器人到下一跳节点的距离，d j是下一跳节点到系统基站的距离。
[0019] 优选的是，还包括步骤，移动机器人根据信标节点位置定位自身位置。
[0020] 优选的是，还包括步骤，通过信标节点接收移动机器人反馈的信号的强弱来定位 移动机器人的位置。
[0021] 本发明采用上述结构后，
[0022] 1)移动机器人作为无线传感网络中的移动节点，可以实现监测节点动态，并实现 自定义部署来随意扩展无线传感网络的监测范围，同时也是现场任务的执行者，可采集现 场数据或执行控制任务；
[0023] 2)系统基站用于对系统中所有移动机器人进行管理协调、收集和发布控制信息；
[0024] 3)信标节点用于传感网络的定位，同时用于对移动机器人进行定位；
[0025] 4)本系统通过多个移动机器人组成无线传感网络，各移动机器人之间协同作业完 成具体任务，从而使无线传感网络变成一种具有主动监测功能的工具，针对无线传感网络 的特点，所采用的定位算法和信息收集算法均具有较高的能效性，本系统具有良好的可扩 展性、通用性，市场应用前景广阔；
[0026] 5)选取最优节点，并通过该最优节点把数据转发到系统基站（即2跳方式），从而 完成数据上传过程，该算法复杂度低，且可有效降低系统能耗。
【附图说明】
[0027] 图1为本发明的系统示意图。
[0028] 图2为本发明移动机器人的结构框图。
【具体实施方式】
[0029] 下面结合附图和【具体实施方式】对本发明作进一步详细说明：
[0030] 如图1所示，一种基于无线传感网络的移动机器人控制系统，包括软件部分和硬 件部分；其中软件部分包括移动机器人定位算法和信息收集算法，所述定位算法采用信标 节点来实现，所述信息收集算法采用距离阈值的判断来实现；硬件部分包括移动机器人、系 统基站和信标节点。
[0031] 如图2所示，一种基于无线传感网络的移动机器人控制系统，包括系统基站、信标 节点和移动机器人，移动机器人包括电源模块、控制模块、无线通信模块、感知模块和运动 模块，其中，电源模块，用于为各个模块供电；无线通信模块，用于移动机器人与系统基站、 移动机器人与信标节点、移动机器人与移动机器人之间的无线数据传输；感知模块，包括若 干传感器，用于采集信息，并传送到控制模块；控制模块，用于信息处理，并将输出的结果传 送到运动模块；运动模块，用于执行控制模块输出的结果。
[0032] 所述控制模块包括主控电路和驱动电路，其中，主控电路用于实现信息处理，驱动 电路用于输出结果以驱动运动模块。
[0033] 所述运动模块包括电机和车轮，驱动电路通过驱动电机来带动车轮运转。
[0034] 所述信标节点采用4个，并均匀分布在系统基站四周，系统基站在中心，信标节点 为4个，成一个正方形分布式四周，当然可以更多，相对的，越多成本越高，理论上来说3个 以上就能实现定位，但设置4个，是为了在正方形监测区域内较均匀地分布。
[0035] 一种基于无线传感网络的移动机器人控制系统的方法，包括
[0036] 1)根据信标节点架构无线传感网络中信息的位置坐标；
[0037] 2)在控制模块中预设距离阈值；
[0038] 3)移动机器人通过感知模块完成工作任务；
[0039] 4)控制模块将移动机器人自身到系统基站的距离与