CN105013775A - 一种基于力矩控制的管道自动清洗机器人的控制方法 - Google Patents

Abstract

本发明一种基于力矩控制的管道自动清洗机器人的控制方法,所述机器人包括喷杆及与所述喷杆相连接的喷嘴及安装在机器人上的监控摄像头，所述控制方法包括以下步骤：读取机器人参数配置文件，并开启监控摄像头；获取管道自动清洗信号；输出对第一伺服电机和第二伺服电机的控制信号以控制所述喷杆的竖直旋转轴和所述喷杆的水平旋转轴的运行；判断接收到喷杆水平旋转或竖直旋转轴的返回速度是否为零且持续一定时间T且是否完成一个周期的清洗；如果是，所述机器人沿当前管道移动预设的行进距离;判断机器人已经移动的距离是否大于等于设定的总距离,如果是,终止清洗工作,如果否,则进入下个周期的清洗步骤。本方案有效降低了管道自动清洗机器人在管道中作业中驱动电机的故障率；同时有效提高了对管道油污的清洗效果。

Description

一种基于力矩控制的管道自动清洗机器人的控制方法

技术领域

本发明涉及管道清洗运动控制技术及其控制系统设计，具体涉及一种基于力矩控制的管道自动清洗机器人的控制方法。

背景技术

烟道是宾馆、酒楼、饭店厨房的基础设施，极易藏污纳垢，是清理的死角。同时烟道是消防、卫生、防疫部门检查的重点区域。同时，烟罩内壁易寄生老鼠、蟑螂，不符合国家卫生标准。油腻胶状物长期扒附在金属表面，还会腐蚀金属材料，缩短烟道使用寿命。油烟管道有很多油渍长时间残留在烟机上和烟道表面上形成油垢，这样就会影响油烟机、烟道的使用，使烟流不易排除。厨房排烟不畅有80％左右的原因，都是由于长时间没有对油烟净化器的内置过滤网进行清洁，油污堵塞过滤网而造成的。烟道、烟罩常年处于高温工作环境，油烟气化形成积油、积炭或油腻的胶状物，如果不及时对烟道及烟罩进行清洗，非常容易引起火灾。

现在，继中央空调风道清洗机器人的成功运用，又出现了管道自动清洗机器人成功解决了油烟管道自动清洗这一难题，使用控制系统操控的管道自动清洗机器人通过自身携带的摄像头，清楚掌握管道内的污染情况，可实现对管道油烟的自动清洗，但是现有的管道自动清洗机器人在清洗管道的过程中，一方面，因喷杆和喷嘴与管道壁的干涉会导致控制电机的堵转从而烧毁电机，从而导致管道自动清洗机器人中途停止清洗工作；另一方面，现有的机器人清洗喷嘴与管道壁贴合不紧，导致管道自动清洗效果不佳。

发明内容

本发明的目的旨在解决现有的管道自动清洗机器人清洗管道的过程中容易烧坏电机停止工作以及对管道的清洗效果不佳的技术问题，提供一种基于力矩控制的管道自动清洗机器人的控制方法。

本发明提供一种基于力矩控制的管道自动清洗机器人的控制方法,所述机器人包括喷杆及与所述喷杆相连接的喷嘴及安装在机器人上的监控摄像头，所述控制方法包括以下步骤：

读取机器人参数配置文件，并开启监控摄像头；

获取管道自动清洗信号为圆形管道或近似圆形管道，并根据所述管道自动清洗信号设定所述机器人的清洗参数；

输出对用于控制喷杆绕水平旋转轴水平旋转的第一伺服电机和用于控制喷杆绕竖直旋转轴竖直旋转的第二伺服电机的第一控制信号以带动所述机器人的喷嘴移动到管道自动清洗周期的运动原点；

输出对第一伺服电机和第二伺服电机的第二控制信号以控制所述喷杆的竖直旋转轴和所述喷杆的水平旋转轴的运行；

判断接收到喷杆水平旋转的返回速度是否为零且持续一定时间T；

如果是，输出对第一伺服电机和第二伺服电机的第三控制信号以控制所述喷杆的竖直旋转轴和所述喷杆的水平旋转轴的运行；

判断接收到喷杆竖直旋转的返回速度是否为零且持续一定时间T；

