管道机器人协同控制方法、装置及管道机器人
本发明涉及机器人控制,尤其涉及一种管道机器人协同控制方法、装置及管道机器人。
背景技术:
1、在油气、化工及工业输送管道检测与维护场景中,管道机器人通常配备全局变径机构和局部压壁机构以适应管径变化和非圆截面。相关技术中,全局变径机构用于补偿管径的整体变化,局部压壁机构用于补偿周向局部差异,但两者往往基于同一压力误差信号进行闭环控制。由于两类执行机构的机械惯量、作用范围和响应带宽存在显著差异,若控制器不能有效区分共同压力趋势与局部偏载,极易导致两类机构对同一误差进行重复补偿,引发机构争调和跨层振荡。此外,管道环境恶劣,压力传感器易发生饱和、断线或漂移等故障,上述控制逻辑常将测量通道的低读数直接等同于真实接触力不足,从而触发持续增压动作,导致执行机构过载甚至损坏。
技术实现思路
1、本发明提供一种管道机器人协同控制方法、装置及管道机器人,以至少解决相关技术中存在的多执行机构重复补偿导致争调振荡以及传感器失效引发误增压的问题。本发明的技术方案如下:
2、根据本发明实施例的第一方面,提供了一种管道机器人协同控制方法,该方法包括:获取管道机器人的多个支撑轮对应的多个测量点的多点接触力数据,并确定各测量点的测量可信度;基于多点接触力数据进行轮内融合与轮间分解,得到共同接触特征和局部接触差异特征;基于共同接触特征执行全局变径控制,以通过调整支撑轮位置改变接触力分布,以及,基于局部接触差异特征执行局部支撑控制,以通过调整单轮接触力改变接触力分布,其中,对局部支撑控制施加不改变共同接触特征的基准的协调约束;响应于测量可信度不满足预设条件,封锁增加接触力方向的控制动作;基于多源状态信息,确定管道机器人的牵引滑移状态,其中多源状态信息包括多个支撑轮的接触状态;基于牵引滑移状态分配管道机器人的多个驱动轮的牵引力。
3、上述方案通过将多点接触力数据分解为共同接触特征和局部接触差异特征,并分别映射至全局变径控制和局部支撑控制,同时对局部支撑控制施加不改变共同接触特征基准的协调约束,从数据层面和控制架构层面实现了整体压力调节与局部压力重分配的解耦,避免了不同时间尺度的执行机构对同一误差信号的重复响应;通过将测量可信度与真实物理接触状态分离,在测量可信度不满足预设条件时直接封锁增加接触力方向的控制动作,从根本上阻断了因传感器故障导致的误判和误增压路径;通过融合包含支撑轮接触状态在内的多源状态信息确定牵引滑移状态,能够在缺乏独立地速传感器的情况下准确感知机器人的附着状态,并据此动态分配牵引力,提升了复杂工况下的运动可靠性。
4、作为一种技术方案,基于多点接触力数据进行轮内融合与轮间分解,得到共同接触特征和局部接触差异特征,包括:基于多点接触力数据,确定多个支撑轮中各支撑轮的轮级总接触力、偏载状态和受力均匀度;基于测量可信度对多个支撑轮的轮级总接触力进行加权,得到共同接触特征;基于轮级总接触力与共同接触特征的偏差,得到局部接触差异特征。
5、该方案通过轮内融合提取出表征单轮整体受力水平的轮级总接触力、表征受力空间分布特性的偏载状态和受力均匀度,保留了丰富的空间接触信息;进而利用测量可信度作为权重因子对轮级总接触力进行加权聚合,使得数据质量高的支撑轮在共同接触特征的计算中占据主导地位,自动抑制了异常通道对全局基准的干扰;最后通过计算轮级总接触力与共同接触特征的偏差获得局部接触差异特征,确保了局部控制仅针对相对于全局基准的差异量进行响应,为后续的解耦控制提供了精确的数据基础。
6、作为一种技术方案,确定各测量点的测量可信度,包括:基于通道健康度、数据新鲜度和跨源合理性指标,确定各测量点的测量可信度,测量可信度与多个支撑轮的真实物理接触状态相分离;响应于测量可信度不满足预设条件,封锁增加接触力方向的控制动作,包括:响应于测量可信度低于预设阈值,禁止执行增加局部支撑力的控制动作以及全局变径控制。
7、该方案明确了测量可信度的评估维度涵盖通道健康度(表征硬件链路完整性)、数据新鲜度(表征通信时效性)和跨源合理性指标(表征多传感器间的一致性),并将其定义为独立于真实物理接触状态的纯数据质量评价指标,这意味着即使机器人处于真实欠压状态,只要传感器数据不可信,系统也不会盲目增压;当测量可信度低于预设阈值时,同时禁止局部支撑力和全局变径控制的增力动作,构建了双重安全防线,有效防止了在传感器失效、通信丢帧或数据异常跳变等故障模式下执行机构因错误反馈而产生的过载风险。
8、作为一种技术方案,基于多源状态信息,确定管道机器人的牵引滑移状态,包括:将多个驱动轮的轮速、多个驱动轮的电流残差、多个支撑轮中与多个驱动轮对应的支撑轮的接触状态以及惯性测量单元信息进行融合;根据融合结果对多轮协同滑移状态进行评估,确定牵引滑移状态。
9、该方案在不引入额外外部速度传感器的前提下,综合利用驱动轮自身的运动学信息(轮速)、动力学信息(电流残差)、环境交互信息(关联支撑轮接触状态)以及本体姿态信息(惯性测量单元信息)进行多维融合,能够区分单轮打滑、多轮协同滑移、悬空及堵转等不同工况;特别是将支撑轮接触状态纳入融合体系,使得滑移评估不仅依赖主动轮自身表现,还能结合被动支撑侧的附着情况进行交叉验证,显著提高了在无绝对速度参考条件下牵引滑移状态评估的鲁棒性和准确性。
10、作为一种实施方式,基于多点接触力数据,确定多个支撑轮中各支撑轮的轮级总接触力、偏载状态和受力均匀度,包括:筛选多点接触力数据中的有效测量点集合;基于有效测量点集合中的接触力值和各测量点的安装角,计算归一化接触力偏心分量,并基于归一化接触力偏心分量确定偏载状态,偏载状态包括偏载程度和偏载方向;基于有效测量点集合中的接触力离散度确定受力均匀度;当有效测量点集合中的有效测量点数量不足或角度覆盖不足时,输出降级估计的轮级总接触力,并将偏载状态和受力均匀度标记为不可判定。
11、该方案通过筛选有效测量点集合剔除了故障或无效数据,保证了后续计算的可靠性;利用接触力值和安装角计算归一化接触力偏心分量,将离散的空间力分布转化为矢量化的偏载程度和偏载方向,为局部压壁机构的定向补偿提供了明确的几何指引;基于接触力离散度量化受力均匀度,直观反映了单轮与管壁的贴合质量;特别设计了降级处理机制,当有效测量点数量或角度覆盖不足以支撑完整状态解算时,主动将偏载状态和受力均匀度标记为不可判定并输出降级估计的轮级总接触力,避免了在数据缺失情况下强行计算导致的虚假偏载信号误导控制系统,体现了算法的安全边界意识。
12、作为一种技术方案,对局部支撑控制施加不改变共同接触特征的基准的协调约束,包括:基于局部接触差异特征生成未协调的局部支撑指令;在基于测量可信度确定的可信支撑轮集合内,以最小化未协调的局部支撑指令与修正后的局部支撑指令之间的偏差为目标,以修正后的局部支撑指令的加权和为零为约束条件,求解修正后的局部支撑指令;其中,约束条件还包含各支撑轮的局部执行器灵敏度、位置上下限约束、速率限制约束以及危险方向门控约束;当可行自由度不足时,按比例缩小局部修正量;其中,全局变径控制、局部支撑控制以及牵引力的分配分别在慢速、中速和快速三个时间尺度下执行,且慢速时间尺度的控制周期大于中速时间尺度的控制周期,中速时间尺度的控制周期大于快速时间尺度的控制周期。
13、该方案通过构建带约束的优化问题求解局部支撑指令,以修正后的局部支撑指令加权和为零作为核心守恒约束,从数学上保证了局部压力的重分配不会改变由全局变径控制负责的共同压力基准,彻底消除了两层控制之间的耦合干扰;同时将执行器灵敏度、物理限位、速率限制及安全门控纳入约束体系,确保生成的指令既满足协调性又符合物理可实现性和安全性;当可行自由度不足时按比例缩小修正量而非破坏守恒约束,维持了系统的稳定性;进一步通过设置慢速、中速、快速三个时间尺度,使大惯量的全局变径、中等响应的局部压壁和快速响应的牵引分配在频域上自然分离,配合协调约束,有效抑制了跨层级的动态干涉和振荡。
14、作为一种技术方案,将多个驱动轮的轮速、多个驱动轮的电流残差、多个支撑轮中与多个驱动轮对应的支撑轮的接触状态以及惯性测量单元信息进行融合;根据融合结果对多轮协同滑移状态进行评估,包括:当异常驱动轮比例达到预设比例阈值、基于多个驱动轮的轮速确定的车速变化率与惯性测量单元轴向加速度的差异超过预设加速度阈值、且电流残差与接触力方向一致的证据持续预设周期数时,升高多轮协同滑移状态的疑似度;基于牵引滑移状态分配管道机器人的多个驱动轮的牵引力,包括:基于牵引滑移状态确定各驱动轮的牵引质量;在单轮转矩、总电流和总功率约束下,基于牵引质量对多个驱动轮进行牵引力权重分配;当牵引质量的总和低于预设有效阈值时,将全部牵引力参考值置零。
15、该方案针对多轮协同滑移这一难以直接观测的状态,设计了基于异常比例、运动学-动力学一致性检验及持续性验证的多重证据链判定逻辑,仅在多重证据同时成立且持续一定周期时才升高疑似度,有效避免了瞬时扰动造成的误判;在牵引力分配环节,将滑移状态转化为量化的牵引质量,并在单轮转矩、总电流和总功率等多重物理约束下进行权重分配,确保了牵引力始终优先分配给附着可靠的驱动轮;当所有驱动轮的牵引质量总和低于预设有效阈值时,判定整机丧失有效牵引能力并将全部牵引力参考值置零,防止了在完全打滑或悬空状态下电机持续空转过热或加剧失控风险。
16、作为一种技术方案,还包括:基于测量可信度确定的可信支撑轮的比例、多个支撑轮的周向覆盖率、通信健康状态和限位健康状态,确定系统级可信度;响应于单个测量点失效,进入第一降级状态,降低对应的支撑轮的测量可信度和增加接触力的速率;响应于单轮的有效测量点不足或单支路的支撑执行器无响应,进入第二降级状态,隔离故障支路并降低关联的驱动轮的牵引力权重;响应于多支路故障或系统级可信度低于预设系统阈值,进入第三降级状态,禁止全局变径控制并限制总牵引力;其中,状态转移优先级依次为紧急停机、安全停机、解卡、第三降级状态、第二降级状态和第一降级状态,紧急停机、安全停机和解卡分别在对应的安全触发条件满足时执行。
17、该方案建立了从单点失效到系统级故障的分级降级机制,通过综合可信支撑轮比例、周向覆盖率、通信及限位健康状态来量化系统级可信度,为全局决策提供依据;针对不同严重程度的故障定义了差异化的处置策略:单点失效时仅降低置信度和调节速率,维持基本功能;单轮或单支路故障时隔离故障单元并联动调整牵引权重,防止局部异常扩散;多支路或系统级可信度不足时禁止高风险的全局变径并限制总牵引力,确保最低限度的安全保持;同时确立了严格的状态转移优先级,确保安全关键动作(如紧急停机、解卡)具有最高响应权限,且各级降级状态之间具有明确的进入与恢复逻辑,避免了故障抖动引起的状态频繁切换,保障了机器人在非理想工况下的行为确定性和安全性。
18、根据本发明实施例的第二方面,提供了一种管道机器人协同控制装置,该装置包括:数据获取模块,用于获取管道机器人的多个支撑轮对应的多个测量点的多点接触力数据,并确定各测量点的测量可信度;特征分解模块,用于基于多点接触力数据进行轮内融合与轮间分解,得到共同接触特征和局部接触差异特征;分层控制模块,用于基于共同接触特征执行全局变径控制,并基于局部接触差异特征执行局部支撑控制,其中,对局部支撑控制施加不改变共同接触特征的基准的协调约束;安全门控模块,用于响应于测量可信度不满足预设条件,封锁增加接触力方向的控制动作;牵引分配模块,用于基于多源状态信息,确定管道机器人的牵引滑移状态,其中多源状态信息包括多个支撑轮的接触状态,并基于牵引滑移状态分配管道机器人的多个驱动轮的牵引力。
19、根据本公开实施例的第三方面,提供一种管道机器人,包括本体、驱动机构、支撑机构、传感器以及控制器,控制器被配置为执行上述第一方面及其任一种可能的技术方案的管道机器人协同控制方法。
20、根据本发明实施例的第四方面,提供了一种计算机可读存储介质,计算机可读存储介质上存储有指令,当计算机可读存储介质中的指令由控制器的处理器执行时,使得控制器能够执行如第一方面及其任一种可能的实现方式的管道机器人协同控制方法。
21、本发明的实施例提供的技术方案至少带来以下有益效果:一方面通过将测量可信度定义为独立于真实物理接触状态的数据质量指标,并在测量可信度不满足预设条件时封锁增加接触力方向的控制动作,建立了压力无效不等于压力偏低的安全门控机制,有效防止了因传感器饱和、断线、漂移或通信异常导致的误判和持续误增压,避免了执行机构过载损坏,显著增强了系统在恶劣管道环境中的故障容忍能力和运行安全性。另一方面,通过轮内融合与轮间共差模分解,将多点接触力数据解耦为共同接触特征和局部接触差异特征,并分别驱动全局变径控制和局部支撑控制,同时对局部支撑控制施加不改变共同接触特征基准的协调约束,从控制架构上消除了大惯量全局机构与小惯量局部机构对同一误差信号的重复响应,避免了机构争调和跨层振荡,提升了系统在变径和非圆截面工况下的动态稳定性。
22、应当理解的是,以上的一般描述和后文的细节描述仅是示例性和解释性的,并不能限制本公开。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com