一种用于管道潜航机器人的鲁棒初始对准方法及系统技术方案

本发明专利技术涉及一种用于管道潜航机器人的鲁棒初始对准方法及系统，包括以下步骤：获取潜航机器人的移动方向；基于潜航机器人的移动方向计算潜航机器人的光流速度并估计出潜航机器人在机体坐标系下的潜航运行速度；基于潜航机器人的光流速度和潜航运行速度计算潜航机器人的初始姿态角；获得实时姿态角信息；将实时姿态角信息反馈到初始姿态角计算中，得到精准初始姿态角信息。本发明专利技术采用鲁棒初始对准方法，结合运动图像、加速度和角速度量以及实时速度信息，获得潜航机器人精准的初始姿态信息，降低管道污水环境对初始对准的影响，实现捷联惯导的动基座精确初始对准。捷联惯导的动基座精确初始对准。捷联惯导的动基座精确初始对准。

【技术实现步骤摘要】
一种用于管道潜航机器人的鲁棒初始对准方法及系统


[0001]本专利技术涉及城市管线自动化检测领域，具体涉及一种用于管道潜航机器人的鲁棒初始对准方法及系统。

技术介绍

[0002]管道作为运输手段，在石油、化工、国防、天然气、排污等多个领域应用广泛，极大方便了人类社区，同时也带来了巨大的经济效益。然而，随着管道服役时间的增加，其内壁会附着大量黏性污物，除此之外，在腐蚀和重压等因素耦合作用下，管道内壁不可避免地出现脱节、破裂、错位、塌陷现象，上述因素不仅影响运输效率，而且带来了安全隐患，甚至产生严重的经济损失。尽管暴雨是天灾，但如果建设了高标准的排水基础设施，并对堵塞的管线进行及时的检查和清理，可将财产的损失降到最低，避免人员伤亡。因此，通过及时有效的方法对管道进行全面的维护和故障排查，提高管道运行的安全性，能够减少国家的经济损失，保障生态环境的稳定，对我国可持续发展战略具有重要意义。
[0003]对于地下管道健康状态检测的工作，由于其环境的特殊性与复杂性，目前业界主要采用装载摄像头的机器人采集管道内的可视化信息，并将视频数据传输至智能检测平台系统，由专业工程师对可视化信息进行检查判读，从而完成管道健康状态的检测。虽然携带摄像头可以帮助判别管道的健康状态，但是无法定位出缺陷在管段的三维位置信息。为了能够获得缺陷在管段的三维位置信息，有学者提出了惯性导航定位方法，捷联惯性导航系统(SINS)是指将陀螺仪和加速度计直接固定在运载体上，利用陀螺仪和加速度计等惯性敏感器件对运行载体三轴角速度和三轴加速度信息进行实时测量，结合运行载体初始惯性信息，通过高速积分获得运动载体的姿态、速度及位置等导航信息。捷联惯性导航系统在工作时不依赖外界信息,也不向外界辐射能量,不易受到干扰破坏,是一种自主式导航系统,具有数据更新率高、数据全面以及短时定位精度高等优点。
[0004]SINS作为一种航位推算导航方法，其性能很大程度上取决于初始姿态角(或初始姿态矩阵)的精度，该初始条件由所谓的初始对准过程确定。通常来说，对准过程包括粗对准和精对准两个阶段。粗对准需在短时间内提供一个大致已知的初始姿态矩阵，随后，在精对准阶段中，使用卡尔曼滤波技术对粗对准阶段计算的初始姿态矩阵进行修正。因此，粗对准作为精对准的前提，高性能的粗对准方法可以有效提高精对准的精度和收敛速度。然而，管道内部空间狭小、水流流速时变，障碍物繁多，潜航器在初始对准的过程中很难长时间保持静止，陀螺仪敏感到的地球自转角速度容易被机体的运动角速度掩盖，传统的解析法初始对准误差太大甚至不可用，采用基于惯性系的初始对准具有更好的抗角晃动干扰的能力。
[0005]然而，采用惯性系初始对准的算法需要得到潜航器的对地速度，传统的视频测速算法有背景差法、帧差法、光流法等。由于背景差分法不能很好地适应场景变化，帧差法不能完整地提取所有相关特征点的状态，得到的不是纯背景图像，检测结果不精确，不利于目标分析与速度检测。而光流法既能支持摄像机运动，同时对多运动目标检测也有较强的区
分能力，能完整地反映运动信息及从背景中检测相关目标。
[0006]虽然采用光流法可以计算潜航器的对地速度，但光流法易受光照、物体遮挡或图像噪声的影响，如若排水管网中水质混浊发黑，测量结果将存在较大误差，从而影响初始对准的精度。

技术实现思路