如果是，输出对第一伺服电机和第二伺服电机的第四控制信号以控制所述喷杆的竖直旋转轴和所述喷杆的水平旋转轴的运行；

判断接收到喷杆水平旋转的返回速度是否为零且持续一定时间T；

如果是，输出对第一伺服电机和第二伺服电机的第五控制信号以控制所述喷杆的竖直旋转轴和所述喷杆的水平旋转轴的运行；

判断接收到喷杆竖直旋转的返回速度是否为零且持续一定时间T;

如果是,所述机器人沿当前管道移动预设的行进距离;

判断机器人已经移动的距离是否大于等于设定的总距离,如果是,终止清洗工作,如果否,则进入下个周期的清洗步骤。

进一步地，所述获取管道自动清洗信号为圆形管道或近似圆形管道，并根据所述管道自动清洗信号设定所述机器人的清洗参数的步骤，具体为：

设定清洗管道总长度L、每个清洗周期内的行进距离A、清洗阻力F，清洗动力S，以及主动轴的运行速度V；

根据监控摄像头采集的管道视频信号设定清洗模式为轻油污清洗模式或重油污清洗模式；

清油污清洗模式下，控制喷嘴与喷杆的夹角为0；

重油污清洗模式下，控制喷嘴与喷杆的夹角为设定角度α，使喷杆与喷嘴所在的平面始终与所清洗的管道的垂直。

进一步地，所述输出对用于控制喷杆水平旋转的第一伺服电机和用于控制喷杆竖直旋转的第二伺服电机的第一控制信号以带动所述机器人的喷嘴移动到管道自动清洗周期的运动原点的步骤，具体为：

设定所述喷杆竖直旋转轴和喷杆水平旋转轴的力矩大小为空走力矩，所述喷杆竖直旋转轴和喷杆水平旋转轴的最大速度设定为空走速度；

开启对第一伺服电机和第二伺服电机的使能信号以带动所述机器人的喷嘴移动到管道自动清洗周期的运动原点；

其中，所述运动原点位于圆形管道或近似圆形管道的内壁面最高点。

进一步地，所述输出对第一伺服电机和第二伺服电机的第二控制信号以控制所述喷杆的竖直旋转轴和所述喷杆的水平旋转轴的运行的步骤，具体为：

设定所述竖直旋转轴力矩为清洗动力S的力矩与喷杆重力G的力矩之差，设定所述水平旋转轴的力矩为清洗阻力F的力矩，设定竖直旋转轴为主动轴，水平旋转轴的速度为竖直旋转轴的四倍；

开启对第一伺服电机和第二伺服电机的使能信号以带动所述机器人的喷嘴开始清洗管道的左上壁面。

进一步地，所述输出对第一伺服电机和第二伺服电机的第三控制信号以控制所述喷杆的竖直旋转轴和所述喷杆的水平旋转轴运行的步骤，具体为：

设定所述竖直旋转轴力矩为清洗阻力F的力矩与喷杆重力G的力矩之差，设定所述水平旋转轴的力矩为清洗动力S的力矩，设定水平旋转轴的为主动轴，竖直旋转轴的速度为水平旋转轴的四倍；

开启对第一伺服电机和第二伺服电机的使能信号以带动所述机器人的喷嘴开始清洗管道的左下壁面。

进一步地，所述输出对第一伺服电机和第二伺服电机的第四控制信号以控制所述喷杆的竖直旋转轴和所述喷杆的水平旋转轴运行的步骤，具体为：

设定所述竖直旋转轴力矩为清洗动力S的力矩与喷杆重力G的力矩之和，设定所述水平旋转轴的力矩为清洗阻力F的力矩，设定竖直旋转轴为主动轴，水平旋转轴的速度为竖直旋转轴的四倍；

开启对第一伺服电机和第二伺服电机的使能信号以带动所述机器人的喷嘴开始清洗管道的右下壁面。

进一步地，所述输出对第一伺服电机和第二伺服电机的第五控制信号以控制所述喷杆的竖直旋转轴和所述喷杆的水平旋转轴运行的步骤，具体为：

设定所述竖直旋转轴力矩为清洗阻力F的力矩与喷杆重力G的力矩之和，设定所述水平旋转轴的力矩为清洗动力S的力矩，设定水平旋转轴为主动轴，竖直旋转轴的速度为水平旋转轴的四倍；

