[发明专利]复杂环境下消防机器人协同定位与自主作业方法

摘要

本发明涉及一种复杂环境下消防机器人协同定位与自主作业方法，包括灭火和侦察机器人群协同定位步骤以及灭火和侦察机器人群协同侦察和灭火步骤，侦察机器人包括第一侦察机器人和第二侦察机器人，机器人操控台包括主操控台和辅操控台，实现了在高低地面起伏的复杂环境中，灭火机器人与侦察机器人协同对灾害现场火源等危险源的全自动识别、定位和灭火机器人自动瞄准、扑救等功能，从而提高灾害现场处置速度，提高危险源处置效率，降低人员和财产损伤。

主权项

1.复杂环境下消防机器人协同定位与自主作业方法，其特征在于，包括灭火和侦察机器人群协同定位步骤以及灭火和侦察机器人群协同侦察和灭火步骤；1)灭火和侦察机器人群协同定位步骤如下：①灭火机器人、侦察机器人、机器人操控台布局完成，机器人操控台中的主操控台内的主通讯模块发送定位指令，灭火机器人中的灭火机器人从通讯模块、侦察机器人中的侦察机器人次通讯模块以及机器人操控台中辅操控台内的辅通讯模块接收到指令后进行解析，并分别控制灭火机器人中的标签天线、侦察机器人中的定位基站和机器人操控台中辅操控台内的辅定位基站进行参数设定并就位；②机器人操控台中的主操控台发射通讯测量指令信号，灭火机器人中的定位标签、侦察机器人中的定位基站和机器人操控台中的辅定位基站进行回应并计算出时间信息，根据时间耗时和电磁波传输速度，获取灭火机器人相对侦察机器人、机器人操控台的距离参数；③机器人操控台中的主操控台将获得的距离信息利用空间几何法确定灭火机器人相对主操控台、辅操控台以及侦察机器人的空间位置信息，继而通过灭火机器人中的灭火机器人姿态传感器和侦察机器人中的侦察机器人姿态传感器获得灭火机器人和侦察机器人相对原始出发位置经过一段时间后的平面(X，Y)位置信息，为后续灭火机器人实施精准灭火提供空间参数基础；2)灭火和侦察机器人群协同侦察和灭火步骤如下：机器人操控台根据上述定位算法实时测定出空间中灭火机器人、侦察机器人和机器人操控台间的三维控制坐标位置，然后发出兴趣目标点侦察指令，侦察机器人对兴趣目标点进行三维空间计算，获得兴趣目标点相对侦察机器人的空间三维位置并返回至机器人操控台；机器人操控台推算出兴趣目标点相对灭火机器人的空间位置关系，计算水炮喷射角度，控制灭火机器人定点喷射灭火。