CN114458868A - 履带式管道机器人及其运动控制方法 - Google Patents
履带式管道机器人及其运动控制方法 Download PDFInfo
- Publication number
- CN114458868A CN114458868A CN202210290157.7A CN202210290157A CN114458868A CN 114458868 A CN114458868 A CN 114458868A CN 202210290157 A CN202210290157 A CN 202210290157A CN 114458868 A CN114458868 A CN 114458868A
- Authority
- CN
- China
- Prior art keywords
- crawler
- motor
- robot
- baffle
- synchronous
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Withdrawn
Links
Images
Classifications
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F16—ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
- F16L—PIPES; JOINTS OR FITTINGS FOR PIPES; SUPPORTS FOR PIPES, CABLES OR PROTECTIVE TUBING; MEANS FOR THERMAL INSULATION IN GENERAL
- F16L55/00—Devices or appurtenances for use in, or in connection with, pipes or pipe systems
- F16L55/26—Pigs or moles, i.e. devices movable in a pipe or conduit with or without self-contained propulsion means
- F16L55/28—Constructional aspects
- F16L55/30—Constructional aspects of the propulsion means, e.g. towed by cables
- F16L55/32—Constructional aspects of the propulsion means, e.g. towed by cables being self-contained
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F16—ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
- F16L—PIPES; JOINTS OR FITTINGS FOR PIPES; SUPPORTS FOR PIPES, CABLES OR PROTECTIVE TUBING; MEANS FOR THERMAL INSULATION IN GENERAL
- F16L55/00—Devices or appurtenances for use in, or in connection with, pipes or pipe systems
- F16L55/26—Pigs or moles, i.e. devices movable in a pipe or conduit with or without self-contained propulsion means
- F16L55/28—Constructional aspects
- F16L55/40—Constructional aspects of the body
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P.I., P.I.D.
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F16—ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
- F16L—PIPES; JOINTS OR FITTINGS FOR PIPES; SUPPORTS FOR PIPES, CABLES OR PROTECTIVE TUBING; MEANS FOR THERMAL INSULATION IN GENERAL
- F16L2101/00—Uses or applications of pigs or moles
- F16L2101/10—Treating the inside of pipes
- F16L2101/12—Cleaning
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F16—ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
- F16L—PIPES; JOINTS OR FITTINGS FOR PIPES; SUPPORTS FOR PIPES, CABLES OR PROTECTIVE TUBING; MEANS FOR THERMAL INSULATION IN GENERAL
- F16L2101/00—Uses or applications of pigs or moles
- F16L2101/30—Inspecting, measuring or testing
Abstract
本发明公开了一种履带式管道机器人及其运动控制方法,履带式管道机器人包括变径机构、履带机构、感知机构和控制机构,三个履带机构压紧管道内壁且呈120度夹角分布在变径机构外侧,变径机构与三个履带机构连接,运动控制方法通过控制机器人前端中心点与管道中心轴的偏向距离实现行走姿态稳定。本发明履带机构可相对于变径机构展开或收缩,使机器人可以适用于不同管径的管道中;履带机构采用平行四边形履带机构,使机器人可以在弯管、变径管等复杂管道内移动,并具有越过一定尺寸障碍的能力;其运动控制方法解决了现有管道机器人运动过程中行走姿态调整能力差,容易卡死的问题。
Description
技术领域
本发明属于机械制造领域,具体为机器人技术领域,更具体的说是一种能够在管道中自主爬行的履带式管道机器人及其运动控制方法。
背景技术
在一般工业、核设施、石油天然气、军事装备、市政设施等领域中,管道作为一种有效的物料输送方式而得到广泛的应用。管道的工作环境非常恶劣,容易发生腐蚀、疲劳破坏或使管道内部潜在的缺陷发展成破损而引起泄漏等事故。因此,为了延长管道的寿命、防止泄漏事故的发生,就必须对管道进行有效的检测维护、维修。
现实中管道复杂狭长,人工操作难以完成。管道机器人因为其较小的体积、可在管道中爬行、可携带多种传感器及操作机械以及可远程控制,被广泛应用于管道的检测、清理以及探伤。
现有技术中,管道机器人只能适用特定管径的管道,而且大多是采用轮子作为行走装置,轮子会在某一时刻离开管壁的表面,因此轮式不能很好地通过曲率半径较小的管道;管道机器人在通过复杂管道时会出现卡死和打滑的现象,限制了其转弯能力;管道机器人管径适应的范围较小,在遇到不规则管道和障碍时不能很好地越障。
发明内容
为了解决上述技术问题,本发明提供一种结构简单、工作可靠的履带式管道机器人及其运动控制方法。
本发明解决上述技术问题的技术方案是:一种履带式管道机器人,包括变径机构、履带机构、感知机构和控制机构,三个履带机构压紧管道内壁且呈120度夹角分布在变径机构外侧,变径机构与三个履带机构连接,履带机构可相对于变径机构展开或收缩,所述感知机构安装在变径机构上,感知机构与控制机构相连,控制机构与变径机构、履带机构相连。
上述履带式管道机器人,所述变径机构包括预紧电机、预紧电机座、联轴器、滚珠丝杠、丝杠支撑板、丝杠螺母、丝杠螺母底座、固定杆,所述滚珠丝杠左右两端通过第一轴承安装在两块丝杠支撑板上,滚珠丝杠外侧平行设置三根呈120度夹角分布的固定杆,固定杆的一端固定在其中一块丝杠支撑板上,固定杆的另一端穿过另一块丝杠支撑板后与预紧电机座固定连接,预紧电机固定安装在预紧电机座上,预紧电机的输出轴通过联轴器与滚珠丝杠一端连接,滚珠丝杠两侧对称设置两个丝杠螺母底座,两个丝杠螺母底座外侧套设于三根固定杆上且可沿固定杆滑动,每个丝杠螺母底座内侧均固定设有一个丝杠螺母,两个丝杠螺母分别螺纹连接于滚珠丝杠两端,三个履带结构均通过伸缩连接件与丝杠螺母底座连接。
上述履带式管道机器人,所述伸缩连接件包括滑动片、固定支撑板、支撑架、长折叠杆、短折叠杆和压簧,两块固定支撑板相对设置且均固定套设于三根固定杆的中部,每根支撑杆的两端均套设一个压簧,压簧的一端固定在对应的丝杠螺母底座上,压簧的另一端与一个套设于固定杆上的滑动片固定连接,每个滑动片的两端分别与两个长折叠杆的一端铰接,每个长折叠杆的中点位置均与一个短折叠杆的一端铰接,短折叠杆的另一端与固定设置在固定支撑板上的支撑架铰接,每个长折叠杆的另一端均铰接在对应的履带机构上。
上述履带式管道机器人,所述履带机构包括橡胶履带、同步主动轮、第一同步从动轮、第二同步从动轮、齿轮、支撑杆、第一同步轮挡板、第二同步轮挡板、凸台同步轮挡板、外挡板、电机外挡板、电机、第一小同步轮、第二小同步轮、小履带、转动轴、第一限位轴和第二限位轴,所述外挡板和电机外挡板通过支撑杆连接,与滑动片两端相连的两个长折叠杆的另一端分别铰接在外挡板和电机外挡板上,一个同步主动轮和一个第一同步从动轮通过第一限位轴安装在第一同步轮挡板和凸台同步轮挡板之间两端位置组成第一同步轮组,两个第二同步从动轮通过第二限位轴安装在两个第二同步轮挡板之间两端位置组成第二同步轮组;电机安装在电机外挡板外侧一端,电机的输出轴穿过电机外挡板与外挡板连接,第一同步轮组位于外挡板和电机外挡板之间靠近电机一侧且第一同步轮组的第一同步轮挡板和凸台同步轮挡板穿设于电机的输出轴上,电机的输出轴上固定设有齿轮,齿轮与同步主动轮侧齿啮合,第二同步轮组的两个第二同步轮挡板通过转动轴安装在外挡板和电机外挡板之间远离电机一侧,凸台同步轮挡板外侧的凸台穿过外挡板和第一小同步轮,转动轴一端穿过外挡板并外露,第二小同步轮安装在转动轴的外露端,第一同步轮组和第二同步轮组啮合连接橡胶履带,第一小同步轮和第二小同步轮外侧啮合连接小履带。
上述履带式管道机器人,所述感知机构包括红外测距仪、摄像头、倾角检测单元、霍尔测速单元和薄膜压力传感器,所述红外测距仪、摄像头和倾角检测单元安装在所述丝杠支撑板上,每个压簧和滑动片接触面上设置有薄膜压力传感器。
上述履带式管道机器人,所述控制机构包括控制器、无线传输单元、蓄电池,所述控制器、无线传输单元、蓄电池安装在两个固定支撑板之间,所述蓄电池与控制器电连接,所述控制器分别与感知机构、电机、预紧电机电连接。
上述履带式管道机器人,所述固定支撑板中心开孔,不与滚珠丝杠接触,所述同步主动轮和第一同步从动轮通过第二轴承与限位轴连接。
上述履带式管道机器人,所述电机输出轴通过第三轴承与电机外挡板以及第一同步轮组连接;所述凸台同步轮挡板的凸台通过第四轴承与外挡板固定连接;所述转动轴通过第五轴承与电机外挡板以及外挡板连接。
一种履带式管道机器人的运动控制方法,包括以下步骤:
步骤1:设定机器人的履带机构电机转速初值n0和卡死阈值K,作为给定值,发送给控制器,其中卡死阈值K为由机器人自身结构所决定的常值;
步骤2:控制器根据转速给定值,采用增量式PID算法,并对输出进行限幅处理,实现速度闭环控制,驱动履带机构的电机旋转;
步骤3:用红外测距仪和倾角检测单元实时采集机器人的行走姿态信息,红外测距仪测量在空间中三个履带机构前端中点到机体前端中心点的距离|OA|、|OB|、|OC|,倾角检测单元测量机器人中央机体与三个履带的相对角度θA、θB、θC,反馈给控制器;
步骤4:控制器把行走姿态信息进行计算处理,得到在管道截面上机体前端中心点与管道中心轴的偏向距离d以及偏向方向;
步骤5:在控制器中,将偏向距离d与卡死阈值K作比较,判断机器人是否有卡死的风险,偏向距离d大于卡死阈值K则有卡死的风险,如果有卡死的风险则执行步骤6,没有卡死的风险则返回步骤2;
步骤6:根据偏向距离d与卡死阈值K的偏差量和偏向方向,给出三个履带机构上电机各自新的转速给定值,进行差速控制,调整机器人行走姿态,重复步骤2至步骤5,控制偏向距离d始终小于等于卡死阈值K。
上述履带式管道机器人的运动控制方法,所述步骤4包括如下分步骤:
步骤4.1:对当前时刻行走姿态信息进行处理,将三个履带机构前端中点A、B、C与机体前端中心点O投影到点O所在的管道截平面上,利用如下公式在投影面上得到履带投影点a、b、c到机体前端中心投影点o的距离;
|oa|=|OA|cos 2θA
|ob|=|OB|cos 2θB
|oc|=|OC|cos 2θC
步骤4.2:偏向方向由投影面上oa、ob、oc的距离大小确定,将oa、ob、oc的距离按从小到大顺序赋值给h1、h2、h3,利用如下公式计算出在投影面上机体前端中心点o与管道中心轴的偏向距离d;
式中,R表示管道内半径。
本发明的有益效果在于:本发明针对履带式管道机器人对管径变化适应性差和过弯控制复杂的问题,设计了自变径结构、平行四边形履带结构以及其运动控制方法,包括变径机构和呈120度夹角分布在变径机构外侧的三个履带机构,履带机构可相对于变径机构展开或收缩,使机器人可以适用于不同管径的管道中,履带机构采用平行四边形履带机构,使机器人可以在弯管、变径管等复杂管道内移动,并具有越过一定尺寸障碍的能力,其运动控制方法解决了现有管道机器人运动过程中行走姿态调整能力差,容易卡死的问题。
附图说明
图1为本发明的整体结构立体图。
图2为本发明中变径机构与履带机构的装配关系立体图。
图3为本发明中的变径机构结构立体图。
图4为本发明中的履带机构结构立体图。
图5为本发明中的履带机构各零件结构立体图。
图6为本发明中的运动控制方法流程图。
具体实施方式
下面结合附图和实施例对本发明做进一步的说明。
如图1、图2所示,一种履带式管道机器人,包括变径机构1、履带机构2、感知机构3、控制机构4,三个履带机构2压紧管道内壁且呈120度夹角分布在变径机构1外侧,变径机构1与三个履带机构2连接,履带机构2可相对于变径机构1展开或收缩;所述感知机构3安装在变径机构1上,感知机构3与控制机构4相连,控制机构4与变径机构1、履带机构2相连。
如图3所示,所述变径机构1包括预紧电机1-1、预紧电机座1-2、联轴器1-3、滚珠丝杠1-4、丝杠支撑板1-5、丝杠螺母1-6、丝杠螺母底座1-7、固定杆1-10,所述滚珠丝杠1-4左右两端通过第一轴承安装在两块丝杠支撑板1-5上,滚珠丝杠1-4外侧平行设置三根呈120度夹角分布的固定杆1-10,固定杆1-10的一端固定在其中一块丝杠支撑板1-5上,固定杆1-10的另一端穿过另一块丝杠支撑板1-5后与预紧电机座1-2固定连接,预紧电机1-1固定安装在预紧电机座1-2上,预紧电机1-1的输出轴通过联轴器1-3与滚珠丝杠1-4一端连接,滚珠丝杠1-4两侧对称设置两个丝杠螺母底座1-7,两个丝杠螺母底座1-7外侧套设于三根固定杆1-10上且可沿固定杆1-10滑动,每个丝杠螺母底座1-7内侧均固定设有一个丝杠螺母1-6,两个丝杠螺母1-6分别螺纹连接于滚珠丝杠1-4两端,三个履带结构均通过伸缩连接件与丝杠螺母底座1-7连接。
所述伸缩连接件包括滑动片1-8、固定支撑板1-9、支撑架1-11、长折叠杆1-12、短折叠杆1-13和压簧1-14,两块固定支撑板1-9相对设置且均固定套设于三根固定杆1-10的中部,每根支撑杆的两端均套设一个压簧1-14,压簧1-14的一端固定在对应的丝杠螺母底座1-7上,压簧1-14的另一端与一个套设于固定杆1-10上的滑动片1-8固定连接,每个滑动片1-8的两端分别与两个长折叠杆1-12的一端铰接,每个长折叠杆1-12的中点位置均与一个短折叠杆1-13的一端铰接,短折叠杆1-13的另一端与固定设置在固定支撑板1-9上的支撑架1-11铰接,每个长折叠杆1-12的另一端均铰接在对应的履带机构2上。
如图4、图5所示,所述履带机构2包括橡胶履带2-1、同步主动轮2-2、第一同步从动轮2-3、第二同步从动轮、齿轮2-4、支撑杆2-5、第一同步轮挡板、第二同步轮挡板2-6、凸台同步轮挡板2-7、外挡板2-8、电机外挡板2-9、电机2-10、第一小同步轮、第二小同步轮2-11、小履带2-12、转动轴2-13、第一限位轴和第二限位轴2-14,所述外挡板2-8和电机外挡板2-9通过支撑杆2-5连接,与滑动片1-8两端相连的两个长折叠杆1-12的另一端分别铰接在外挡板2-8和电机外挡板2-9上,一个同步主动轮2-2和一个第一同步从动轮2-3通过第一限位轴安装在第一同步轮挡板和凸台同步轮挡板2-7之间两端位置组成第一同步轮组2-15,两个第二同步从动轮通过第二限位轴2-14安装在两个第二同步轮挡板2-6之间两端位置组成第二同步轮组2-16;电机2-10安装在电机外挡板2-9外侧一端,电机2-10的输出轴穿过电机外挡板2-9与外挡板2-8连接,第一同步轮组2-15位于外挡板2-8和电机外挡板2-9之间靠近电机2-10一侧且第一同步轮组2-15的第一同步轮挡板和凸台同步轮挡板2-7穿设于电机2-10的输出轴上,电机2-10的输出轴上固定设有齿轮2-4,齿轮2-4与同步主动轮2-2侧齿啮合,第二同步轮组2-16的两个第二同步轮挡板2-6通过转动轴2-13安装在外挡板2-8和电机外挡板2-9之间远离电机2-10一侧,凸台同步轮挡板2-7外侧的凸台穿过外挡板2-8和第一小同步轮,转动轴2-13一端穿过外挡板2-8并外露,第二小同步轮2-11安装在转动轴2-13的外露端,第一同步轮组2-15和第二同步轮组2-16啮合连接橡胶履带2-1,第一小同步轮和第二小同步轮2-11外侧啮合连接小履带2-12。
所述固定支撑板1-9中心开孔,不与滚珠丝杠1-4接触。所述同步主动轮2-2和第一同步从动轮2-3通过第二轴承与限位轴连接。所述电机2-10输出轴通过第三轴承与电机外挡板2-9以及第一同步轮组2-15连接。所述凸台同步轮挡板2-7的凸台通过第四轴承与外挡板2-8固定连接;所述转动轴2-13通过第五轴承与电机外挡板2-9以及外挡板2-8连接。
所述的感知机构3包括红外测距仪、摄像头、倾角检测单元、霍尔测速单元和薄膜压力传感器,所述红外测距仪、摄像头和倾角检测单元安装在所述丝杠支撑板1-5上,每个压簧1-14和滑动片1-8接触面上设置有薄膜压力传感器;霍尔测速单元是测量电机转速的,在运动控制方法里有用到。薄膜压力传感器是用于测量压簧1-14和滑动片1-8之间的压力;摄像头是根据实际工程需要加装的,用于显示管道内的实时图像。
所述的控制机构4包括控制器、无线传输单元、蓄电池,所述控制器、无线传输单元、蓄电池安装在两个固定支撑板1-9之间,所述蓄电池与控制器电连接,所述控制器分别与感知机构3、电机2-10、预紧电机1-1电连接。
一种履带式管道机器人的运动控制方法,包括以下步骤:
步骤1,设定机器人的履带机构电机转速初值n0和卡死阈值K,作为给定值,发送给控制器,其中卡死阈值K为由机器人自身结构所决定的常值。
步骤2,控制器根据转速给定值,采用增量式PID算法,并对输出进行限幅处理,实现速度闭环控制,驱动履带机构电机旋转。
步骤3:用红外测距仪和倾角检测单元实时采集机器人的行走姿态信息,由于过弯或者越障导致三个履带机构发生相对位移,造成机器人中央机体发生倾斜,不再与履带机构保持平行,红外测距仪测量在空间中三个履带机构前端中点到机体前端中心点的距离|OA|、|OB|、|OC|,倾角检测单元测量机器人中央机体与三个履带的相对角度θA、θB、θC,反馈给控制器;
步骤4,控制器把行走姿态信息进行计算处理,得到在管道截面上机体前端中心点与管道中心轴的偏向距离d以及偏向方向;
步骤4包括如下分步骤:
步骤4.1:对当前时刻行走姿态信息进行处理,将三个履带机构前端中点A、B、C与机体前端中心点O投影到点O所在的管道截平面上,利用如下公式在投影面上得到履带投影点a、b、c到机体前端中心投影点o的距离;
|oa|=|OA|cos 2θA
|ob|=|OB|cos 2θB
|oc|=|OC|cos 2θC
步骤4.2,偏向方向由投影面上oa、ob、oc的距离大小确定,将oa、ob、oc的距离按从小到大顺序赋值给h1、h2、h3,利用如下公式计算出在投影面上机体前端中心点o与管道中心轴的偏向距离d;
式中,R表示管道内半径。
步骤5,在控制器中,将偏向距离d与卡死阈值K作比较,判断机器人是否有卡死的风险,偏向距离d大于卡死阈值K则有卡死的风险,如果有则执行步骤6,没有则返回步骤2。
步骤6,根据偏向距离d与卡死阈值K的偏差量和偏向方向,给出三个履带机构上电机各自新的转速给定值,进行差速控制,调整机器人行走姿态,重复2到5的步骤,控制偏向距离d始终小于等于卡死阈值K。
本发明的工作原理如下:
在直管内,机器人的履带机构2分布在120度的圆周上,因此它可以更好平稳地在管道中行走,同时利用丝杠螺母1-6的锁紧以及橡胶履带2-1和管道之间的摩擦力,可以让其能够在垂直管道中行走。机器人的履带机构2的第一同步轮组2-15和第二同步轮组2-16与管道的中心轴保持平行状态,每个履带机构2的电机2-10驱动齿轮2-4转动,齿轮2-4带动同步主动轮2-2转动,同步主动轮2-2带动橡胶履带2-1运动,驱动机器人在管道中行驶。
当遇到小范围的变径管、不规则管道和障碍时,该机器人的履带机构的第一同步轮组2-15在外力作用下摆动至与管道的中心轴成一夹角,第二同步轮组2-16在小履带2-12的带动下与第一同步轮组2-15保持平行;同时滑动片1-8在外力作用下压缩压簧1-14改变短折叠杆1-13和长折叠杆1-12之间夹角,从而调节该机器人直径。在机器人经过变径管、弯管和障碍后,在压簧1-14弹力作用下,使第一同步轮组2-15和第二同步轮组2-16与管道的中心轴重新保持平行状态,继续行驶。压簧1-14保证该机器人具有自动适应变径管、不规则管道和障碍的能力,并有减震作用。
当需要调节的管径变大时,预紧电机1-1的输出轴带动联轴器1-3转动,联轴器1-3转动带动滚珠丝杠1-4转动,滚珠丝杠1-4转动带动丝杠螺母1-6及丝杠螺母底座1-7移动一定的距离,丝杠螺母底座1-7移动带动滑动片1-8移动进而改变短折叠杆1-13和长折叠杆1-12之间夹角使得履带机构2向管道中心轴靠拢或张开来适应大范围的管径变化。
当机器人转向时,由于每个履带机构2的电机2-10都是相互独立控制的,因此控制机构4可以对每个履带机构2进行调节,达到不同履带机构2的不同速度,因此可以实现其主动转向的功能,可以达到通过弯道管道和T形管道。
由于采用了所述运动控制方法,机器人通过对每个履带机构2的电机2-10都的调节,实现差速控制,控制了偏向距离始终小于卡死阈值,极大降低了机器人在运动过程中卡死在管道中的可能性。
Claims (10)
1.一种履带式管道机器人,其特征在于,包括变径机构、履带机构、感知机构和控制机构,三个履带机构压紧管道内壁且呈120度夹角分布在变径机构外侧,变径机构与三个履带机构连接,履带机构可相对于变径机构展开或收缩,所述感知机构安装在变径机构上,感知机构与控制机构相连,控制机构与变径机构、履带机构相连。
2.根据权利要求1所述的履带式管道机器人,其特征在于,所述变径机构包括预紧电机、预紧电机座、联轴器、滚珠丝杠、丝杠支撑板、丝杠螺母、丝杠螺母底座、固定杆,所述滚珠丝杠左右两端通过第一轴承安装在两块丝杠支撑板上,滚珠丝杠外侧平行设置三根呈120度夹角分布的固定杆,固定杆的一端固定在其中一块丝杠支撑板上,固定杆的另一端穿过另一块丝杠支撑板后与预紧电机座固定连接,预紧电机固定安装在预紧电机座上,预紧电机的输出轴通过联轴器与滚珠丝杠一端连接,滚珠丝杠两侧对称设置两个丝杠螺母底座,两个丝杠螺母底座外侧套设于三根固定杆上且可沿固定杆滑动,每个丝杠螺母底座内侧均固定设有一个丝杠螺母,两个丝杠螺母分别螺纹连接于滚珠丝杠两端,三个履带结构均通过伸缩连接件与丝杠螺母底座连接。
3.根据权利要求2所述的履带式管道机器人,其特征在于,所述伸缩连接件包括滑动片、固定支撑板、支撑架、长折叠杆、短折叠杆和压簧,两块固定支撑板相对设置且均固定套设于三根固定杆的中部,每根支撑杆的两端均套设一个压簧,压簧的一端固定在对应的丝杠螺母底座上,压簧的另一端与一个套设于固定杆上的滑动片固定连接,每个滑动片的两端分别与两个长折叠杆的一端铰接,每个长折叠杆的中点位置均与一个短折叠杆的一端铰接,短折叠杆的另一端与固定设置在固定支撑板上的支撑架铰接,每个长折叠杆的另一端均铰接在对应的履带机构上。
4.根据权利要求3所述的履带式管道机器人,其特征在于,所述履带机构包括橡胶履带、同步主动轮、第一同步从动轮、第二同步从动轮、齿轮、支撑杆、第一同步轮挡板、第二同步轮挡板、凸台同步轮挡板、外挡板、电机外挡板、电机、第一小同步轮、第二小同步轮、小履带、转动轴、第一限位轴和第二限位轴,所述外挡板和电机外挡板通过支撑杆连接,与滑动片两端相连的两个长折叠杆的另一端分别铰接在外挡板和电机外挡板上,一个同步主动轮和一个第一同步从动轮通过第一限位轴安装在第一同步轮挡板和凸台同步轮挡板之间两端位置组成第一同步轮组,两个第二同步从动轮通过第二限位轴安装在两个第二同步轮挡板之间两端位置组成第二同步轮组;电机安装在电机外挡板外侧一端,电机的输出轴穿过电机外挡板与外挡板连接,第一同步轮组位于外挡板和电机外挡板之间靠近电机一侧且第一同步轮组的第一同步轮挡板和凸台同步轮挡板穿设于电机的输出轴上,电机的输出轴上固定设有齿轮,齿轮与同步主动轮侧齿啮合,第二同步轮组的两个第二同步轮挡板通过转动轴安装在外挡板和电机外挡板之间远离电机一侧,凸台同步轮挡板外侧的凸台穿过外挡板和第一小同步轮,转动轴一端穿过外挡板并外露,第二小同步轮安装在转动轴的外露端,第一同步轮组和第二同步轮组啮合连接橡胶履带,第一小同步轮和第二小同步轮外侧啮合连接小履带。
5.根据权利要求3所述的履带式管道机器人,其特征在于:所述感知机构包括红外测距仪、摄像头、倾角检测单元、霍尔测速单元和薄膜压力传感器,所述红外测距仪、摄像头和倾角检测单元安装在所述丝杠支撑板上,每个压簧和滑动片接触面上设置有薄膜压力传感器。
6.根据权利要求5所述的履带式管道机器人,其特征在于:所述控制机构包括控制器、无线传输单元、蓄电池,所述控制器、无线传输单元、蓄电池安装在两个固定支撑板之间,所述蓄电池与控制器电连接,所述控制器分别与感知机构、电机、预紧电机电连接。
7.根据权利要求4所述的履带式管道机器人,其特征在于,所述固定支撑板中心开孔,不与滚珠丝杠接触,所述同步主动轮和第一同步从动轮通过第二轴承与限位轴连接。
8.根据权利要求4所述的履带式管道机器人,其特征在于,所述电机输出轴通过第三轴承与电机外挡板以及第一同步轮组连接;所述凸台同步轮挡板的凸台通过第四轴承与外挡板固定连接;所述转动轴通过第五轴承与电机外挡板以及外挡板连接。
9.一种如权利要求1-8中任一项所述的履带式管道机器人的运动控制方法,其特征在于,包括以下步骤:
步骤1:设定机器人的履带机构电机转速初值n0和卡死阈值K,作为给定值,发送给控制器,其中卡死阈值K为由机器人自身结构所决定的常值;
步骤2:控制器根据转速给定值,采用增量式PID算法,并对输出进行限幅处理,实现速度闭环控制,驱动履带机构的电机旋转;
步骤3:用红外测距仪和倾角检测单元实时采集机器人的行走姿态信息,红外测距仪测量在空间中三个履带机构前端中点到机体前端中心点的距离|OA|、|OB|、|OC|,倾角检测单元测量机器人中央机体与三个履带的相对角度θA、θB、θC,反馈给控制器;
步骤4:控制器把行走姿态信息进行计算处理,得到在管道截面上机体前端中心点与管道中心轴的偏向距离d以及偏向方向;
步骤5:在控制器中,将偏向距离d与卡死阈值K作比较,判断机器人是否有卡死的风险,偏向距离d大于卡死阈值K则有卡死的风险,如果有卡死的风险则执行步骤6,没有卡死的风险则返回步骤2;
步骤6:根据偏向距离d与卡死阈值K的偏差量和偏向方向,给出三个履带机构上电机各自新的转速给定值,进行差速控制,调整机器人行走姿态,重复步骤2至步骤5,控制偏向距离d始终小于等于卡死阈值K。
10.根据权利要求9所述的履带式管道机器人的运动控制方法,其特征在于,所述步骤4包括如下分步骤:
步骤4.1:对当前时刻行走姿态信息进行处理,将三个履带机构前端中点A、B、C与机体前端中心点O投影到点O所在的管道截平面上,利用如下公式在投影面上得到履带投影点a、b、c到机体前端中心投影点o的距离;
|oa|=|OA|cos2θA
|ob|=|OB|cos2θB
|oc|=|OC|cos2θC
步骤4.2:偏向方向由投影面上|oa|、|ob|、|oc|的大小确定,将oa、ob、oc的距离按从小到大顺序赋值给h1、h2、h3,利用如下公式计算出在投影面上机体前端中心点o与管道中心轴的偏向距离d;
式中,R表示管道内半径。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210290157.7A CN114458868A (zh) | 2022-03-23 | 2022-03-23 | 履带式管道机器人及其运动控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210290157.7A CN114458868A (zh) | 2022-03-23 | 2022-03-23 | 履带式管道机器人及其运动控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114458868A true CN114458868A (zh) | 2022-05-10 |
Family
ID=81416544
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210290157.7A Withdrawn CN114458868A (zh) | 2022-03-23 | 2022-03-23 | 履带式管道机器人及其运动控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114458868A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114960977A (zh) * | 2022-06-13 | 2022-08-30 | 中国建筑第二工程局有限公司 | 利用混凝土尾料封堵铝模层外墙螺杆洞的封堵机构及设备 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20040173116A1 (en) * | 2001-10-17 | 2004-09-09 | William Marsh Rice University | Autonomous robotic crawler for in-pipe inspection |
CN104477264A (zh) * | 2014-11-27 | 2015-04-01 | 浙江理工大学 | 一种可变平行四边形履带式管内移动作业机器人 |
CN207406986U (zh) * | 2017-07-27 | 2018-05-25 | 青岛海艺自动化技术有限公司 | 一种管道机器人 |
CN108980511A (zh) * | 2018-08-27 | 2018-12-11 | 大唐环境产业集团股份有限公司 | 一种新型管道机器人 |
CN109737267A (zh) * | 2019-01-16 | 2019-05-10 | 青岛理工大学 | 基于多传感器信息融合的管道检测机器人及方法 |
CN110440092A (zh) * | 2019-06-05 | 2019-11-12 | 天津大学青岛海洋技术研究院 | 一种履带支撑式管道内检测机器人驱动机构 |
CN113586840A (zh) * | 2021-07-28 | 2021-11-02 | 中国人民解放军陆军工程大学 | 一种可自适应管径及弯道的探测及抓取管道机器人 |
-
2022
- 2022-03-23 CN CN202210290157.7A patent/CN114458868A/zh not_active Withdrawn
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20040173116A1 (en) * | 2001-10-17 | 2004-09-09 | William Marsh Rice University | Autonomous robotic crawler for in-pipe inspection |
CN104477264A (zh) * | 2014-11-27 | 2015-04-01 | 浙江理工大学 | 一种可变平行四边形履带式管内移动作业机器人 |
CN207406986U (zh) * | 2017-07-27 | 2018-05-25 | 青岛海艺自动化技术有限公司 | 一种管道机器人 |
CN108980511A (zh) * | 2018-08-27 | 2018-12-11 | 大唐环境产业集团股份有限公司 | 一种新型管道机器人 |
CN109737267A (zh) * | 2019-01-16 | 2019-05-10 | 青岛理工大学 | 基于多传感器信息融合的管道检测机器人及方法 |
CN110440092A (zh) * | 2019-06-05 | 2019-11-12 | 天津大学青岛海洋技术研究院 | 一种履带支撑式管道内检测机器人驱动机构 |
CN113586840A (zh) * | 2021-07-28 | 2021-11-02 | 中国人民解放军陆军工程大学 | 一种可自适应管径及弯道的探测及抓取管道机器人 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114960977A (zh) * | 2022-06-13 | 2022-08-30 | 中国建筑第二工程局有限公司 | 利用混凝土尾料封堵铝模层外墙螺杆洞的封堵机构及设备 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107380291B (zh) | 多运动模态管道外壁攀爬检测机器人 | |
CN105318141B (zh) | 一种微型螺旋管道机器人 | |
US11965620B2 (en) | Pipeline patrol inspection robot having variable tracks and control method therefor | |
CN105135151A (zh) | 一种具有主动适应和自适应功能的履带式管道机器人 | |
CN108216519B (zh) | 一种面向海上油田井口平台导管架轮式移动机构 | |
CN104475405A (zh) | 容器及管道爬壁清理机器人 | |
CN113586840B (zh) | 一种可自适应管径及弯道的探测及抓取管道机器人 | |
Park et al. | Development of an actively adaptable in-pipe robot | |
CN103867848A (zh) | 一种螺旋驱动式管道机器人 | |
CN111776100B (zh) | 具有六连杆机构的外管道爬行机器人 | |
CN114458868A (zh) | 履带式管道机器人及其运动控制方法 | |
CN210971085U (zh) | 一种直驱式轨道行走装置 | |
Xu et al. | A wheel-type in-pipe robot for grinding weld beads | |
CN114234018A (zh) | 一种分离式管道检测机器人 | |
CN110953439A (zh) | 适应复杂管道的一体化机器人 | |
CN112097008B (zh) | 一种衬里复合管修形机器人 | |
Elankavi et al. | Kinematic modeling and analysis of wheeled in-pipe inspection mobile robot | |
CN112413284A (zh) | 一种压力自适应调节的管道机器人预紧机构 | |
CN116817084A (zh) | 一种可适用于不同管径的管道探伤机器人 | |
Oka et al. | A wheeled v-shaped in-pipe robot with clutched underactuated joints | |
CN216555977U (zh) | 用于地下管道清理自平衡自适应机器人的可变径行走机构 | |
CN110509738A (zh) | 基于地面封闭的六自由度串联支链腿 | |
CN206588579U (zh) | 螺栓紧固系统 | |
CN202115266U (zh) | 重载自驱动全向轮 | |
Choi et al. | Development of articulated robot for inspection of underground pipelines |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
WW01 | Invention patent application withdrawn after publication | ||
WW01 | Invention patent application withdrawn after publication |
Application publication date: 20220510 |