开启对第一伺服电机和第二伺服电机的使能信号以带动所述机器人的喷嘴开始清洗管道的右上壁面。

从上述系统的方案可以看出，通过采用第一伺服电机控制喷杆绕水平旋转轴转动，并采用第二伺服电机控制喷杆绕竖直旋转轴转动，两个伺服电机分别都工作在转矩模式下，可以有效保证喷杆遇到管道壁面的干涉时，伺服电机不易被烧毁，从而有效降低了管道自动清洗机器人在管道中作业时驱动电机的故障率；同时，采用伺服电机的力矩模式，可以有效保证喷嘴始终紧贴所清洗的管道壁，有效提高了对管道油污的清洗效果。

附图说明

图1为本发明管道自动清洗机器人的一种实施例的结构示意图；

图2为本发明圆形管道一种实施例的清洗区域划分示意图；

图3为本发明管道自动清洗机器人控制方法的一种实施例的流程图。

具体实施方式

为了使本发明所解决的技术问题、技术方案及有益效果更加清楚明白，以下结合附图及实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。

本发明提供一种实施例的基于力矩控制的管道自动清洗机器人的控制方法，所述管道自动清洗机器人，如图1所示，包括喷杆1及与喷杆相连接的喷嘴2，其上还设有水平旋转轴3及竖直旋转轴4，所述喷杆1可绕水平旋转轴3在水平面上转动，从而带动喷嘴2沿着水平面转动，所述喷杆1可绕竖直旋转轴4在竖直面上转动，从而带动喷嘴2沿着水平面转动。利用其内设置的控制装置及驱动装置（图中未示出）控制驱动所述水平旋转轴及竖直旋转轴的转动，从而带动喷杆和喷嘴完成对管道的清洗工作。本实施例中，优选采用第一伺服电机驱动所述水平旋转轴3转动，第二伺服电机驱动所述竖直旋转轴4转动。

对于交流伺服电机，其可以分别运行在三种不同模式下：位置模式、速度模式以及转矩模式。本实施例中，我们使用它的转矩模式，在转矩模式下，电机的转动转矩为可设定量，其设定范围为0-3倍额定转矩。理论上，若阻力矩一直小于设定力矩，电机将会一直保持加速状态，最终导致转速过快，实际中，受电机功率限制，转速不会达到无限快，但转速也会维持在一个较高的水平。因此，在伺服驱动器上，可以设定转矩模式下的最大速度，即使阻力矩一直小于设定力矩，电机转速也不会超过设定值。特别地，当电机转矩设定在额定转矩以下时，若阻力矩大于设定转矩，电机能够以零速度在一段较长的时间内输出设定的转矩，同时又不会对电机造成损伤，利用伺服电机在转矩模式下的这个特性，在清洗管道时，能够实现先使喷嘴与管道壁贴紧，保持一定的压力（可设定大小），再在管道壁平面上移动蒸汽喷嘴，在保证蒸汽喷嘴与管道壁时时贴紧的同时，又不会对电机造成损伤，如果采用步进电机的话，在长时间堵转的情况下，将会烧坏。

所述管道自动清洗机器人上还设有监控摄像头，用于实时监控机器人的行进情况及管道内的油污情况。

所述基于力矩控制的管道自动清洗机器人的控制方法包括以下步骤：

系统初始化，读取机器人参数配置文件，并开启监控摄像头，恢复默认值；机器人的运动控制卡初始化，串口开启，打开摄像头开启监控。

获取管道自动清洗信号，并根据所述管道自动清洗信号设定所述机器人的清洗参数，这里所述管道的自动清洗信号为圆形管道或近似圆形管道。

输出对用于控制喷杆绕水平旋转轴水平旋转的第一伺服电机和用于控制喷杆绕竖直旋转轴竖直旋转的第二伺服电机的第一控制信号以带动所述机器人的喷嘴移动到管道自动清洗周期的运动原点；

输出对第一伺服电机和第二伺服电机的第二控制信号以控制所述喷杆的竖直旋转轴和所述喷杆的水平旋转轴的运行；

判断接收到喷杆水平旋转的返回速度是否为零且持续一定时间T；

如果是，输出对第一伺服电机和第二伺服电机的第三控制信号以控制所述喷杆的竖直旋转轴和所述喷杆的水平旋转轴的运行；