[0007]本专利技术的目的是提供一种用于管道潜航器机器人的鲁棒初始对准方法及系统，降低管道污水环境对初始对准的影响，提高惯性导航的初始对准精度。
[0008]为实现上述目的，本专利技术提供的技术方案是：
[0009]一种用于管道潜航机器人的鲁棒初始对准方法，包括以下步骤：
[0010]步骤一、获取潜航机器人的移动方向；
[0011]步骤二、基于潜航机器人的移动方向计算潜航机器人的光流速度并估计出潜航机器人在机体坐标系下的潜航运行速度；
[0012]步骤三、基于潜航机器人的潜航运行速度计算潜航机器人的初始姿态角；
[0013]步骤四、获得实时姿态角信息；
[0014]步骤五、将步骤四的实时姿态角信息反馈到步骤三中，得到精准初始姿态角信息。
[0015]为优化上述技术方案，采取的具体措施还包括：
[0016]潜航机器人前方搭载有摄像头，摄像头的镜头一直维持在潜航器的运动方向；潜航机器人设有主控板；潜航机器人搭载内部集成了三轴加速度计和三轴陀螺仪的惯性测量单元IMU，用来测量潜航机器人的加速度和角速度信息；潜航机器人搭载DVL传感器，基于多普勒效应测量潜航机器人的实时速度。
[0017]步骤一中，主控板通过摄像头模组采集外部世界的运动图像数据，结合运动场和光流场的关系，采用运动主方向原理，确定潜航机器人的移动方向。
[0018]步骤二中，分析运动图像在不同时刻的帧数据，基于Harris角点检测算法提取运动图像的角点信息，据此构造运动图像金字塔模型，并利用Lucas
‑
Kanade光流法计算潜航机器人的光流速度，并通过坐标映射的方式估计出潜航机器人在机体坐标系下的潜航运行速度。
[0019]步骤三中，构造惯性导航粗对准方程，在进行数值离散化后，结合获得的潜航运行速度以及惯性测量单元IMU输出的加速度和角速度物理量，利用基于四元数的初始对准QMethod方法计算潜航机器人的初始姿态角。
[0020]步骤四中，结合DVL传感器输出的潜航机器人机体坐标系下的潜航运行速度，推导非线性卡尔曼滤波状态方程和观测方程，利用卡尔曼滤波器估计实时姿态误差和陀螺仪零偏，获得实时姿态角精确信息。
[0021]进一步地，惯性测量单元IMU采用激光捷联惯导系统；三轴陀螺仪和三轴加速度计的零偏稳定性分别为0.01
°
/h和10
‑5g，以满足管道实时定位的要求；DVL传感器采用A50声学多普勒计程仪。
[0022]本专利技术还保护一种用于管道潜航机器人的鲁棒初始对准系统，包括：
[0023]移动方向获取模块，用于获取潜航机器人的移动方向；
[0024]速度计算模块，用于基于潜航机器人的移动方向计算潜航机器人的光流速度并估
计出潜航机器人在机体坐标系下的潜航运行速度；
[0025]初始姿态角计算模块，用于基于潜航机器人的潜航运行速度计算潜航机器人的初始姿态角计算模块，用于；
[0026]精准初始姿态角获取模块，用于获得实时姿态角信息，将实时姿态角信息反馈到初始姿态角计算模块，返回到初始姿态角计算模块执行的操作中，计算得到精准初始姿态角信息；
[0027]本专利技术还保护一种电子设备，包括：存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，所述处理器执行计算机程序时，实现上述的用于管道潜航机器人的鲁棒初始对准方法。
[0028]本专利技术还保护一种计算机可读存储介质，存储有计算机程序，所述计算机程序使计算机执行上述的用于管道潜航机器人的鲁棒初始对准方法。
[0029]与现有技术相比，本专利技术的有益效果本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种用于管道潜航机器人的鲁棒初始对准方法，其特征在于：包括以下步骤：步骤一、获取潜航机器人的移动方向；步骤二、基于潜航机器人的移动方向计算潜航机器人的光流速度并估计出潜航机器人在机体坐标系下的潜航运行速度；步骤三、基于潜航机器人的潜航运行速度计算潜航机器人的初始姿态角；步骤四、获得实时姿态角信息；步骤五、将步骤四的实时姿态角信息反馈到步骤三中，得到精准初始姿态角信息。2.根据权利要求1所述的用于管道潜航机器人的鲁棒初始对准方法，其特征在于：潜航机器人前方搭载有摄像头，摄像头的镜头一直维持在潜航器的运动方向；潜航机器人设有主控板；潜航机器人搭载内部集成了三轴加速度计和三轴陀螺仪的惯性测量单元IMU，用来测量潜航机器人的加速度和角速度信息；潜航机器人搭载DVL传感器，基于多普勒效应测量潜航机器人的实时速度。3.根据权利要求2所述的用于管道潜航机器人的鲁棒初始对准方法，其特征在于：步骤一中，主控板通过摄像头模组采集外部世界的运动图像数据，结合运动场和光流场的关系，采用运动主方向原理，确定潜航机器人的移动方向。4.根据权利要求3所述的用于管道潜航机器人的鲁棒初始对准方法，其特征在于：步骤二中，分析运动图像在不同时刻的帧数据，基于Harris角点检测算法提取运动图像的角点信息，据此构造运动图像金字塔模型，并利用Lucas
‑
Kanade光流法计算潜航机器人的光流速度，并通过坐标映射的方式估计出潜航机器人在机体坐标系下的潜航运行速度。5.根据权利要求2所述的用于管道潜航机器人的鲁棒初始对准方法，其特征在于：步骤三中，构造惯性导航粗对准方程，在进行数值离散化后，结合获得的潜航运行速度以及惯性测量单元IMU输出的加速度和角速度物理量，利用基...

【专利技术属性】
技术研发人员：陈宇鸣，倪洋，章俊，
申请(专利权)人：南京安透可智能系统有限公司，
类型：发明
国别省市：