申请日2018.03.09
公开(公告)日2018.09.14
IPC分类号G01N21/954; G01S15/93; G01S17/93
摘要
本发明涉及一种基于污水管线检测机器人的检测方法，给机器人本体连接脐带电缆以及安全绳，打开机器人本体电源，手动将机器人通过窨井投入管道中;通过地面控制系统制定检测任务，生成检测指令，并下发检测任务和检测指令至机器人本体;机器人本体根据检测任务和检测指令，开始工作过程，所述工作过程包括运动过程、数据采集过程以及数据处理过程;本发明的机器人检测之前不需要排干管道内部的水，因此可以在任意时间进行检测，大大提升效率。
权利要求书
1.一种基于污水管线检测机器人的检测方法，其特征在于包括如下步骤：
S1.给机器人本体连接脐带电缆以及安全绳，打开机器人本体电源，手动将机器人通过窨井投入管道中;
S2. 通过地面控制系统制定检测任务，生成检测指令，并下发检测任务和检测指令至机器人本体;
S3. 机器人本体根据检测任务和检测指令，开始工作过程，所述工作过程包括运动过程、数据采集过程以及数据处理过程;
S4. 机器人本体将采集信息和相对位置信息发送到地面控制系统。
2.根据权利要求1所述的一种基于污水管线检测机器人的检测方法，其特征在于：所述运动过程即机器人本体收到检测指令后，根据检测任务计算出终点位置，然后将机器人本体的当前位置与终点位置进行比较，如果还没有到达终点位置，机器人本体沿管线前进，前进过程中根据机器人本体中的定位模块获取机器人本体的姿态和航向角度进行横向定位，调整前进的方向。
3.根据权利要求1所述的一种基于污水管线检测机器人的检测方法，其特征在于所述数据采集过程包括：电缆定位采集、无线基站结合移动站定位采集之任一种。
4.根据权利要求3所述的一种基于污水 管线检测机器人的检测方法，其特征在于：还包括卷缆机、CCD摄像机;所述电缆定位采集即机器人本体使用脐带线缆定位，获取机器人本体相对于投放口的位置数据;脐带线缆从卷缆机牵出，脐带线缆上每隔固定的间距做上标记，卷缆机的出线口位于投放口旁，卷缆机上安装有CCD摄像机，定时采集线缆图像，通过图像识别的方式检查图像中是否包含标记，并计算投放线缆的长度。
5.根据权利要求3所述的一种基于污水管线检测机器人的检测方法，其特征在于：还包括无线基站和移动站;所述无线基站结合移动站定位采集即在检测的起点、终点安装无线基站，在机器人本体上安装移动站，通过测量机器人本体到每一个基站的距离，利用三角定位原理计算出机器人本体在管线中的相对位置。
6.根据权利要求3所述的一种基于污水管线检测机器人的检测方法，其特征在于：还包括惯性传感器，电缆定位采集、无线基站结合移动站定位采集可结合所述惯性传感器进行数据融合，进一步提高定位精度。
7.根据权利要求6所述的一种基于污水管线检测机器人的检测方法，其特征在于数据融合采用特定算法完成，所述特定算法如下：
状态方程 X(k|k-1)=A﹒X(k-1)+B﹒U(K)+W(k)
观测方程 Z(k)=H﹒X(k)+V(k)
X=[s v]T，U=[0 a]T，Z=[s 0]T
其中s为机器人本体位置，v为机器人本体速度，a为惯性传感器输出的加速度;根据具体的机械结构即可列出矩阵A、B、H，通过实验得到状态方程的噪声W和测量系统的噪声V;
通过状态方程可以计算出预测值X(k|k-1)，通过机器人定位模块可以获取测量值Z(k)，然后通过以下公式得到最优化估算值，该值即为机器人当前的位置;
X(k|k)= X(k|k-1)+Kg﹒(Z(k)-H﹒X(k|k-1))
其中Kg为卡尔曼增益，通过以下公式计算：
上式中，R为测量系统的协方差矩阵,
为状态方程的协方差矩阵;
P(k|k-1)=A﹒P(k-1|k-1) AT+Q
上式中Q为状态方程的协方差矩阵;最终得到了k状态下最优的估算值X(k|k);
同时更新k状态下X(k|k)的协方差矩阵：P(k|k)=(I-Kg﹒H)P(k|k-1)。
8.根据权利要求7所述的一种基于污水管线检测机器人的检测方法，其特征在于：所述机器人本体包括自主控制模块、下层控制单元;所述下层控制单元包括电机驱动器、旋转电机、螺旋桨;所述自主控制模块将采集数据通过所述特定算法转换为每一个时刻的位置和速度，将当前速度和检测任务中的目标速度进行比较，如果不一致，则向下层控制单元发送速度指令，速度指令被电机驱动器转换为电机的驱动电流，改变螺旋桨的转速，从而调节机器人本体前进的速度。
9.根据权利要求1所述的一种基于污水管线检测机器人的检测方法，其特征在于：所述机器人本体还包括避障模块，如果机器人本体的避障模块发现障碍物，机器人本体停下并试图绕过;如障碍无法绕过，可用地面控制系统把机器人本体切换至手动控制模式，手动遥控绕过障碍后，机器人本体继续沿规划路径检测。
10.根据权利要求2所述的一种基于污水管线检测机器人的检测方法，其特征在于：所述横向定位即：求取机器人本体距离管线两个侧壁的垂直距离，以及相对管线中心的航向角;
激光雷达以固定频率获取周围的数据，管道侧壁的雷达数据表现为两条直线，从雷达数据中搜索这两条直线数据，搜索采用随机采样一致性算法，并拟合出两条直线的方程，分别为：
其中A1、B1、C1和A2、B2、C2是方程的系数;
机器人本体距离两侧壁的距离为：
机器人本体的航向角为：。
说明书
一种基于污水管线检测机器人的检测方法
技术领域
本发明涉及一种检测方法，具体说是一种基于污水管线检测机器人的检测方法。
背景技术
城市排水管网是城市的重要基础设施之一，随着城市发展，排水管网的安全管理工作显得日益重要，对排水管网的管理要求也逐渐提高。内窥检测技术为城市排水管道的运行管理提供可靠的手段，通过内窥检测可以及时发现管道的腐蚀，破损，接口错位，淤积，结垢等不良状况，及时修复，从而提升管道的使用年限。目前市面上的管道检测机器人均为轮式结构，使用时需要把管道内的水抽干，但是管道排水涉及的工程量非常浩大，给检测工作带来了极大的不便。
发明内容
为克服现有技术存在的以上问题，本发明提供了一种基于污水管线检测机器人的检测方法，该方法不仅检测效率高，检测结果的准确度高，而且降低了工作人员的劳动强度，可有效保障工作人员的人身安全。
本发明由以下技术方案实现：
一种基于污水管线检测机器人的检测方法，包括如下步骤：
S1.给机器人本体连接脐带电缆以及安全绳，打开机器人本体电源，手动将机器人通过窨井投入管道中;
S2. 通过地面控制系统制定检测任务，生成检测指令，并下发检测任务和检测指令至机器人本体;地面控制系统制定检测任务后，会生成一系列检测指令，按一定的顺序下发至机器人本体;
S3. 机器人本体根据检测任务和检测指令，开始工作过程，所述工作过程包括运动过程、数据采集过程以及数据处理过程;
S4. 机器人本体将采集信息和相对位置信息发送到地面控制系统。
进一步的，所述运动过程即机器人本体收到检测指令后，根据检测任务计算出终点位置，然后将机器人本体的当前位置与终点位置进行比较，如果还没有到达终点位置，机器人本体沿管线前进，前进过程中根据定位模块获取机器人本体的姿态和航向角度进行横向定位，调整前进的方向。
进一步的，所述数据采集过程包括：电缆定位采集、无线基站结合移动站定位采集之任一种。
进一步的，还包括卷缆机、CCD摄像机;所述电缆定位采集即机器人本体使用脐带线缆定位，获取机器人本体相对于投放口的位置数据;脐带线缆从卷缆机牵出，脐带线缆上每隔固定的间距做上标记，卷缆机的出线口位于投放口旁，卷缆机上安装有CCD摄像机，定时采集线缆图像，通过图像识别的方式检查图像中是否包含标记，并计算投放线缆的长度;如果包含则线缆计数增加1，将计数值乘以每两个标记之间的距离即为机器人已使用线缆的长度，该长度即为机器人距离投放口的长度。
进一步的，还包括无线基站和移动站;所述无线基站结合移动站定位采集即在检测的起点、终点安装无线基站，在机器人本体上安装移动站，通过测量机器人本体到每一个基站的距离，利用三角定位原理计算出机器人本体在管线中的相对位置。
进一步的，还包括惯性传感器，电缆定位采集、无线基站结合移动站定位采集可结合所述惯性传感器进行数据融合，进一步提高定位精度。
进一步的，数据融合采用特定算法完成，所述特定算法如下：
状态方程 X(k|k-1)=A﹒X(k-1)+B﹒U(K)+W(k)
观测方程 Z(k)=H﹒X(k)+V(k)
X=[s v]T，U=[0 a]T，Z=[s 0]T
其中s为机器人本体位置，v为机器人本体速度，a为惯性传感器输出的加速度;根据具体的机械结构即可列出矩阵A、B、H，通过实验得到状态方程的噪声W和测量系统的噪声V;
通过状态方程可以计算出预测值X(k|k-1)，通过机器人自身传感器可以获取测量值Z(k)，然后通过以下公式得到最优化估算值，该值即为机器人当前的位置;
X(k|k)= X(k|k-1)+Kg﹒(Z(k)-H﹒X(k|k-1))
其中Kg为卡尔曼增益，通过以下公式计算：P(k|k-1)=A﹒P(k-1|k-1) AT+Q
上式中Q为状态方程的协方差矩阵;最终得到了k状态下最优的估算值X(k|k);
同时更新k状态下X(k|k)的协方差矩阵：P(k|k)=(I-Kg﹒H)P(k|k-1)。
进一步的，所述机器人本体包括自主控制模块、下层控制单元;所述下层控制单元包括电机驱动器、旋转电机、螺旋桨;所述自主控制模块将采集数据通过所述特定算法转换为每一个时刻的位置和速度，将当前速度和检测任务中的目标速度进行比较，如果不一致，则向下层控制单元发送速度指令，速度指令被电机驱动器转换为电机的驱动电流，改变螺旋桨的转速，从而调节机器人本体前进的速度。
进一步的，所述机器人本体还包括避障模块，如果机器人本体的避障模块发现障碍物，机器人本体停下并试图绕过;如障碍无法绕过，可用地面控制系统把机器人本体切换至手动控制模式，手动遥控绕过障碍后，机器人本体继续沿规划路径检测。
进一步的，所述激光雷达横向定位的方法是：
求取机器人本体距离管线两个侧壁的垂直距离，以及相对管线中心的航向角;
激光雷达以固定频率获取周围的数据，管道侧壁的雷达数据表现为两条直线，从雷达数据中搜索这两条直线数据，搜索采用随机采样一致性算法，并拟合出两条直线的方程，分别为：
其中A1、B1、C1和A2、B2、C2是方程的系数;
机器人本体距离两侧壁的距离为：
与现有技术相比，本发明的有益效果如下：
现有的管道机器人检测之前需要排干管道内部的水，但是排水是一项需要多部门配合的浩大工程，还可能影响居民正常用水;本发明的机器人检测之前不需要排干管道内部的水，因此可以在任意时间进行检测，大大提升效率。
本发明通过特定算法进行数据融合，进一步提高了机器人系统的定位精度，从而精准确定管线内部各种缺陷，可以进行高效、精准的自主无损检测，该机器人系统工作可靠，完全替代了通过人工检测的高强度工作和检测结果的不准确性。