判断接收到喷杆竖直旋转的返回速度是否为零且持续一定时间T；

如果是，输出对第一伺服电机和第二伺服电机的第四控制信号以控制所述喷杆的竖直旋转轴和所述喷杆的水平旋转轴的运行；

判断接收到喷杆水平旋转的返回速度是否为零且持续一定时间T；

如果是，输出对第一伺服电机和第二伺服电机的第五控制信号以控制所述喷杆的竖直旋转轴和所述喷杆的水平旋转轴的运行；

判断接收到喷杆竖直旋转的返回速度是否为零且持续一定时间T;

如果是,所述机器人沿当前管道移动预设的行进距离;

判断机器人已经移动的距离是否大于等于设定的总距离,如果是,终止清洗工作,如果否,则进入下个周期的清洗步骤。

所述获取根据所述管道自动清洗信号设定所述机器人的清洗参数的步骤具体为：

并设定清洗管道总长度L、每个清洗周期内的行进距离A、清洗阻力F，清洗动力S，以及主动轴的运行速度V；这里根据管道不同的清洗区域，主动轴可以设定为水平旋转轴或者竖直旋转轴；

根据监控摄像头采集的管道视频信号设定清洗模式为轻油污清洗模式或重油污清洗模式；

清油污清洗模式下，控制喷嘴与喷杆的夹角为0；

重油污清洗模式下，控制喷嘴与喷杆的夹角为设定角度α，使喷嘴始终与所清洗的管道的轴线垂直。

在0-90度范围内，喷嘴与管道壁面的夹角越大，意味着喷嘴喷出的高温蒸汽射流对管道壁面的冲击力越大。因此对于较清油污，即轻油污清洗模式下，只需要使喷嘴2与喷杆1保持在同一直线上，即夹角为0度，此时喷杆的与壁面的夹角即为喷嘴与管道壁面的夹角。而对于重油污，需要转换为重油污清洗模式，因此针对重油污区，为了获得更好的清洗效果，需增大喷嘴与喷杆的夹角，此时喷嘴与壁面的实际夹角为喷杆与壁面的夹角加上喷杆与喷嘴的夹角。

增大喷嘴与喷杆的夹角，虽然能够增强对油污的冲击力，但同时也会减小蒸汽射流的作用面积，使得清洗宽度更窄。更重要的是，当喷嘴与喷杆不处于一条直线时，喷嘴与喷杆（等效成两条直线）所构成的平面必须时刻与要清洗的管道壁面垂直，也就是必须要与管道的横截面垂直。

下面，以圆形管道为例，详述本发明的基于力矩控制的管道自动清洗机器人的控制方法。

对于圆管清洗可以将其分为四个部分，如图2所示。对圆管清洗，在力矩控制模式下，采取一轴主动另一轴随动的控制方法。例如，在清洗圆周的左上部分时，从圆周最高点（上端点）开始，喷杆应向左运动，同时喷杆也要向下运动。对应到控制轴，水平旋转轴向左转动，同时竖直旋转轴向下旋转，此时竖直旋转轴为主动轴，这是因为在竖直旋转轴向下转动时，不会受到来自管道壁的限制，而水平旋转轴，以圆周的最高点为起点，在向左旋转时，若竖直旋转轴保持静止，水平旋转轴的运动势必会受到圆周边缘限制，将无法转动。因此在清洗时，主动轴的速度为实际运动速度，随动轴的速度设定值应远高于主动轴的速度，这是由于受管道边缘限制，沿圆周运动时，随动轴的实际速度受限于主动轴的速度。将随动轴的速度设定高一点，是为了保证在主动轴向下旋转的过程中，喷头能够始终贴紧管道壁。本实施例中随动轴的速度优选设定为主动轴速度V的四倍，即4V。

结合图3所示，本实施例中的基于力矩控制的管道自动清洗机器人的控制方法包括以下步骤：

步骤S2001，系统初始化，读取参数配置文件，恢复默认值，各个串口开启，打开摄像头开启监控，选择圆形管道自动清洗，并设定以下参数：清洗管道总长度、每个清洗周期内的行进距离、清洗阻力F（即喷嘴对管道壁面的压力），清洗动力S（即为使喷嘴在壁面移动的驱动力），以及喷嘴在管道壁面上的行走速度V（即清洗速度）。如果对上述参数有尚未设定的，则采取默认值；

