一种用于轨道式巡检机器人的防碰撞控制方法及系统与流程
本发明涉及轨道式巡检机器人控制,具体涉及一种用于轨道式巡检机器人的防碰撞控制方法及系统。
背景技术:
1、燃气-蒸汽联合循环机组的余热锅炉炉顶布置有沿固定轨道运行的巡检机器人,用于对炉顶设备进行周期性巡视。炉顶通行空间受结构布局约束,轨道周边存在固定构件,检修作业期间还可能有临时物体进入轨道通行范围。巡检机器人在运行过程中需要及时识别前方障碍并可靠停车,以避免与障碍物发生碰撞。
2、现有防碰撞控制通常以测距装置输出的障碍距离与预设阈值的比较结果触发停车。这种方式未考虑测距采样时刻与控制指令生成时刻之间机器人的位置变化,障碍位置与机器人状态在时间基准上不一致;测距回波来源未与机器人实际通行范围关联,轨道周边固定构件的回波容易被作为通行障碍处理;制动距离按固定制动参数计算,未反映机器人在不同轨道区段的实际减速状态。上述因素使停车位置难以与障碍占用边界相适应,或者引起不必要的停车,或者在制动能力不足时无法在障碍前停稳。
技术实现思路
1、本发明的目的是提供一种用于轨道式巡检机器人的防碰撞控制方法及系统,以解决上述背景技术中的问题。
2、为了实现上述目的,本发明提供如下技术方案:
3、第一方面,本发明提供一种用于轨道式巡检机器人的防碰撞控制方法,包括:
4、对障碍测距时序和包含驱动反馈的轨道运动时序进行时基配准,得到同一控制周期下的障碍轨道坐标序列和含运行方向的机器人轨道状态;
5、将障碍轨道坐标序列与机器人运行包络进行沿轨匹配,形成沿轨有效障碍信息;
6、由所述驱动反馈中的速度衰减过程生成当前制动约束;
7、使沿轨有效障碍信息与当前制动约束共同约束停车位置,生成沿轨停车边界,沿轨停车边界包括减速触发位置、停车触发位置和停车保持位置;
8、将沿轨停车边界转换为速度-距离控制曲线,并按速度-距离控制曲线控制轨道式巡检机器人减速至停车保持位置;在沿轨有效障碍信息表征的障碍物脱离机器人运行包络后解除停车保持。
9、在一种可能的实施方式中,所述障碍测距时序包含当前运行方向上的测距结果及对应测距采样时刻,所述轨道运动时序包含轨道里程、轨道速度、运行方向及对应驱动反馈时刻,所述机器人轨道状态包含同一控制周期下的轨道里程、轨道速度和运行方向。
10、在一种可能的实施方式中,所述对障碍测距时序和包含驱动反馈的轨道运动时序进行时基配准,得到同一控制周期下的障碍轨道坐标序列和含运行方向的机器人轨道状态,包括:取当前控制周期的指令生成时刻为对齐时刻,分别计算测距采样时刻和驱动反馈时刻相对于对齐时刻的采样时差;在轨道运动时序中截取覆盖采样时差的反馈速度段,并由反馈速度段外推沿轨补偿位移;将测距结果对应的沿轨距离和沿轨补偿位移按运行方向叠加至对齐时刻的轨道里程,并保留对齐时刻的轨道速度和运行方向,得到同一控制周期下的障碍轨道坐标序列和含运行方向的机器人轨道状态。
11、在一种可能的实施方式中,所述由反馈速度段外推沿轨补偿位移,包括:在反馈速度段内选取靠近测距采样时刻的相邻驱动反馈点,并由相邻驱动反馈点的轨道速度差和驱动反馈时刻差计算轨道加速度;依据测距采样时刻对应的轨道速度、轨道加速度、采样时差和运行方向符号,对测距采样时刻至对齐时刻之间的位移进行外推,得到沿轨补偿位移。
12、在一种可能的实施方式中,所述机器人运行包络由轨道式巡检机器人的车体限界沿轨道中心线扫掠形成,所述机器人运行包络包括沿轨前缘和侧向边界,所述侧向边界由轨道通行净空确定。
13、在一种可能的实施方式中,所述将障碍轨道坐标序列与机器人运行包络进行沿轨匹配,形成沿轨有效障碍信息,包括:以机器人轨道状态中的轨道里程和运行方向确定机器人运行包络在当前控制周期的轨道截面,并将障碍轨道坐标序列映射至轨道截面;删除位于机器人运行包络外或者未处于当前运行方向前方的障碍轨道坐标,并按测距采样时刻连接剩余障碍轨道坐标,形成候选障碍轨迹;依据采样间隔以及预设的障碍物允许移动速度和测距容差确定可达沿轨位移,剔除候选障碍轨迹中相邻沿轨位移超出可达沿轨位移的孤立障碍轨道坐标,并提取当前运行方向上的占用前缘,形成沿轨有效障碍信息。
14、在一种可能的实施方式中,所述当前制动约束由可用制动减速度、制动响应时间和制动响应位移构成,所述速度衰减过程为制动指令下发后、自轨道速度开始下降的时刻起至轨道速度下降到停车保持状态止的反馈速度段。
15、在一种可能的实施方式中,所述由所述驱动反馈中的速度衰减过程生成当前制动约束,包括:按照同一控制周期下的轨道里程确定当前轨道区段,并在驱动反馈中截取制动起始里程处于当前轨道区段且速度方向与当前运行方向一致的速度衰减过程;对速度衰减过程的轨道速度进行积分得到制动速度积分距离,并由起点速度、终点速度和制动速度积分距离反算可用制动减速度;根据制动指令下发时刻和速度衰减过程起点时刻确定制动响应时间,并由机器人轨道状态中的轨道速度和制动响应时间确定制动响应位移,生成当前制动约束;其中,制动速度积分距离和可用制动减速度按照以下关系确定:
16、
17、
18、式中,为制动速度积分距离,为速度衰减过程起点时刻,为速度衰减过程终点时刻,为轨道速度关于驱动反馈时刻的函数,为可用制动减速度,为起点速度,为终点速度。
19、在一种可能的实施方式中,所述使沿轨有效障碍信息与当前制动约束共同约束停车位置,生成沿轨停车边界,包括:从沿轨有效障碍信息中提取当前运行方向上的占用前缘,并依据占用前缘在相邻两次更新之间的沿轨位移和更新时间间隔求取沿轨接近速度;由机器人轨道状态中的当前轨道速度和当前制动约束中的可用制动减速度计算制动距离和制动时间,并由沿轨接近速度与制动响应时间和制动时间之和确定接近补偿距离;沿当前运行方向的反向,将机器人运行包络在当前运行方向上的前缘长度和接近补偿距离叠加至占用前缘得到停车保持位置,并由停车保持位置依次回退制动距离和制动响应位移,生成沿轨停车边界;其中,沿轨停车边界按照以下关系确定:
20、
21、式中,为停车保持位置,为占用前缘,为运行方向符号,为机器人运行包络在当前运行方向上的前缘长度,为接近补偿距离,为停车触发位置,为制动距离,为减速触发位置,为制动响应位移。
22、第二方面,本发明提供一种用于轨道式巡检机器人的防碰撞控制系统,用于执行第一方面所述的方法,包括:时基配准模块,用于对障碍测距时序和包含驱动反馈的轨道运动时序进行时基配准,得到同一控制周期下的障碍轨道坐标序列和含运行方向的机器人轨道状态;包络匹配模块,用于将障碍轨道坐标序列与机器人运行包络进行沿轨匹配,形成沿轨有效障碍信息;制动约束模块,用于由所述驱动反馈中的速度衰减过程生成当前制动约束;停车边界模块,用于使沿轨有效障碍信息与当前制动约束共同约束停车位置,生成沿轨停车边界,沿轨停车边界包括减速触发位置、停车触发位置和停车保持位置;速度控制模块,用于将沿轨停车边界转换为速度-距离控制曲线,并按速度-距离控制曲线控制轨道式巡检机器人减速至停车保持位置,以及在沿轨有效障碍信息表征的障碍物脱离机器人运行包络后解除停车保持。
23、与现有技术相比,本发明的技术方案具有如下有益效果:
24、本发明通过对障碍测距时序和包含驱动反馈的轨道运动时序进行时基配准,使障碍物位置与机器人轨道状态对应同一控制周期,消除了测距采样与指令生成之间的时间差对障碍定位的影响;通过将障碍轨道坐标序列与机器人运行包络进行沿轨匹配,排除通行净空外的测距回波和沿轨位置不连续的测距坐标,使停车控制仅响应实际占用通行范围的障碍;通过由驱动反馈中的速度衰减过程生成当前制动约束,使制动距离计算与机器人在当前轨道区段的实际减速状态相符;进而由二者共同约束停车位置,生成包含减速触发位置、停车触发位置和停车保持位置的沿轨停车边界,并按速度-距离控制曲线实施减速与停车保持。机器人由此能够在障碍占用边界前可控停车,减少了因回波误判引起的不必要停车,并在障碍物脱离运行包络后自动恢复运行,提高了炉顶轨道巡检的连续性和安全性。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com