Fusion fault line selection method of small current grounding fault based on VMD
-
摘要: 针对目前煤矿配电网故障选线方法在相关故障特征不明显时存在故障选线失效,基于单一模态分量和单一故障特征的故障选线方法的选线准确度较低等问题,提出了一种基于变分模态分解(VMD)的小电流接地故障融合选线方法。利用VMD将母线中各出线的故障零序电流分解为多个模态分量,根据模态分量的故障特征确定VMD层数,并选取故障特征明显的模态分量作为故障选线的有效模态分量;分别计算各出线故障零序电流有效模态分量的暂态能量和波形相似度;根据各出线有效模态分量的暂态能量占比和波形相似度占比,构建基于暂态能量的故障选线判据和基于波形相似度的故障选线判据,并将2种故障选线判据融合,形成基于VMD的故障融合选线算法。利用电磁暂态仿真软件ATP/EMTP搭建煤矿配电网模型,在不同接地故障电阻、故障初相角和故障位置的单相接地故障场景下,对所提出的故障融合选线方法进行验证,结果表明:在配电网发生各种单相接地故障时,基于VMD的小电流接地故障融合选线方法不受故障位置的影响,较能量法和相关性聚类法的故障选线正确率分别提高了17%和50%,且不受故障类型影响,可应用于小电流接地故障选线。Abstract: At present, the fault line selection method of coal mine distribution network has the problem of fault line selection failure when the relevant fault features are not obvious. The fault line selection method based on single modal component and single fault feature has low accuracy. In order to solve the above problems, a method of small current grounding fusion fault line selection based on variational mode decomposition (VMD) is proposed. VMD is used to decompose the fault zero-sequence current of each outgoing line in the bus into multiple modal components. The layer number of the VMD is determined according to the fault features of the modal components. The modal components with obvious fault features are selected as effective modal components for fault line selection. The transient energy and the waveform similarity of the effective modal component of the zero sequence current of each outgoing line fault are calculated respectively. According to the proportion of transient energy and the proportion of waveform similarity of effective modal components of each outgoing line, a fault line selection criterion based on transient energy and a fault line selection criterion based on waveform similarity are constructed. The two fault line selection criteria are fused to form a fault fusion line selection algorithm based on VMD. A coal mine distribution network model is built by using the electromagnetic transient simulation software ATP/EMTP. The proposed fusion fault line selection method is verified under single-phase-to-ground fault scenarios with different ground fault resistances, fault initial phase angles and fault locations. The results show that when various single-phase ground faults occur in the distribution network, the fusion line selection method of small-current grounding fault based on VMD is not affected by the fault location. The fault line selection accuracy is respectively improved by 17% and 50% compared with the energy method and the correlation clustering method. The fusion line selection method is not affected by the fault type, and can be applied to the small current grounding fault line selection.
-
0. 引言
煤炭是我国的主要能源和重要战略资源。目前我国煤矿智能化水平较低,井下作业人员仍然较多、安全风险大,加快煤炭企业对煤矿机器人的研发和应用是破解当前安全生产矛盾、实现减人增效的重要途径和现实需求。对于各类煤矿移动机器人,精确定位与地图构建是其推广应用亟待实现的共性关键技术[1]。同步定位与地图构建(Simultaneous Localization and Mapping,SLAM)具有在定位的同时实时重构场景模型的功能,为辅助驾驶、自主导航等提供定位建图功能,近10 a来得到了长足的发展并已逐渐走向工业应用领域。
在煤矿井下SLAM方法方面,国外较早开展了相关研究,但主要采用手持设备[2]、移动小车[3]、探测机器人[4]、矿车[5]搭载激光雷达及惯性测量单元(Inertial Measurement Unit,IMU)等传感器进行环境建模。D.Tardioli等[6]分析了其所在课题组多年来在地下隧道机器人领域开展的相关研究进展,主要探讨了基于激光雷达、视觉相机、里程计等传感器的SLAM方法在隧道环境的应用。美国国防部高级研究计划局(Defense Advanced Research Projects Agency,DARPA)于2018—2021年举办的SubT赛事面向城市地下空间、隧道和天然洞穴环境下的机器人应用,相关研究针对光照变化[7]、场景退化[8]及巷道特征利用[9]等地下场景SLAM中的典型问题提出了新的解决方案。国内方面,马宏伟等[10]提出了基于深度相机进行井下定位建图实现移动机器人自主导航的方案。陈先中等[11]提出了一种煤矿地下毫米波雷达点云成像、结合深度学习处理稀疏点云的SLAM方法构想。杨健健等[12]研究了基于Hector−SLAM的掘进机器人巷道环境感知方法。Li Menggang等[13]提出了一种基于激光雷达的NDT(正态分布变换)−Graph SLAM方法,利用平面约束减轻地图漂移,用于煤矿救援机器人的高效建图任务。高士岗等[14]在国家能源神东煤炭榆家梁煤矿初步应用了搭载Exscan激光扫描仪的巡检机器人,基于SLAM技术构建了动态数字化工作面,三维点云模型实测精度为0.2 m。总体来看,针对煤矿机器人SLAM的研究集中于解决激光雷达、相机、毫米波雷达等传感器在特定场景、特定条件下的初步应用和性能改善问题,对井下多种条件耦合的复杂环境长期定位建模技术仍有待进一步攻关。
在三维激光SLAM研究方面,以迭代最近点(Iterative Closest Point,ICP)为代表的扫描匹配方法研究较早[15]。6D SLAM[16]的前端利用大量原始点云进行ICP配准,后端使用全局松弛化,实现了非实时的高精地图构建。与使用全部点云不同,为了减少计算量、提高算法精度,另一类基于特征的方法被提出。Zhang Ji等[17]提出了一种激光里程计与建图(LiDAR Odometry and Mapping, LOAM)方法,通过计算曲率分割边点和面点,构建点−线和点−面优化问题,是目前诸多激光里程计采用的方法,但由于缺乏回环检测,LOAM方法在长距离应用中仍然有较大的漂移。Shan Tixiao等[18]基于LOAM方法提出LeGO−LOAM(Light Weight and Ground−optimized LOAM)方法,采用了与LOAM方法同样的特征提取方法,通过深度图像分割剔除地面的干扰。J.Weingartent等[19]和A.J.B.Trevor等[20]均提出构建平面特征进行数据关联,后端分别基于扩展卡尔曼滤波(Extended Kalman Filter,EKF)和图优化构建SLAM。此类方法必须要求环境中有大量可提取的平面,形成稀疏平面特征地图。
在激光−惯性融合定位建图方面,目前主要分为松耦合和紧耦合2种方式。松耦合通过构建惯性导航独立进行状态传播,利用激光进行观测更新。紧耦合方法近年来逐渐得到关注。Ye Haoyang等[21]提出了一种雷达惯性里程计与建图(Lidar Inertial Odometry and Mapping,LIO−mapping)方法,使用面特征构建相邻帧之间的点−面约束,同时构建IMU预积分约束,基于因子图联合优化所有帧间观测,在特征较多的大场景条件下难以满足实时运行需求。Shan Tixiao等[22]提出了一种基于平滑建图的雷达惯性里程计(Lidar Inertial Odometry via Smoothing and Mapping,LIO−SAM)方法,前端同样采用LOAM进行特征提取,后端利用因子图框架融合IMU,取得了较好的效果。除了优化方案,滤波方法也被用于激光惯性传感器融合中。Qin Chao 等[23]提出的用于鲁棒和高效导航的雷达惯性状态估计器(Lidar−Inertial State Estimator for Robust and Efficient Navigation,LINS)和Xu Wei等[24]提出的快速雷达惯性里程计(Fast Lidar Inertial Odometry, Fast−LIO)系列方法,基于迭代扩展卡尔曼滤波(Iterative Extended Kalman Filter,IEKF)实现激光和IMU紧耦合,在观测更新时采用了类似优化方法的迭代过程,但没有使用历史数据,在复杂场景中的精度和鲁棒性较差。杨林等[25]提出了激光惯性融合SLAM方法,前端利用IEKF设计了激光惯性里程计,通过构建关键帧在后端采用位姿图优化进行联合优化,降低了系统累计误差。
煤矿井下机器人SLAM是当前研究热点,但针对提高激光SLAM在井下复杂条件下的精度、鲁棒性的研究仍然不足;传统激光SLAM方法在此类环境下存在累计误差迅速增大、旋转过程鲁棒性差、特征关联错误率高等问题;现有激光−惯性融合的定位建图紧耦合融合机制仍需进一步探讨,以期进一步提高激光−惯性融合SLAM方法对煤矿井下复杂环境的适应能力。为此,本文提出了一种煤矿机器人LiDAR/IMU紧耦合SLAM方法(Lidar−Inertial SLAM,LI−SLAM方法)。基于点−线和点−面扫描匹配构建激光相对位姿约束,融合IMU预积分因子约束和回环因子约束,利用因子图优化实现了LiDAR/IMU紧耦合的SLAM。构建了雷达相对位姿因子约束模型,解析推导了雷达相对位姿约束的残差、雅可比和协方差矩阵;基于因子图模型,构建了激光相对位姿约束与IMU预积分约束的紧耦合数据融合机制,提升了对煤矿井下颠簸路面、机器人剧烈旋转等复杂工况的适应能力。该方法可帮助煤矿移动机器人在井下复杂地形与环境工况中实现鲁棒精确的定位建图,为煤矿移动机器人自主导航提供关键技术支撑。
1. LI−SLAM框架
LI−SLAM框架如图1所示。激光约束构建阶段包括5个步骤:① 雷达数据预处理:利用IMU的短时状态估计传播运动状态,校正时段内采集的雷达线扫运动畸变,进行区域滤波等预处理过程。② 特征提取:提取点云中的边和面特征。③ 关键帧与子图构建:提取关键帧并构建局部子图。④ 特征关联:利用特征关联和扫描匹配计算相对位姿变换。⑤ 雷达相对位姿因子构建:基于帧到子图的扫描匹配建立局部雷达相对位姿因子。完成激光约束构建后,执行激光−惯性紧耦合融合机制:与同时段内惯性预积分因子在滑动窗口中进行联合优化,实现状态估计,利用雷达相对位姿因子限制惯导零偏等参数的漂移,实现紧耦合的联合状态估计,同时利用子图关键帧构建全局地图。迭代执行上述过程,可实现在线激光−惯性紧耦合SLAM。
定义惯导坐标系B,雷达坐标系L,激光惯性里程计坐标系O。LI−SLAM的因子图模型如图2所示。待估计的变量
$ {\boldsymbol{x}}_{{B_i}}^O $ 是优化窗口内所有的IMU相对于局部坐标系下的位置p、速度v、姿态q、加速度零偏ba(a为加速度)、角速度零偏bω(ω为角速度)及从惯导到雷达坐标系间的外参${{\boldsymbol{T}}_{\boldsymbol{B}}^{\boldsymbol{L}}} $ 。从i,i+1,…,j时刻所有的待估计变量$ {\boldsymbol{x}}_{{B_i}}^O $ ,$ \;{\boldsymbol{x}}_{{B_{i + 1}}}^O $ ,…,$ {\boldsymbol{x}}_{{B_j}}^O $ 组成的集合为$ \;\chi $ :$$ \chi = \left[ {\begin{array}{*{20}{c}} {{\boldsymbol{x}}{{_{{B_i}}^{O\,{{\rm{T}}}}}}\;\;{\boldsymbol{x}}{{_{{B_{i + 1}}}^{O\,{{\rm{T}}}}}}}& \cdots &{{\boldsymbol{x}}{{_{{B_j}}^{O\,{{\rm{T}}}}}}}&{{\boldsymbol{T}}_B^L} \end{array}} \right] $$ (1) 优化窗中第i时刻对应的状态变量和外参分别表示为
$$ {\boldsymbol{x}}_{{B_i}}^O = {\left[ {\begin{array}{*{20}{c}} {{\boldsymbol{p}}{{_{{B_i}}^{O\,{{\rm{T}}}}}}}&{{\boldsymbol{v}}{{_{{B_i}}^{O\,{{\rm{T}}}}}}}&{{\boldsymbol{q}}{{_{{B_i}}^{O\,{{\rm{T}}}}}}}&{{\boldsymbol{b}}_{{a_i}}^{\rm{T}}}&{{\boldsymbol{b}}_{{g_i}}^{\rm{T}}} \end{array}} \right]^{\rm{T}}} $$ (2) $$ {\boldsymbol{T}}_B^L = {\left[ {\begin{array}{*{20}{c}} {{\boldsymbol{p}}{{_B^{L{{\rm{T}}}}}}}&{{\boldsymbol{q}}{{_B^{L{{\rm{T}}}}}} } \end{array}} \right]^{\rm{T}}} $$ (3) 采用子图进行扫描匹配过程。在局部优化过程中,仅滑动窗口以内的各类因子参与优化过程,窗口外的状态利用边缘化技术固定。基于因子图模型的优化目标函数为
$$ {\boldsymbol{\hat \chi }} = \mathop {\arg \min }\limits_{\boldsymbol{\chi }} \left\{ {{\phi _{{\rm{prior}}}}({\boldsymbol{\chi }}) + {\phi _L}({\boldsymbol{\chi }}) + {\phi _B}({\boldsymbol{\chi }})} \right\} $$ (4) 式中:
$ \;{\boldsymbol{\hat \chi }} $ 为优化求解后观测变量组成的集合;$ {\phi _{{\rm{prior}}}}({\boldsymbol{\chi }}) $ 为先验项约束;$ {\phi _L}({\boldsymbol{\chi }}) $ 为雷达相对位姿约束;$ {\phi _B}({\boldsymbol{\chi }}) $ 为惯性预积分约束。2. 激光约束构建
2.1 雷达数据预处理
点云畸变在机械式激光雷达高速运动问题中是必须解决的问题。现有手段通常基于匀速运动假设,利用线性插值重新部署激光点云的位置。这种方法对于剧烈的非线性运动适应性差。本文使用高频IMU进行状态传播,以恢复每个点的运动。设定第i时刻和第j时刻对应的雷达观测帧为Si和Sj。对第Si帧与第Sj帧之间的IMU观测进行积分,作为激光扫描匹配的初值。相邻采样时刻间认为加速度和角速度未发生变化,加速度、角速度零偏是固定值。IMU加速度观测值为
$ {{\boldsymbol{\hat a}}_t} $ ,角速度为$ {{\boldsymbol{\hat \omega }}_t} $ ,从t(t=i,i+1,…, j)时刻传播的状态包括位置$ {\boldsymbol{p}}_{{B_j}}^O $ 、速度$ {\boldsymbol{v}}_{{B_j}}^O $ 、方向$ {\boldsymbol{q}}_{{B_j}}^O $ 。$$ \left\{ \begin{array}{l} \begin{gathered} {\boldsymbol{p}}_{{B_j}}^O = {\boldsymbol{p}}_{{B_i}}^O + \sum\limits_{t = i}^{j - 1} {\left( {{\boldsymbol{v}}_{{B_t}}^W\Delta t + \frac{1}{2}\left( {{\boldsymbol{R}}_t^W({{{\boldsymbol{\hat a}}}_t} - {{\boldsymbol{b}}_{{{\boldsymbol{a}}_t}}}) - {{\boldsymbol{g}}^O}} \right)\Delta {t^2}} \right)} \\ {\boldsymbol{v}}_{{B_j}}^O = {\boldsymbol{v}}_{{B_i}}^O + \sum\limits_{t = i}^{j - 1} {\left( {{\boldsymbol{R}}_t^O({{{\boldsymbol{\hat a}}}_t} - {{\boldsymbol{b}}_{{{\boldsymbol{a}}_t}}}) - {{\boldsymbol{g}}^O}} \right)} \Delta t \\ {\boldsymbol{q}}_{{B_j}}^O = {\boldsymbol{q}}_{{B_j}}^O \otimes \prod\limits_{t = i}^{j - 1} {\left( {\left[ {\begin{array}{*{20}{c}} {\dfrac{1}{2}({{{\boldsymbol{\hat \omega }}}_t} - {{\boldsymbol{b}}_{{{\boldsymbol{\omega}} _t}}})\Delta t} \\ 1 \end{array}} \right]} \right)} \\ \end{gathered} \end{array} \right. $$ (5) 式中:
${{{\boldsymbol{v}}}}_{{B_t}}^W$ 为t时刻世界坐标系下的速度;$ {{\boldsymbol{g}}^O} $ 为里程计坐标系下的重力加速度;$ {\boldsymbol{R}}_t^W $ 和$ {\boldsymbol{R}}_t^O $ 为t时刻相对于世界坐标系和里程计坐标系的旋转矩阵。利用在线估计获得的IMU与雷达之间的外参变换
${\boldsymbol{T}}_B^L $ ,计算当前雷达的位置和速度。以各点时间戳将观测帧Sj通过线性插值重设位置,统一到Sj末端时刻的基坐标系,完成点云畸变的校正。利用区域滤波提取雷达测距有效范围内的点云参与后续特征提取、关键帧建立与状态估计。2.2 特征提取
采用LOAM[17]的特征提取方法设计点云粗糙度指标作为线特征和面特征的区分方式。设定某个雷达扫描周期K内点云为PK,点云PK中2个点
$ ({P_A},{P_U}) \in {P_K} $ ,在雷达坐标系下的位置坐标可以表示为$ ({\boldsymbol{X}}_{K,A}^L,{\boldsymbol{X}}_{K,U}^L) $ 。s为点云PK中点PA所在的行中的点组成的连续点集,则点PA所在局部曲面的粗糙度为$$ C = \frac{1}{{\left| s \right| \left\| {{\boldsymbol{X}}_{K,A}^L} \right\|}}\left\| {\sum\limits_{U \in s,U \ne A} {({\boldsymbol{X}}_{K,A}^L - {\boldsymbol{X}}_{K,U}^L)} } \right\| $$ (6) 式中A,U为点云中的2个点对应的序号。
根据以下规则提取特征:① 边缘点:取粗糙度C最大的某些个点排序即为曲率较大的边缘点。② 平面点:取粗糙度C最大的某些个点排序即为曲率较小的平面点。③ 为了使点云特征在雷达坐标系下的各个区域分布尽可能均匀,将每个扫描帧等分为若干区域,每个区域提取2个边点和4个平面点。
2.3 关键帧与子图构建
为处理高频激光观测数据,采用关键帧进行特征匹配和雷达约束的构建。预设最小平移距离阈值、最小旋转角度阈值,若达到其中一个条件,则设置当前帧为关键帧。关键帧位姿变化计算公式可以参考文献[13]。
在前端匹配中,采用帧到子图的方式进行扫描匹配,组合固定数量的关键帧形成子图。设关键帧k的边和面特征集合为 Fek和 Fhk(e,h分别表示边和面,下同),n个关键帧组成的特征集合为{
${{{F}}_{k - n}},{{{F}}_{k - n + 1}} \cdots ,{{{F}}_k}$ }$,{{{F}}_k} = {{F}}_{\rm{e}}^k \cup {{F}}_{\rm{h}}^k$ 。利用各关键帧的变换可以将特征转换到局部里程计坐标系O下。转换后,拼接关键帧,组成局部子图$ {{{M}}_k} $ ,其中包含变换到里程计坐标系后的边和面两类特征,${{{M}}_k} = \{ {{M}}_k^{\rm{e }}\cup {{M}}_k^{\rm{h}}\}$ 。采用下采样方法剔除同一个体素栅格中的重复特征,避免冗余的特征匹配。${{M}}_k^{\rm{e}}$ 和${{M}}_k^{\rm{h}}$ 的下采样精度根据环境特点、计算量按照经验设置,此处设为0.1 m和0.2 m,子图内关键帧数量为n=20。2.4 帧到子图的特征关联与扫描匹配
新获得的雷达扫描帧
${{{F}}_{k + 1}} \left( {{{{F}}_{k + 1}} = {{F}}_{k + 1}^{\rm{e}} \cup {{F}}_{k + 1}^{\rm{h}}} \right)$ 是基于雷达坐标系,需要将当前帧特征从雷达坐标系L转换到里程计坐标系O下。利用IMU预测的机器人运动状态${{{\overline {\boldsymbol{T}}}}_{k + 1}}$ ,可以获得转换后的特征集合${{{F}'}_{{{k}} + 1}}$ 。特征关联即寻找特征集合${{{F}'}_{{{k}} + 1}}$ 中边缘特征${{F}}_{k + 1}^{{\rm{e}}'}$ 和面特征${{F}}_{k + 1}^{{\rm{h}}'}$ 在局部子图${{{M}}_k} = \{ {{M}}_k^{\rm{e}} \cup {{M}}_k^{\rm{h}}\}$ 中的关联特征。边缘点和平面点的特征关联方法如图3所示。图3(a)中,对于任意边缘特征I,基于kd-tree寻找${{M}}_k^{\rm{e}}$ 中最近的点A、${{M}}_k^{\rm{e }}$ 中与A最近且与以上2个点不共线的点U,则(A,U)为特征I的关联边特征点。图3(b)中,可以在${{M}}_k^{\rm{h}}$ 中找到与平面特征I最近的A、${{M}}_k^{\rm{h}}$ 中与A最近的2个不共线的点V和U,即为面特征的关联面特征点(A,V,U)。至此,构建点到线的距离
$ {d_{\rm{e}}} $ :$$ {d_{\rm{e}}} = \frac{{\left| {\left( {{\boldsymbol{X}}_{k + 1,I}^{\rm{e}} - {\boldsymbol{X}}_{k,A}^{\rm{e}}} \right) \times \left( {{\boldsymbol{X}}_{k + 1,I}^{\rm{e}} - {\boldsymbol{X}}_{k,U}^{\rm{e}}} \right)} \right|}}{{\left| {{\boldsymbol{X}}_{k,A}^{\rm{e}} - {\boldsymbol{X}}_{k,U}^{\rm{e}}} \right|}} $$ (7) 式中:
${\boldsymbol{X}}_{k + 1,I}^{\rm{e}}$ 为关键帧k+1对应的边特征I的坐标;${\boldsymbol{X}}_{k,A}^{\rm{e}}$ ,${\boldsymbol{X}}_{k,U}^{\rm{e}}$ 为关键帧k对应的面特征A和U的坐标。构建点到面的距离dh:
$$ {d_{\rm{h}}} = \frac{{\left| {\left( {{\boldsymbol{X}}_{k + 1,I}^{\rm{h}} - {\boldsymbol{X}}_{k,A}^{\rm{h}}} \right) \cdot \left( {{\boldsymbol{X}}_{k,A}^{\rm{h}} - {\boldsymbol{X}}_{k,U}^{\rm{h}}} \right) \times \left( {{\boldsymbol{X}}_{k,A}^{\rm{h}} - {\boldsymbol{X}}_{k,V}^{\rm{h}}} \right)} \right|}}{{\left| {\left( {{\boldsymbol{X}}_{k,A}^{\rm{h}} - {\boldsymbol{X}}_{k,U}^{\rm{h}}} \right) \times \left( {{\boldsymbol{X}}_{k,A}^{\rm{h}} - {\boldsymbol{X}}_{k,V}^{\rm{h}}} \right)} \right|}} $$ (8) 式中:
${\boldsymbol{X}}_{k + 1,I}^{\rm{h}}$ 为关键帧k+1对应的面特征I的坐标;${\boldsymbol{X}}_{k,A}^{\rm{h}}$ ,${\boldsymbol{X}}_{k,U}^{\rm{h}}$ ,${\boldsymbol{X}}_{k,V}^{\rm{h}}$ 为关键帧k对应的面特征A,U,V对应的坐标。利用帧与子图中的点到线的距离
$ {d_{\rm{e}}} $ 与点到面的距离dh,可以组成距离矩阵d,基于扫描匹配方法,可以建立以下代价函数$ f\left( {{{{{\overline {\boldsymbol{T}}}}}_{k + 1}}} \right) $ 来求解帧到子图的最优位姿变换关系$ {{{\overline {\boldsymbol{T}}}}_{k + 1}} $ :$$ \left\{ \begin{array}{l} f\left( {{{{{\overline {\boldsymbol{T}}}}}_{k + 1}}} \right) = {\boldsymbol{d}} \\ {\boldsymbol{d}} = \left[ {\begin{array}{*{20}{c}} {{d_{\rm{e}}}} \\ {{d_{\rm{h}}}} \end{array}} \right] \end{array} \right. $$ (9) 利用列文伯格马切尔特(LM)方法可以构建以下优化方程来求解帧间位姿的变换:
$$ \left\{ \begin{array}{l} \min \dfrac{1}{2}\left\| {f({{{{\overline {\boldsymbol{T}}}}}_{k + 1}}) + {\boldsymbol{J}}{{({{{{\overline {\boldsymbol{T}}}}}_{k + 1}})}^{\rm{T}}}\Delta {{{{\overline {\boldsymbol{T}}}}}_{k + 1}}} \right\| \\ {\rm{s.t.}}\;\;{\left\| {{\boldsymbol{D}}\Delta {{{{\overline {\boldsymbol{T}}}}}_{k + 1}} < \mu } \right\|_2} \end{array} \right. $$ (10) 式中:J为雅可比矩阵,
${\boldsymbol{J}} = {{\partial f} \mathord{\left/ {\vphantom {{\partial f} {\partial {{\boldsymbol{T}}_{k + 1}}}}} \right. } {\partial {{\boldsymbol{T}}_{k + 1}}}}$ ;D为系数矩阵;$ \mu $ 为信赖区域半径。迭代推导出最优估计:
$$ {{\boldsymbol{T}}_{k + 1}} \leftarrow {{\boldsymbol{T}}_{k + 1}} - {\left( {{{\boldsymbol{J}}^{\rm{T}}}{\boldsymbol{J}} + \lambda {\rm{diag}}\left( {{{\boldsymbol{J}}^{\rm{T}}}{\boldsymbol{J}}} \right)} \right)^{ - 1}}{{\boldsymbol{J}}^{\rm{T}}}{\boldsymbol{d}} $$ (11) 式中
$ \lambda $ 为阻尼因子。采用以上列文伯格马切尔特优化方法收敛后可以得到当前位姿估计值
${{\boldsymbol{T}}_{k + 1}} = {{{\overline {\boldsymbol{T}}}}_{k + 1}}$ 。位姿Tk和Tk+1之间的相对位姿变换为$$ \Delta {{\boldsymbol{T}}_{k,k + 1}} = {\boldsymbol{T}}_k^{ - 1}{{\boldsymbol{T}}_{k + 1}} $$ (12) 2.5 相对位姿因子构建
利用雷达相对位姿构建关键帧位姿之间的约束关系,在滑窗中联合惯性预积分一起参与优化。相邻位姿间的优化目标项为
$$ {\phi _L}({\boldsymbol{x}}) = \frac{1}{2}\left\| {{r_L}({{\boldsymbol{x}}_i},{{\boldsymbol{x}}_j})} \right\|_{\boldsymbol{\varSigma }}^2 $$ (13) 式中:x为待优化状态变量;rL为相对位姿因子残差;xi和xj分别为i和j时刻对应的运动状态;
${\boldsymbol{ \varSigma }} $ 为约束不确定度的协方差矩阵,${\boldsymbol{ \varSigma }}\in {\boldsymbol{R}}^{6\text{}\times 6} $ ,R为旋转矩阵。由于估计过程是基于IMU坐标系,相对位姿观测需要转换到LiDAR坐标系:
$$ {\boldsymbol{T}}_{{L_j}}^{{L_i}} = {\boldsymbol{T}}_B^L{\boldsymbol{T}}_{{B_i}}^{{O^{ - 1}}}{\boldsymbol{T}}_{{B_j}}^O{\boldsymbol{T}}_B^{{L^{ - 1}}} $$ (14) 式中:
$ {\boldsymbol{T}}_{{L_j}}^{{L_i}} $ 为从j时刻变换到i时刻雷达坐标系下的位姿变换矩阵;$ {\boldsymbol{T}}_{{B_i}}^O $ 和$ {\boldsymbol{T}}_{{B_j}}^O $ 为对应i和j时刻IMU坐标系相对于里程计坐标系的位姿变换矩阵。2.5.1 残差计算
从i时刻关键帧到j时刻关键帧之间的位姿变换的观测和期望之间的残差可以表示为
$$ {{{r}}_L}({{{{\boldsymbol{z}}}}}_{{B_j}}^{{B_i}},{\boldsymbol{\chi }}) = {{\overline {\boldsymbol{T}}}}{_{{L_j}}^{{{L_i}}^{ - 1}}}{\boldsymbol{T}}_B^L{\boldsymbol{T}}{_{{B_i}}^{O^{ - 1}}}{\boldsymbol{T}}_{{B_j}}^O{\boldsymbol{T}}{_B^{L^{ - 1}}} $$ (15) 式中
${{{r}}_L}({\boldsymbol{z}}_{{B_j}}^{{B_i}},{\boldsymbol{\chi }})$ 为雷达坐标系下相对于观测$ {\boldsymbol{z}}_{{B_j}}^{{B_i}} $ 和待估计变量$ {\boldsymbol{\chi }} $ 的残差,$ {\boldsymbol{z}}_{{B_j}}^{{B_i}} $ 为从j时刻到i时刻IMU坐标系下的观测。推导可得相对位姿因子残差的旋转部分
$ {{\boldsymbol{r}}_{\boldsymbol{\theta }}} $ 和平移部分${{\boldsymbol{r}}}_{{\boldsymbol{\xi}} }$ :$$ \left\{ \begin{array}{l} {{\boldsymbol{r}}_{\boldsymbol{\theta }}} = {{\overline {\boldsymbol{R}}}}{_{{L_j}}^{{{L_i}}^{ - 1}}}{\boldsymbol{R}}_B^L{\boldsymbol{R}}{_{{B_i}}^{O^{ - 1}}}{\boldsymbol{R}}_{{B_j}}^O{\boldsymbol{R}}{_B^{L^{ - 1}}} \\ {{\boldsymbol{r}}_{\boldsymbol{\xi}} } = {{\overline {\boldsymbol{R}}}}{_{{L_j}}^{{{L_i}}^{ - 1}}}\left[ {{\boldsymbol{R}}_B^L{{\boldsymbol{R}}_{{{B_i}}}^{O^{ - 1}}}\left( {{\boldsymbol{p}}_{{B_j}}^O - {\boldsymbol{p}}_{{B_i}}^O - {\boldsymbol{R}}_{{B_j}}^O{{\boldsymbol{R}}_{B}^{L^{ - 1}}}{\boldsymbol{p}}_B^L} \right) + {\boldsymbol{p}}_B^L - {\boldsymbol{\bar p}}_{{L_j}}^{{L_i}}} \right] \end{array} \right. $$ (16) 式中:
${{\overline {\boldsymbol{R}}}}_{{L_j}}^{{L_i}}$ 和${{\overline {\boldsymbol{p}}}}_{{L_j}}^{{L_i}}$ 分别为雷达坐标系下从j时刻到i时刻观测的旋转矩阵和平移矩阵;$ {\boldsymbol{R}}_B^L $ ,$ {\boldsymbol{p}}_B^L $ 分别为从IMU坐标系到雷达坐标系的外参的旋转矩阵和平移矩阵;$ {\boldsymbol{R}}_{{B_i}}^O $ ,$ {\boldsymbol{R}}_{{B_j}}^O $ 为i时刻和j时刻对应的IMU相对于里程计坐标系下的旋转矩阵;$ {\boldsymbol{p}}_{{B_j}}^O $ ,$ {\boldsymbol{p}}_{{B_i}}^O $ 为j时刻和i时刻IMU在里程计坐标系下的平移矩阵。2.5.2 雅可比矩阵计算
(1) 向量空间:平移残差向量在向量空间参数块的雅可比矩阵为
$$ \left\{ \begin{array}{l} \begin{gathered} \frac{{\partial {{\boldsymbol{r}}_{\boldsymbol{\xi}} }}}{{\partial {\boldsymbol{p}}_{{B_i}}^o}} = - {{\overline {\boldsymbol{R}}}}{_{{L_j}}^{{{L_i}}^{\rm{T}}}}{\boldsymbol{R}}_B^L{\boldsymbol{R}}{_{{B_i}}^{O^{\rm{T}}}} \\ \frac{{\partial {{\boldsymbol{r}}_{\boldsymbol{\xi}} }}}{{\partial {\boldsymbol{p}}_{{B_j}}^o}} = {{\overline {\boldsymbol{R}}}}{_{{L_j}}^{{{L_i}}^{\rm{T}}}}{\boldsymbol{R}}_B^L{\boldsymbol{R}}{_{{B_j}}^{O^{\rm{T}}}} \\ \frac{{\partial {{\boldsymbol{r}}_{\boldsymbol{\xi}} }}}{{\partial {\boldsymbol{p}}_B^L}} = - {{\overline {\boldsymbol{R}}}}{_{{L_j}}^{{{L_i}}^{\rm{T}}}}{\boldsymbol{R}}_B^L{\boldsymbol{R}}{_{{B_i}}^{O^{\rm{T}}}}{\boldsymbol{R}}_{{B_j}}^O{\boldsymbol{R}}{_B^{L^{\rm{T}}}} + {\boldsymbol{\overline R}}{_{{L_j}}^{{{L_i}}^{\rm{T}}}} \\ \end{gathered} \end{array} \right. $$ (17) (2) 流形空间:平移与旋转残差向量在流形空间参数块的雅可比为
$$ \left\{ \begin{array}{l} \begin{split} & \frac{{\partial {{\boldsymbol{r}}_{\boldsymbol{\xi}} }}}{{\partial \delta {\boldsymbol{\theta }}_{{B_i}}^O}} = {{\overline {\boldsymbol{R}}}}{_{{L_j}}^{{{L_i}}^{\rm{T}}}}{\boldsymbol{R}}_B^L{\left\lfloor {{{\boldsymbol{R}}_{{{B_i}}}^{O^{\rm{T}}}}\left( {{\boldsymbol{p}}_{{B_j}}^O - {\boldsymbol{p}}_{{B_i}}^O - {\boldsymbol{R}}_{{B_j}}^O{{\boldsymbol{R}}_{B}^{L^{\rm{T}}}}{\boldsymbol{p}}_B^L} \right)} \right\rfloor _ \times } \\ & \frac{{\partial {{\boldsymbol{r}}_{\boldsymbol{\xi}} }}}{{\partial \delta {\boldsymbol{\theta }}_{{B_j}}^O}} = {{\overline {\boldsymbol{R}}}}{_{{L_j}}^{{{L_i}}^{\rm{T}}}}{\boldsymbol{R}}_B^L{\boldsymbol{R}}{_{{B_i}}^{O^{\rm{T}}}}{\boldsymbol{R}}_{{B_j}}^O{\left\lfloor {{{\boldsymbol{R}}_{B}^{L^{ - 1}}}{\boldsymbol{p}}_B^L} \right\rfloor _ \times } \\ & \frac{{\partial {{\boldsymbol{r}}_{\boldsymbol{\xi}} }}}{{\partial \delta {\boldsymbol{\theta }}_B^L}} = {{\overline {\boldsymbol{R}}}}{_{{L_j}}^{{{L_i}}^{\rm{T}}}}{\boldsymbol{R}}_B^L\left( {{{\left\lfloor {{{\boldsymbol{R}}_{{{B_i}}}^{O^{\rm{T}}}}{\boldsymbol{R}}_{{B_j}}^O{{\boldsymbol{R}}_{B}^{L^{\rm{T}}}}{\boldsymbol{p}}_B^L} \right\rfloor }_ \times } - {{\boldsymbol{R}}_{{{B_i}}}^{O^{\rm{T}}}}{\boldsymbol{R}}_{{B_j}}^O{{\left\lfloor {{{\boldsymbol{R}}_{B}^{L^{\rm{T}}}}{\boldsymbol{p}}_B^L} \right\rfloor }_ \times }} \right) \\ & \frac{{\partial {{\boldsymbol{r}}_\theta }}}{{\partial \delta {\boldsymbol{\theta }}_{{B_i}}^O}} = {{\overline {\boldsymbol{R}}}}{_{{L_j}}^{{{L_i}}^{\rm{T}}}}{\boldsymbol{R}}_B^L{\left\lfloor {{{\boldsymbol{R}}_{{{B_i}}}^{O^{\rm{T}}}}{\boldsymbol{R}}_{{B_j}}^O{{\boldsymbol{R}}_{B}^{L^{\rm{T}}}}} \right\rfloor _ \times } \\ & \frac{{\partial {{\boldsymbol{r}}_\theta }}}{{\partial \delta {\boldsymbol{\theta }}_{{B_j}}^O}} = - {{\overline {\boldsymbol{R}}}}{_{{L_j}}^{{{L_i}}^{\rm{T}}}}{\boldsymbol{R}}_B^L{\boldsymbol{R}}{_{{B_i}}^{O^{\rm{T}}}}{\boldsymbol{R}}_{{B_j}}^O{\left\lfloor {{{\boldsymbol{R}}_{B}^{L^{\rm{T}}}}} \right\rfloor _ \times } \\ & \frac{{\partial {{\boldsymbol{r}}_\theta }}}{{\partial \delta {\boldsymbol{\theta }}_B^L}} = {{\overline {\boldsymbol{R}}}}{_{{L_j}}^{{{L_i}}^{\rm{T}}}}{\boldsymbol{R}}_B^L\left( {{{\boldsymbol{R}}_{{{B_i}}}^{O^{\rm{T}}}}{\boldsymbol{R}}_{{B_j}}^O{{\left\lfloor {{{\boldsymbol{R}}_{B}^{L^{\rm{T}}}}} \right\rfloor }_ \times } - {{\left\lfloor {{{\boldsymbol{R}}_{{{B_i}}}^{O^{\rm{T}}}}{\boldsymbol{R}}_{{B_j}}^O{{\boldsymbol{R}}_{B}^{L^{\rm{T}}}}} \right\rfloor }_ \times }} \right) \end{split} \end{array} \right. $$ (18) 式中:
$ {\boldsymbol{\theta }}_{{B_i}}^O $ ,$ {\boldsymbol{\theta }}_{{B_j}}^O $ 分别为i时刻和j时刻的旋转矩阵的四元素表示形式;$ {\boldsymbol{\theta }}_B^L $ 为从IMU坐标系到雷达坐标系的外参旋转部分的四元数表示形式。2.5.3 协方差计算
由于前端配准采用了扫描到子图的方法,因此可通过计算所有匹配成功特征点来计算整体扫描匹配的协方差。计算当前扫描帧c的特征点u的坐标
$X_u^c $ 在子图w中对应特征点u的坐标Xuw:$$ {\boldsymbol{X}}_u^w = {\boldsymbol{R}}{_{{L_c}}^{{{L_w}}^{\rm{T}}}}\left( {{\boldsymbol{X}}_u^c - {\boldsymbol{p}}_{{L_c}}^{{L_w}}} \right) $$ (19) 式中
${\boldsymbol{R}}_{{L_c}}^{{L_w}}$ 和${\boldsymbol{p}}_{{L_c}}^{{L_w}}$ 为扫描帧c到子图w计算的相对变换。所有匹配成功的雷达特征计算的协方差矩阵H为
$$ {\boldsymbol{H}} = \left[ {\begin{array}{*{20}{c}} {{{\left\lfloor {{\boldsymbol{X}}_u^c} \right\rfloor }_ \times }}&{ - {\boldsymbol{R}}_{{L_c}}^{{L_w}}} \end{array}} \right] $$ (20) 定义噪声矩阵
$ {\boldsymbol{\varLambda }} $ 为$$ {\boldsymbol{\varLambda }} = \left[ {\begin{array}{*{20}{c}} {2\sigma _x^2}&{}&{} \\ {}&{2\sigma _y^2}&{} \\ {}&{}&{2\sigma _{\textit{z}}^2} \end{array}} \right] $$ (21) 式中
$ {\sigma _x} $ ,$ {\sigma _y} $ ,$ {\sigma _{\textit{z}}} $ 为x,y,z方向的的噪声西格玛值,受到2个点Xuw和Xuc噪声的影响,参考激光雷达的噪声参数,设置噪声典型值为5 cm。协方差矩阵对应的信息矩阵
$ {\boldsymbol{\varOmega }} $ 为$$ {\boldsymbol{\varOmega }} \leftarrow {\boldsymbol{\varOmega }} + {{\boldsymbol{H}}^{\rm{T}}}{{\boldsymbol{\varLambda }}^{ - 1}}{\boldsymbol{H}} $$ (22) 利用式(22)从初始时刻的06×6矩阵开始迭代计算信息矩阵,随着运动距离增加,信息矩阵的不确定度逐渐增长。
3. IMU预积分约束构建
IMU预积分作为一种高频惯性观测数据处理方法,在视觉惯性里程计、激光惯性里程计中逐渐得到应用,其核心思想是将相邻关键帧之间的大量惯性观测进行集成,在关键帧的局部惯性坐标系下开始积分,获得独立的相对运动约束,与其他约束联合优化,实现完整的状态估计。预积分原理如图4所示,横坐标代表时间戳。预积分过程就是将关键帧So、Si和Sj之间的高频IMU观测独立建立为IMU运动约束。本文采用视觉惯性导航系统(Visual Inertial Navigation System,VINS)的预积分方法对IMU进行积分约束,预积分观测方程、残差、雅可比矩阵和协方差矩阵推导参考文献[26]。
4. 回环检测约束构建
回环检测优化对于获得全局一致的地图有很大作用。本文采用文献[13]提出的回环检测方法,通过以下3个步骤实现回环检测与约束构建。
(1) 里程判断:当新的关键帧建立后,首先搜索因子图并找到与新关键帧位姿在欧氏距离上接近的关键帧。小于设定距离阈值的历史关键帧将被作为回环候选关键帧。
(2) 形貌相似度判断:利用ICP扫描匹配方法匹配当前关键帧的点云,与回环候选关键帧前后设定的某些帧构成局部子图。利用最近点对的均方根最小距离计算拟合率,与设定阈值比较来确定是否为真实回环关键帧。
(3) 回环因子构建:利用以上双重判断选择出回环关键帧后,通过式(12)计算相对变换因子,并将相对变换因子添加到全局因子图中。
5. 实验分析
5.1 野外颠簸路面试验
为了验证LI−SLAM方法在颠簸路面和复杂场景的精度与鲁棒性,基于轮式移动机器人试验平台在野外开展了试验。机器人搭载VLP−16 LiDAR,MTi−G710 IMU。轮式移动机器人搭载的运算平台配置为i7−8700k,32G内存。基于轮式移动机器人的试验平台和3个试验场地如图5所示。
5.1.1 精度分析
为了分析LI−SLAM方法的优越性,将其与当前最优的激光算法LOAM方法、LINS方法、LIO−mapping方法进行了对比。几种方法的轨迹对比及其对齐到卫星地图上的结果如图6−图8所示。可看出:在所有试验场地中,LI−SLAM方法和LOAM方法的地图一致性最好,与真实路线基本吻合,LI−SLAM方法对旋转有更佳的适应能力。LIO−mapping方法无法实时运行,在0.5倍速下可以获得完整轨迹,但在初始运动阶段出现了较大程度的方向偏移,初始化过程容易失败。LINS方法由于仅利用了最新的观测信息,在复杂地形下出现了漂移。
不同方法在机器人起点、终点间测量距离与真值的误差见表1,测量距离通过图上的坐标差获得,距离真值可以通过全站仪等测量和计算获得。从表1可看出:LI−SLAM方法在试验场地1、试验场地2中误差最小,在试验场地3中与LOAM方法的误差接近,均明显优于其他方法。
表 1 不同方法起点、终点间距离与真值的误差Table 1. The distance and truth value error between the starting point and the end point of different methods试验场地 行程/m 时间/s 误差/m LIO−mapping×0.5 LINS LOAM LI−SLAM 1 336 854 8.867 − 4.809 0.233 2 197 477 2.788 − 0.9859 0.4 3 963 1433 29.217 − 15.904 17.204 5.1.2 运算速度分析
LI−SLAM方法各个模块耗时的均值和最大值见表2,可看出回环检测模块耗时最长,其次是建图模块。实际应用中,回环检测和地图构建模块本身不需要实时,可以根据环境和需求人为设定。其余模块均满足10 Hz雷达采样频率的实时运行需求。
表 2 野外试验时LI−SLAM方法中各模块耗时均值与最大值Table 2. The average and maximum time consumption of each module of LI-SLAM method in field testsms 模块 耗时均值 耗时最大值 去畸变 1.889 7.466 特征提取 2.658 13.332 回环检测 85.820 915.839 地图构建 49.322 169.238 优化 0.153 156.012 5.1.3 回环检测效果分析
在试验场地1中机器人起始和终止位置发生的回环优化前后的效果如图9所示。图9(a)中回环尚未发生,在位置2的树木和道路出现明显的模糊,图9(b)中回环优化后树木辨别更加清晰,获得了全局一致性的地图,证明了回环检测的有效性。
5.2 地下车库少结构环境试验
为了验证LI−SLAM方法在少结构的井底车场等环境的应用效果,采用自主研发的CUMTV−C煤矿救援机器人平台[27]进行了地下车库的模拟试验,如图10所示,在机器人上方水平和倾斜30°各部署1个16线激光雷达,分别用于定位和构建稠密地图。机器人搭载Xsens MTi−G−710 IMU,用于惯性数据测量。
LI−SLAM方法的建模效果如图11所示,绿色到红色渐变的球形表示机器人的关键帧位姿,球形之间连线为相对位姿约束与回环约束。从图11可看出,LI−SLAM方法具有较好的建模精度,局部精细化程度高。
不同方法的运动轨迹如图12所示,由于地面较为平坦,LINS、LOAM、LI−SLAM方法均获得了平滑的运动轨迹,LIO−Mapping方法在初始化时出现了偏移,表明该方法在缺乏足够运动激励时难以获得鲁棒的状态估计。
不同方法起点、终点间距离的误差见表3,可看出LOAM和LI−SLAM方法的误差最小,证明了紧耦合方法可以提升定位精度。
表 3 不同方法起点、终点间距离的误差Table 3. The distance error between the starting point and the end point of different methods行程/m 时间/s 误差/m LIO−mappinsg LINS LOAM LI−SLAM 168.9 549.7 1.227 0.181 0.070 0.126 LI−SLAM方法各模块耗时均值与最大值见表4,可以看出:去畸变、特征提取、优化模块均可满足10 Hz运行条件,回环检测与地图构建模块无高频运行需求。
表 4 地下车库试验时LI−SLAM方法中各模块耗时均值与最大值Table 4. The average and maximum time consumption of each module in LI-SLAM method in underground garage testsms 模块 耗时均值 耗时最大值 去畸变 2.319 10.885 特征提取 3.380 9.034 回环检测 44.092 359.736 地图构建 28.115 171.516 优化 0.078 79.906 5.3 煤矿井下现场工业性测试
2020年11月2日,在晋能控股山西煤业股份有限公司塔山煤矿开展了煤矿救援机器人工业性验证试验,如图13所示。采用自主研发的CUMTV−C煤矿救援机器人平台进行试验[27],机器人实时运行LI−SLAM方法,通过无线信号传输(带宽大于120 Mbit/s)实时显示构建的地图,用于人员遥控和自主导航。
机器人在行走过程遇到了各类复杂工况,包括大量水汽、斜坡、岔口、颠簸路面等,如图14所示。搭载LI−SLAM方法的煤矿救援机器人在各类地形环境中均可稳定运行,说明LI−SLAM方法满足鲁棒性、实时性需求。
LI−SLAM方法实际运行中的一组建模结果如图15所示。机器人行驶巷道直线距离为273 m,将地图上的距离作为测量值,利用全站仪测量获得人工标志点的定位结果之间的距离作为真值进行对比,分析30组距离结果表明,平均误差小于15 cm,具有较高的定位和建模精度,基本满足煤矿移动机器人的定位建模精度需求。
6. 结论
(1) 提出了一种基于因子图优化框架的LiDAR和IMU紧耦合SLAM(LI−SLAM)方法,基于点−线和点−面扫描匹配构建激光相对位姿约束,融合IMU预积分因子约束和回环因子约束,利用因子图优化实现了LiDAR/IMU紧耦合的SLAM。
(2) 详细分析了激光约束的构建过程,设计了点云去畸变、特征提取、关键帧与子图构建、特征关联策略,解析推导了雷达相对位姿因子的残差、雅可比与协方差矩阵。
(3) 设计了雷达相对位姿因子、惯性预积分因子、回环检测因子的代价函数,构建了激光惯性里程计因子图紧耦合模型,并设计了无约束优化目标函数。
(4) 在野外颠簸路面、地下车库进行了大量测试,在真实煤矿井下现场进行了工业性试验。结果表明:与LOAM方法、LINS方法、LIO−mapping方法相比,LI−SLAM方法在精度、鲁棒性方面表现更佳,对于颠簸、少结构、水汽等复杂煤矿井下环境的移动机器人精确定位与地图构建有更好的适用性,具有较高的定位和建模精度,基本满足煤矿移动机器人的定位与建模精度需求,对井下各类移动机器人的定位建图与自主导航具有较强的指导意义和参考价值。
-
表 1 提取IMF2分量时的故障选线数据
Table 1 Fault line selection data when extracting IMF2 component
Rg /Ω φ /(°) S2 S3 S4 故障
线路Δ22 η22 Δ23 η23 Δ24 η24 0.5 0 0.110 6 0.999 8 0.105 6 0.999 8 0.783 8 −0.999 7 S4 45 0.113 2 1.064 1 0.114 1 1.064 1 0.772 6 −1.128 2 S4 90 0.110 2 1.058 0 0.116 2 1.058 0 0.773 6 −1.115 9 S4 10 0 0.000 5 0.504 4 0.000 5 0.504 4 0.999 0 −0.008 8 S4 45 0.150 2 1.571 6 0.132 3 1.571 6 0.717 5 −2.143 2 S4 90 0.151 3 1.438 5 0.133 9 1.438 5 0.714 8 −1.876 9 S4 1 000 0 0.004 6 0.499 3 0.003 8 0.499 3 0.991 5 0.001 4 S4 45 0.000 5 −1.00 71 0.000 0 0.003 5 0.999 5 0.003 5 S4 90 0.002 4 0.094 3 0.000 2 0.452 8 0.997 4 0.452 8 无 2 000 0 0.004 7 0.498 0 0.003 9 0.498 0 0.991 4 0.004 0 S4 45 0.000 4 −1.002 3 0.000 0 0.001 1 0.999 5 0.001 1 S4 90 0.002 2 0.099 0 0.000 2 0.450 5 0.997 6 0.450 5 无 表 2 提取IMF3分量时的故障选线数据
Table 2 Fault line selection data when extracting IMF3 component
Rg /Ω φ/(°) S2 S3 S4 故障
线路Δ32 η32 Δ33 η33 Δ34 η34 1 000 90 0.147 4 1.222 6 0.104 5 1.222 6 0.748 1 −1.445 2 S4 2 000 90 0.145 8 1.183 7 0.103 7 1.183 7 0.750 5 −1.367 3 S4 表 3 不同故障位置的故障选线数据
Table 3 Fault line selection data at different fault locations
故障位置 S2 S3 S4 故障
线路Δ32 η32 Δ33 η33 Δ34 η34 f1 0.313 9 0.020 7 0.060 6 0.020 7 0.625 4 −1.041 4 S4 f2 0.132 6 1.065 9 0.067 0 1.065 9 0.800 4 −1.131 8 S7 f3 0.143 4 0.998 4 0.067 6 0.998 4 0.789 0 −0.996 9 S10 表 4 不同故障选线方法的选线结果
Table 4 Line selection results of different fault line selection methods
Rg /Ω φ/(°) 能量法 相关性聚类法 融合选线法 故障线路 选线结果 故障线路 选线结果 故障线路 选线结果 0.5 0 S4 正确 S4 正确 S4 正确 45 S4 正确 S4 正确 S4 正确 90 S4 正确 S4 正确 S4 正确 10 0 S4 正确 S4 正确 S4 正确 45 母线 错误 S4 正确 S4 正确 90 母线 错误 S4 正确 S4 正确 1 000 0 S4 正确 母线 错误 S4 正确 45 S4 正确 S2 错误 S4 正确 90 S4 正确 母线 错误 S4 正确 2 000 0 S4 正确 母线 错误 S4 正确 45 S4 正确 S2 错误 S4 正确 90 S4 正确 母线 错误 S4 正确 -
[1] 罗超,耿蒲龙,曲兵妮,等. 基于小波包的矿井供电系统单相接地故障选线方法[J]. 工矿自动化,2018,44(2):68-74. LUO Chao,GENG Pulong,QU Bingni,et al. A line selection method for single phase ground fault in coal mine power supply system based on wavelet packet[J]. Industry and Mine Automation,2018,44(2):68-74.
[2] 高宏杰,赵建文,郭秀才. 煤矿电网单相漏电故障区段自动定位探索[J]. 工矿自动化,2021,47(5):106-111. GAO Hongjie,ZHAO Jianwen,GUO Xiucai. Research on automatic location of single-phase leakage fault zone in coal mine power network[J]. Industry and Mine Automation,2021,47(5):106-111.
[3] 董礼清,薛永端,李娟,等. 小电流接地故障零序电压分布特征与测距[J]. 电力系统自动化,2022,46(19):180-187. DONG Liqing,XUE Yongduan,LI Juan,et al. Zero-sequence voltage distribution characteristics and locatiaon of non-solidly grounding fault[J]. Automation of Electric Power Systems,2022,46(19):180-187.
[4] 刘扬,刘建功,王毅颖,等. 煤矿坚强智能电网建设理论与技术探讨[J]. 煤炭学报,2020,45(6):2296-2307. LIU Yang,LIU Jiangong,WANG Yiying,et al. Discussion on theory and technology of building robust intelligent power grid in coal mine of China[J]. Journal of China Coal Society,2020,45(6):2296-2307.
[5] 程路,陈乔夫. 小电流接地系统单相接地选线技术综述[J]. 电网技术,2009,33(18):219-224. CHENG Lu,CHEN Qiaofu. A survey on faulty line selection technology for single-phase grounded transmission line in small current neutral grounded system[J]. Power System Technology,2009,33(18):219-224.
[6] 周宇,汤涛,曾祥君,等. 基于零序电流幅值比倍增系数的灵活接地系统故障选线方法[J]. 电力系统保护与控制,2022,50(23):112-120. ZHOU Yu,TANG Tao,ZENG Xiangjun,et al. Fault line detection method for a flexible grounding system based on a zero-sequence current amplitude ratio multiplication coefficient[J]. Power System Protection and Control,2022,50(23):112-120.
[7] 方毅,薛永端,宋华茂,等. 谐振接地系统高阻接地故障暂态能量分析与选线[J]. 中国电机工程学报,2018,38(19):5636-5645,5921. FANG Yi,XUE Yongduan,SONG Huamao,et al. Transient energy analysis and faulty feeder identification method of high impedance fault in the resonant grounding system[J]. Proceedings of the CSEE,2018,38(19):5636-5645,5921.
[8] 季鹏,陈芳芳,徐天奇,等. 基于Spearman相关系数法与有功分量法的高阻接地故障选线方法研究[J]. 山东电力技术,2022,49(12):8-13,31. DOI: 10.3969/j.issn.1007-9904.2022.12.002 JI Peng,CHEN Fangfang,XU Tianqi,et al. Research on high-resistance grounding fault line selection method based on Spearman correlation coefficient and active component[J]. Shandong Electric Power,2022,49(12):8-13,31. DOI: 10.3969/j.issn.1007-9904.2022.12.002
[9] 韦明杰,石访,张恒旭,等. 基于同步零序电流谐波群体比相的谐振接地系统高阻故障选线及区段定位方法[J]. 中国电机工程学报,2021,41(24):8358-8372. WEI Mingjie,SHI Fang,ZHANG Hengxu,et al. Feeder selection and section location of high impedance fault at resonant networks based on the phase differences between the synchronous harmonics of the zero sequence currents[J]. Proceedings of the CSEE,2021,41(24):8358-8372.
[10] 樊淑娴,徐丙垠,张清周. 注入方波信号的经消弧线圈接地系统故障选线方法[J]. 电力系统自动化,2012,36(4):91-95. FAN Shuxian,XU Bingyin,ZHANG Qingzhou. A new method for fault line selection in distribution on system with arc suppression coil grounding with square-wave signal injection[J]. Automation of Electric Power Systems,2012,36(4):91-95.
[11] SHI Shenxing,ZHU Beier,LEI Aoyu,et al. Fault location for radial distribution network via topology and reclosure-generating traveling waves[J]. IEEE Transactions on Smart Grid,2019,10(6):6404-6413. DOI: 10.1109/TSG.2019.2904210
[12] 李聪聪,李玉敦,杨超,等. 基于序分量电压加权的双端故障定位算法研究[J]. 山东电力技术,2021,48(7):53-57,69. LI Congcong,LI Yudun,YANG Chao,et al. Research on two-terminal fault location algorithm based on weighted voltage sequence component[J]. Shandong Electric Power,2021,48(7):53-57,69.
[13] 高锋阳,李昭君,袁成,等. 量子计算和免疫优化算法相结合的有源配电网故障定位[J]. 高电压技术,2021,47(2):396-406. GAO Fengyang,LI Zhaojun,YUAN Cheng,et al. Fault location for active distribution network based on quantum computing and immune optimization algorithm[J]. High Voltage Engineering,2021,47(2):396-406.
[14] ZHAGN Chenyu,YUAN Xiaodong,SHI Mingming,et al. Fault location method based on SVM and similarity model matching[J]. Mathematical Problems in Engineering,2020(1):1-9.
[15] 李科,随晓娜,张俊,等. 矿井电网故障选线方法研究[J]. 工矿自动化,2018,44(5):70-75. LI Ke,SUI Xiaona,ZHANG Jun,et al. Research on fault line selection method of mine power network[J]. Industry and Mine Automation,2018,44(5):70-75.
[16] 原磊明,关瑞,石国栋,等. 基于EEMD与小波阈值去噪的单相接地故障选线方法[J]. 煤炭工程,2020,52(12):137-140. YUAN Leiming,GUAN Rui,SHI Guodong,et al. Line selection method for one-phase grounding fault based on EEMD and wavelet threshold denoising[J]. Coal Engineering,2020,52(12):137-140.
[17] 毕胜,耿蒲龙,张建花,等. 基于CEEMD与自相关阈值去噪的单相接地故障选线方法研究[J]. 煤炭工程,2022,54(7):153-158. BI Sheng,GENG Pulong,ZHANG Jianhua,et al. Line selection method for single-phase ground fault based on CEEMD and autocorrelation threshold denoising[J]. Coal Engineering,2022,54(7):153-158.
[18] 翟二杰,舒征宇,汪俊,等. 基于VMD−LSTM的小电流接地系统故障选线方法[J]. 电工电能新技术,2021,40(1):70-80. ZHAI Erjie,SHU Zhengyu,WANG Jun,et al. Fault line selection method of small current grounding system based on VMD-LSTM[J]. Advanced Technology of Electrical Engineering and Energy,2021,40(1):70-80.
[19] 魏科文,张靖,何宇,等. 基于VMD和相关性聚类的谐振接地系统单相接地故障选线[J]. 电力系统保护与控制,2021,49(22):105-113. WEI Kewen,ZHANG Jing,HE Yu,et al. Single-phase grounding fault line selection in a resonant grounding system based on VMD and correlation clustering[J]. Power System Protection and Control,2021,49(22):105-113.
[20] 薛永端,李娟,徐丙垠. 中性点经消弧线圈接地系统小电流接地故障暂态等值电路及暂态分析[J]. 中国电机工程学报,2015,35(22):5703-5714. XUE Yongduan,LI Juan,XU Bingyin. Transient equivalent circuit and transient analysis of single-phase earth fault in arc suppression coil grounded system[J]. Proceedings of the CSEE,2015,35(22):5703-5714.
[21] 庄伟,牟龙华,童荣斌. 基于罗氏线圈二次信号的煤矿高压电网接地故障区段定位[J]. 煤炭学报,2014,39(6):1184-1190. ZHUANG Wei,MU Longhua,TONG Rongbin. Secondary signal of rogowski coil based ground fault section location in coalmine high-voltage distribution network[J]. Journal of China Coal Society,2014,39(6):1184-1190.
-
期刊类型引用(12)
1. 赵亚东,马腾飞,思旺斗,王猛. 煤矿井下移动机器人同步定位关键技术研究. 煤矿机械. 2024(02): 48-51 . 百度学术
2. 司垒,王忠宾,魏东,顾进恒,闫海峰,谭超,朱远胜. 基于IMU-LiDAR紧耦合的煤矿防冲钻孔机器人定位导航方法. 煤炭学报. 2024(04): 2179-2194 . 百度学术
3. 高毅楠,姚顽强,蔺小虎,郑俊良,马柏林,冯玮,高康洲. 煤矿井下多重约束的视觉SLAM关键帧选取方法. 煤炭学报. 2024(S1): 472-482 . 百度学术
4. 刘敬东,李旭,于凤启,苟丙荣,贺国庆,巩泽文. 激光SLAM技术在巷道精细建模的应用研究. 煤矿机械. 2024(10): 199-202 . 百度学术
5. 黄晨烜,常健,王雷. 基于激光雷达的井下带式输送机边缘提取方法. 工矿自动化. 2024(09): 115-123 . 本站查看
6. 胡青松,李敬雯,张元生,李世银,孙彦景. 面向矿井无人驾驶的IMU与激光雷达融合SLAM技术. 工矿自动化. 2024(10): 21-28 . 本站查看
7. 崔邵云,鲍久圣,胡德平,袁晓明,张可琨,阴妍,王茂森,朱晨钟. SLAM技术及其在矿山无人驾驶领域的研究现状与发展趋势. 工矿自动化. 2024(10): 38-52 . 本站查看
8. 马亮,高亮,廉博翔,张琦,蔺小虎,姜之跃. 基于已知点约束的高精度煤矿巷道三维点云建模方法. 工矿自动化. 2024(11): 78-83+151 . 本站查看
9. 夏建超,周亮亮,陈仁. 恶劣环境下钢包脱挂钩状态自动识别技术研究. 重型机械. 2023(04): 62-67 . 百度学术
10. 高海跃,王凯,王保兵,王丹丹. 基于全局点云地图的煤矿井下无人机定位方法. 工矿自动化. 2023(08): 81-87+133 . 本站查看
11. 程健,李昊,马昆,刘斌,孙大智,马永壮,殷罡,王广福,李和平. 矿井视觉计算体系架构与关键技术. 煤炭科学技术. 2023(09): 202-218 . 百度学术
12. 李少安,刘欣,郭长鑫,王博,丁浩然,李晓健. 基于激光雷达自主定位导航的多功能机器人. 无线互联科技. 2023(17): 54-57 . 百度学术
其他类型引用(6)