根据监控摄像头采集的管道视频信号及人机交互界面，用户选择是否开启重油污清洁模式，若是，则控制管道自动清洗机器人进入重油污清洁模式。实际应用中，判断所述管道壁上是否为重油污的方法及分界限因人而异，具体可以管道壁上是否有油滴为界限，若有油滴，则可以设定机器人的清洗模式为重油污清洗模式。当然，为了增强对任何管道的清洗力度及清洗效果，可以设定机器人一直工作在重油污模式。

步骤S2002，喷杆水平旋转轴以及竖直旋转轴均采用力矩模式，设定所述喷杆竖直旋转轴和喷杆水平旋转轴的力矩大小为空走力矩，所述喷杆竖直旋转轴和喷杆水平旋转轴的最大速度设定为空走速度；开启对第一伺服电机和第二伺服电机的第一控制信号以带动所述机器人的喷嘴移动到圆形管道的自动清洗周期的运动原点；

其中，本实施例中所述运动原点优选位于圆形管道的上端点，即最高点。

步骤S2003，准备开始清洗圆形管道的左上壁面，此时设定喷杆水平旋转轴为随动轴，竖直旋转轴为主动轴。设定喷杆竖直旋转轴力矩为清动力S的力矩与喷杆重力G力矩（常量）之差，这是由于在清洗左上壁面时，喷杆重力提供了部分动力，设定水平旋转轴的力矩为清洗阻力F的力矩，设定其速度为竖直旋转轴速度的四倍，设定完成后，对这两个轴发出第二控制信号，驱动水平旋转轴和竖直旋转轴开始运行。

步骤S2004，判断喷嘴是否到达圆形管道的左端点，即管道左上壁面清洗是否已经完成。判定的依据是喷杆水平旋转轴伺服驱动器返回的电机速度在一段时间T内为零，则说明水平轴已经停止转动，也就是说已经到达圆形管道的左端点。以一段时间T内的速度作为判定依据，是为了防止信号的扰动将导致的误判。如果已经到达管道左端点（水平轴停止转动）则继续执行步骤S2005，否则返回继续监测。

步骤S2005，准备开始清洗圆形管道的左下壁面，此时设定喷杆水平旋转轴为主动轴，竖直旋转轴为随动轴，设定喷杆竖直旋转轴的力矩为清洗阻力F的力矩与喷杆重力G的力矩矩（常量）之差，这是由于在清洗左下壁时，喷杆的重力能够提供一部分阻力，同时设定水平旋转轴的力矩为清动力S的力矩，其清洗速度为主动轴的速度V，竖直旋转轴的速度为4V，设定完成后，对这两个轴发出第三控制信号，驱动水平旋转轴和竖直旋转轴开始运行。

步骤S2006，判断喷嘴是否到达圆形管道的下端点，即左下壁清洗是否已经完成。判定的依据是喷杆竖直旋转轴伺服驱动器返回的电机速度在一段时间T内为零，则说明竖直旋转轴已经停止转动，也就是说已经到达管道的下端点，如果已经到达下端点（竖直轴停止转动）则继续执行步骤S2007，否则返回继续监测。

步骤S2007，准备开始清洗圆形管道的右下壁面，此时喷杆水平旋转轴为随动轴，竖直旋转轴为主动轴，喷嘴的清洗速度为竖直旋转轴的速度V，水平旋转轴的速度为4V，设定喷杆竖直旋转轴的力矩为清洗动力S的力矩与喷杆重力G的力矩（常量）之和，这是由于在清洗右下壁时，竖直旋转轴需克服喷杆的重力矩，设定水平旋转轴的力矩为清洗阻力F的力矩。设定完成后，对这两个轴发出第四控制信号，驱动水平旋转轴和竖直旋转轴开始运行，带动喷嘴对管道右下壁面进行清洗。

步骤S2008，判断喷嘴是否到达圆形管道的右端点，即右下壁面清洗是否已经完成，判定的依据是喷杆水平旋转轴伺服驱动器返回的电机速度在一段时间T内都为零，则说明水平旋转轴已经停止转动，也就是说喷嘴已经到达管道右端点，如果已经到达右端点（水平轴停止转动）则继续执行步骤S2009，否则返回继续监测。

步骤S2009，开始清洗圆形管道的右上壁面，此时喷杆竖直旋转轴为随动轴，水平旋转轴为主动轴，喷嘴的清洗速度为水平旋转轴的速度V，竖直旋转轴的速度为4V，设定喷杆竖直旋转轴的力矩为清洗阻力F的力矩与喷杆重力G的力矩（常量）之和，这是由于在清洗右上壁面时，竖直旋转轴需要克服喷杆的重力矩，设定水平旋转轴的力矩为清洗动力S的力矩。设定完成后，对这两个轴发出第五控制信号，驱动水平旋转轴和竖直旋转轴开始运行，带动喷嘴对圆形管道的右上壁面进行清洗。

步骤S2010，判断喷嘴是否到达管道的上端点，即右上壁面清洗是否已经完成，判定的依据是喷杆竖直旋转轴伺服驱动器返回的电机速度在一段时间T内都为零，则说明竖直旋转轴已经停止转动，也就是说喷嘴已经到达管道的上端点。如果已经到达上端点（竖直轴停止转动）则继续执行步骤S2011，否则返回继续监测。

步骤S2011，一个周期内的清洗动作已经完成，控制驱动机器人沿管道行进预设的行进距离A。

步骤S2012，根据机器人已经移动的总距离判断是否已经完成设定的总长度L，即器人已经移动的距离是否大于等于设定的总距离L，如果是，继续执行步骤S2013，否则返回步骤S2003，开始执行下一个周期的清洗动作。

步骤S2013，终止清洗，等待用户的下一个指令。

综上所述，本发明详述了控制机器人对圆形管道自动清洗所需的所有步骤，在力矩控制模式的基础上，主动轴与随动轴的协和运动得以实现该控制方式。根本上，力矩模式使得喷嘴与管壁之间产生近似弹性的接触，对动力矩（主动轴力矩）和阻力矩（随动轴力矩）的设定，在圆管清洗中显得尤为重要，一般采取通过多次使用后得到的最佳的经验值作为默认，再根据管道的实际情况作恰当的调整。针对类似圆形管道的清洗控制方法与圆形管道的清洗控制方法相同，在此不再赘述。

本发明综述了一套针对基于力矩控制的管道自动清洗机器人的全自动清洗方法。总的来说，该方法简化了基于位置控制的控制方法的控制过程，且方法具有更强的适应性，为油烟管道及风管的清洗开辟了新的道路。不但有效降低了管道自动清洗机器人在管道作业中电机的故障率，同时，采用伺服电机的力矩模式，可以有效保证喷嘴始终紧贴所清洗的管道壁，有效提高了对管道油污的清洗效果。

以上所述仅为本发明的较佳实施例而已，并不用以限制本发明，凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明的保护范围之内。

Claims (7)

1.一种基于力矩控制的管道自动清洗机器人的控制方法,所述机器人包括喷杆及与所述喷杆相连接的喷嘴及安装在机器人上的监控摄像头，其特征在于：所述控制方法包括以下步骤：

读取机器人参数配置文件，并开启监控摄像头；

获取管道自动清洗信号为圆形管道或近似圆形管道，并根据所述管道自动清洗信号设定所述机器人的清洗参数；

输出对用于控制喷杆绕水平旋转轴水平旋转的第一伺服电机和用于控制喷杆绕竖直旋转轴竖直旋转的第二伺服电机的第一控制信号以带动所述机器人的喷嘴移动到管道自动清洗周期的运动原点；

输出对第一伺服电机和第二伺服电机的第二控制信号以控制所述喷杆的竖直旋转轴和所述喷杆的水平旋转轴的运行；

判断接收到喷杆水平旋转的返回速度是否为零且持续一定时间T；

如果是，输出对第一伺服电机和第二伺服电机的第三控制信号以控制所述喷杆的竖直旋转轴和所述喷杆的水平旋转轴的运行；

判断接收到喷杆竖直旋转的返回速度是否为零且持续一定时间T；

如果是，输出对第一伺服电机和第二伺服电机的第四控制信号以控制所述喷杆的竖直旋转轴和所述喷杆的水平旋转轴的运行；

判断接收到喷杆水平旋转的返回速度是否为零且持续一定时间T；

如果是，输出对第一伺服电机和第二伺服电机的第五控制信号以控制所述喷杆的竖直旋转轴和所述喷杆的水平旋转轴的运行；

判断接收到喷杆竖直旋转的返回速度是否为零且持续一定时间T;

如果是,所述机器人沿当前管道移动预设的行进距离;

判断机器人已经移动的距离是否大于等于设定的总距离,如果是,终止清洗工作,如果否,则进入下个周期的清洗步骤。

2.如权利要求1所述的控制方法,其特征在于：所述获取管道自动清洗信号为圆形管道或近似圆形管道，并根据所述管道自动清洗信号设定所述机器人的清洗参数的步骤，具体为：

设定清洗管道总长度L、每个清洗周期内的行进距离A、清洗阻力F，清洗动力S，以及主动轴的运行速度V；

根据监控摄像头采集的管道视频信号设定清洗模式为轻油污清洗模式或重油污清洗模式；

清油污清洗模式下，控制喷嘴与喷杆的夹角为0；

重油污清洗模式下，控制喷嘴与喷杆的夹角为设定角度α，使喷杆与喷嘴所在的平面始终与所清洗的管道的横截面垂直。

3.如权利要求2所述的控制方法,其特征在于：所述输出对用于控制喷杆水平旋转的第一伺服电机和用于控制喷杆竖直旋转的第二伺服电机的第一控制信号以带动所述机器人的喷嘴移动到管道自动清洗周期的运动原点的步骤，具体为：

设定所述喷杆竖直旋转轴和喷杆水平旋转轴的力矩大小为空走力矩，所述喷杆竖直旋转轴和喷杆水平旋转轴的最大速度设定为空走速度；

开启对第一伺服电机和第二伺服电机的使能信号以带动所述机器人的喷嘴移动到管道自动清洗周期的运动原点；

其中，所述运动原点位于圆形管道或近似圆形管道的内壁面最高点。

4.如权利要求3所述的控制方法，其特征在于：所述输出对第一伺服电机和第二伺服电机的第二控制信号以控制所述喷杆的竖直旋转轴和所述喷杆的水平旋转轴的运行的步骤，具体为：

设定所述竖直旋转轴力矩为清洗动力S的力矩与喷杆重力G的力矩之差，设定所述水平旋转轴的力矩为清洗阻力F的力矩，设定竖直旋转轴为主动轴，水平旋转轴的速度为竖直旋转轴的四倍；

开启对第一伺服电机和第二伺服电机的使能信号以带动所述机器人的喷嘴开始清洗管道的左上壁面。

5.如权利要求4所述的控制方法，其特征在于：所述输出对第一伺服电机和第二伺服电机的第三控制信号以控制所述喷杆的竖直旋转轴和所述喷杆的水平旋转轴运行的步骤，具体为：

设定所述竖直旋转轴力矩为清洗阻力F的力矩与喷杆重力G的力矩之差，设定所述水平旋转轴的力矩为清洗动力S的力矩，设定水平旋转轴的为主动轴，竖直旋转轴的速度为水平旋转轴的四倍；

开启对第一伺服电机和第二伺服电机的使能信号以带动所述机器人的喷嘴开始清洗管道的左下壁面。

6.如权利要求5所述的控制方法，其特征在于：所述输出对第一伺服电机和第二伺服电机的第四控制信号以控制所述喷杆的竖直旋转轴和所述喷杆的水平旋转轴运行的步骤，具体为：

设定所述竖直旋转轴力矩为清洗动力S的力矩与喷杆重力G的力矩之和，设定所述水平旋转轴的力矩为清洗阻力F的力矩，设定竖直旋转轴为主动轴，水平旋转轴的速度为竖直旋转轴的四倍；

开启对第一伺服电机和第二伺服电机的使能信号以带动所述机器人的喷嘴开始清洗管道的右下壁面。

7.如权利要求6所述的控制方法，其特征在于：所述输出对第一伺服电机和第二伺服电机的第五控制信号以控制所述喷杆的竖直旋转轴和所述喷杆的水平旋转轴运行的步骤，具体为：

设定所述竖直旋转轴力矩为清洗阻力F的力矩与喷杆重力G的力矩之和，设定所述水平旋转轴的力矩为清洗动力S的力矩，设定水平旋转轴为主动轴，竖直旋转轴的速度为水平旋转轴的四倍；

开启对第一伺服电机和第二伺服电机的使能信号以带动所述机器人的喷嘴开始清洗管道的右上壁面。