文章首先对蛇形机器人的行走关节机构单元模块进行了设计,在不同的燃气管径中以直行或螺旋的形式进行勘察任务.利用ADAMS软件进行了受力分析,并通过软件仿真了蛇形机器人在竖直管道内壁攀爬的效果.文章对基于STM32的小型管道探测蛇形机器人的控制系统进行了设计,并对其控制器进行了设计与开发,采用分布式控制通过该控制器输出的PWM信号控制蛇形机器人在不同的管径内实现自由的前进、后退和转弯等,该控制器可实现对蛇形机器人的姿态、管道内部图像、可燃气体浓度等信息的获取和处理.对管道探测蛇形机器人控制系统框架的搭建、控制方法、控制器原理、硬件电路图及软件的设计,对上位机显示界面进行了配置,经测试各功能符合要求.
In this paper,the moving joint mechanism unit module of the snake-shaped robot is designed first,and the survey task is carried out in the form of straight or spiral in different gas pipe diameters. The force analysis was carried out by using ADAMS software,and the effect of the snake-shaped robot climbing on the inner wall of the vertical pipe was simulated by software. In this paper,the control system of small pipeline detection snake robot based on STM32 is designed,and the controller is designed and developed. The distributed control is used to control the snake robot in different diameters through the PWMsignal output by the controller. The controller realizes the free advance,retreat and turn,etc. The controller can realize the acquisition and processing of the posture of the snake-shaped robot,the image of the inside of the pipeline,the concentration of the combustible gas and the like. The construction,control method,controller principle,hardware circuit diagram and software design of the pipeline detection snake robot control system frame are configured. The upper computer display interface is configured,and the tested functions meet the requirements.
serpentine robot; spiral advance; control system; software and hardware design; inspection and maintenance;
蛇形机器人是一种新型的柔性机器人,可用在各种探测任务中.目前燃气管道正在日益增加,而燃气管道往往深埋地下,经过长期的土壤腐蚀或不可抗拒的自然灾害必将老化,出现泄漏、爆炸等安全事故,鉴于此,我们开发的这款蛇形机器人可在各类燃气管道中进行检测任务.燃气管道的直径从200mm-500mm不等,有的管道的直径甚至更小.目前可以在管道中进行巡查的机器人多为轮式机器人,这种机器人只适合在较粗的管道中进行探测,而在较细管道中无法进入,并且在竖直管道中也显的无能为力.
为克服上述技术和环境适应性的不足,我们提出了一种利用蛇形机器人检测燃气管道内部环境的方法.蛇形机器人因身体细长,横截面小,灵活性强,适应环境等优点
与以往管道外部的蛇形机器人不同,该机器人在管道内部运动对本身的关节不可见,所以行走机构有所不同.首先为了适应燃气的圆形管道,蛇关节外部为圆形,其圆形关节外部两端装有两组小车轮,均为从动轮,在模块中添加一个电机并使用齿轮传动,带动后端车轮转动,进而推动机器人前进.其从动轮主要是为了能平滑行走
关节内部主要包括俯仰舵机、旋转舵机、控制器和一些连接件.图中俯仰舵机通过U型连接件固定后准备与下一个关节相连,另一侧也为一个U型连接件,该连接件与电机相连,终电机带动主动轮向前或向后运动,而舵机通过旋转角度控制整个蛇以螺旋方式前进.在不影响舵机旋转的情况下,控制器放置在舵机与电机连接的侧面,为了保证蛇关节较小,经测控制器大小(6.24cm×6.24cm)为预留的空隙大小.经输出的PWM信号控制俯仰舵机和旋转舵机,在旋转舵机下方是固定件,固定舵机在关节内不晃动,我们可以看到在其下方有预留位置,可以放置传感器和一些连接器件.
在建立ADAMS仿真环境后,针对不同管径的竖直管道进行了建模分析,由于我们的蛇关节是可拆卸的,在不同管径中,使用不同多少的单元模块即可完成在管道内部的检测任务,终使关节按照一定的角度螺旋前行.
和水平运动的管道中比较,在竖直管道中蛇的所有关节重量都是蛇向上攀爬的阻力,所以比水平管道有更大的竖直向上动力才能推动蛇向上爬.
如图2是蛇形机器人在250mm的竖直管道中,从下向上依次将关节起名为J1-J7,选取特殊的关节进行受力分析,规定蛇向上运动方向为Z轴,垂直于显示面为X轴,同时垂直于X和Z轴方向为Y轴.首先选取J1进行受力分析,如图3所示,J1共受四个力的作用,地面对J1的引力G1(方向沿Z轴负方向竖直向下),管壁对J1的支持力Fz1(方向垂直指向于接触面凹面)和管壁对J1的摩擦力Ff1(方向沿着蛇运动趋势的反方向),相邻关节J2对J1的作用力FJ2-J1.其中每个关节共重为380g,所有受力在全局坐标系下进行受力分解得到静力学平衡方程:
从ADAMS中可输出各个力在X轴、Y轴和Z轴上分力的大小,其中Ff1x=5.6N,Fz1x=8.6N,FJ2-J1x=-14.2N.Ff1y=15.8N,Fz1y=-9.7N,FJ2-J1y=-6.1N.Ff1z=-12.1N,G1=0.38*9.8=-3.7N,Fz1z=4.8N,FJ2-J1z=11N,由以上输出的力大小可以看出蛇形机器人满足静力学平衡方程.
通过对管道蛇形机器人的建模仿真,设置好关节的质量、关节之间的扭矩,还可以得到关节之间力矩、旋转的相对角速度等,另外也可以得到蛇在管道内部运动的位移、速度、加速度、相对角速度、相对加速度等值.在250mm的管道中对蛇形机器人进行仿真得到运动的速度、加速度、位移、角速度,由仿真结果图可以看出机器人在管道内重复的以螺旋方式缓慢前行.
探测机器人控制系统的功能是将各个执行机构如舵机、电机等的控制以及各类传感器采集的数据传输控制整合到上位机中,实现操作人员的远程控制功能
在操作人员电脑端,设计使用组态王软件编译上位机监控系统,并与机器人主控制系统相联,由操作人员在上位机监控系统中,发送控制指令,控制探测机器人的姿态及运动等,如控制各单元模块中舵机的转角,达到控制机器人姿态的目的;控制电机的转动,达到控制器机器人的前进后退旋转等目的;控制传感器数据传输,达到采集管道内各项信息的目的等.上位机向下连接由微控制器控制的主控器单元,主控器通过CAN总线连接多个从控制器,使探测机器人具备良好的可扩展性,每个模块均由一个俯仰舵机和一个旋转舵机组成,所以每个模块中有两个从控制器分别控制俯仰舵机和旋转舵机,同时CAN总线也能够满足探测机器人的实时性要求.探测机器人的从控制器采用嵌入式单片机技术,并将探测机器人中应用到的执行机构,如伺服舵机,电机,以及传感器设备搭载在从控制器上,使得每个嵌入式单片机可以独立处理单个单元模块的运动,提高系统的稳定性和实时性.形机器人控制系统整体框架如图4.
根据蛇形机器人的特点,文章构建了以CAN总线为基础的蛇形机器人控制系统.控制系统的上层设计为上位机监控系统
在蛇形机器人的蜿蜒运动控制中为例,分析它的控制方法.图5是蜿蜒运动的模型,蛇体相邻关节的相对转角可用公式(1)表示机器人的运动状态:
式中α0表示蜿蜒运动的初始角度,n代表机器人的单元模块数量,l表示单元模块长度,L表示机器人的整体长度,Kn表示蜿蜒运动时传播的波的个数,K1表示蛇形机器人运动曲线的曲率偏差,s表示蛇形机器人后部尾关节沿运动曲线轴线方向的虚位移,i表示蛇形机器人中的任意关节,VL表示扰动速度,Vd表示目标速度.
蛇形机器人运动控制的基本方法是通过改变相邻单元关节之间的相对转角来控制蛇形机器人的运动姿态,上式表明了蛇形机器人虚位移与各相邻单元关节间相对转角φi的关系.当虚位移s在蛇的运动过程中,随时间变化而改变时,各个模块的关节转角也随之发生改变,进而实现蛇形机器人的连续运动.在控制系统中,不断根据s的变化来实时计算关节转角,后通过驱动信号使执行舵机完成角度变换.
分布式控制将各个关节的转角计算等运算问题分布在各自的从控制器上.主控制器将运动控制函数中的s变量,通过CAN总线网络传递给各个单元关节的从控制器,由各自关节的从控制器自主计算自身关节的变换角度,并在完成全部运算后向主控制器发送一个确认信号,如图6.根据蛇形机器人运动控制函数的特点,可以看出主要的计算变量是s和i在确定了单元关节中的硬件系统及各项参数之后,每个单元关节的i,对本关节从控制器来说是确定的,它只需要在CAN总线上,获取主控制器发送的s变量,即可由自己根据算法来计算所需改变的角度.主控制器在接收到总线上所有的单元关节的完成计算确认后,发送一个同步信号,各单元关节根据同步信号,统一开始调整自身姿态,以实现蛇形机器人的运动调整.
采用分布式控制方式,将各关节的相对转动角度计算交由各自从控制器来完成,这样对主控制器的资源占用大大的降低,也可使节约出资源来处理如其他参数计算,运动规划等任务
控制器以STM32微处理器为核心,姿态传感器将蛇形机器人实时的姿态解算并发送给STM32主控芯片,主控芯片将信息上传到上位机并实时显示其俯仰角,横滚角和航向角,使管理者或使用者实时掌握蛇形机器人的运动情况
舵机是管道探测蛇形机器人构成中重要的组成部分之一,其驱动信号是由主芯片输出的PWM信号来控制,高低电平是一种周期一定,占空比可调的方波,可以通过一个低通滤波器进行解调,通过控制脉冲宽度即可控制舵机旋转角度,舵机通过外部供电,当接收到主控制器发送的PWM信号时,蛇形机器人的各个关节开始运动.所选舵机型号为RDS3115M G,小巧且重量只有60g,尺寸大小为40×20×40.5mm,工作电压4.8-7.2v,堵转扭矩为15kg/cm.
蛇形机器人共有14路舵机需要同时控制
表1 定时器PWM信号通道与舵机对应表
Table 1 Timer PWM signal channel and servo correspondence table 下载原表
舵机与外界连接线有三端,分别是电源线、地线和控制线,其中只有控制线与控制器相连,由上位机下传指令给控制器,控制器产生的PWM信号传输给舵机,经电路板上的IC处理后计算出转动方向,再驱动马达转动,透过减速齿轮将动力传至摆臂,同时由位置检测器(电位器)返回位置信号,判断是否已经到设定位置.舵机控制需要一个高电平时基脉冲,该脉冲一般为0.5ms~2.5ms的角度控制脉冲.舵机转过的角度为输入脉宽控制,我们的舵机能在安装固定件和连接件之后以225度的角度旋转,其对应的控制关系是这样的:0.5ms—0度;1.0ms—45度;1.5ms—90度;2.0ms—135度;2.5ms—180度;3ms—225度;舵机控制模块工作流程图如图7所示.
舵机通电启动之后,定时器开始初始化,控制器开始检测舵机旋转标志位是否等于1.若为1,表示有控制舵机的信号传入,然后清零标志位,开始比较舵机实际位置与目标位置偏差,将偏差信号上传至控制器来调整PWM信号,进而更好地控制舵机.
通过排针的端子与TJA1050收发芯片相连,之后由接线端子(CAN)与外部的CAN总线相连.由于CAN和USB是共用PA11和PA12端口,所以用CAN传输时,要将开发板P9上的PA11和PA12用跳线帽分别与CAN_RX和CAN_TX相接.
将所选舵机供电之后,并与控制器相连,由于我们设计的控制器是同时输出多路PWM,即控制多路舵机协调工作,设置控制舵机角度程序并下载到控制器,经测试控制器可精确控制舵机角度,基本实现蜿蜒运动.控制器如图8所示.
文章为分布式控制,将设计好的小型控制器嵌入到蛇的每一节关节中,其中蛇头为主控制器,其余关节为从控制器,蛇形机器人控制器通过CAN总线连接到上位机,并根据需求完成上位机(组态王)显示界面设计.经调试后,在组态王按键和视频插件中编写脚本语言来实现所需功能,可在组态王视频显示区实时查看蛇形机器人拍摄的管内周围环境,并可以实现缩放、拍照及保存功能.随着蛇形机器人的运动,可以实时显示蛇关节的俯仰角、横滚角和航向角.同时,安装在蛇身上的温度传感器和甲烷浓度传感器等也将管内参数实时上传至上位机显示.由于在实验室测试并没有甲烷,所以甲烷浓度显示0%,另外可以将蛇身上面的温度传感器值上传到组态王并实时显示,如图9所示为蛇形机器人实物及上位机界面.
利用蛇形机器人的灵活性和可拆卸性,通过控制调整舵机的转角,使蛇形机器人不仅可适应大管径也可适应小管径进行探测,不仅可以在管道内部进行水平探测,并通过螺旋方式可以向上攀爬达到探测竖直管道的效果,即使在管径较小的管道中,蛇形机器人也可以以直线的方式进行穿管并探测.文章对管道探测的蛇形机器人的控制系统进行了设计,对控制器进行了设计与开发,该控制器小巧、灵活,有效减小了蛇关节的大小,其上搭载的各类传感器和通信接口均合理分配,可实时控制蛇的姿态以及实时检测管道内的周围环境、温度等.
目前在燃气管道中的探测蛇形机器人是没有先例的,在燃气管道铺设越来越多的今天,利用蛇形机器人可以大大提高检测效率如燃气泄漏等问题.
[3] 王毅,邵磊.管道检测机器人新发展概况[J].石油管材与仪器,2016,2(4):6-10.
[4] 曹建树,徐宝东,刘强,等.支承轮式管道机器人变径机构动力学分析[J].新技术新工艺,2015,(2):87-90.
[5] 王家栋.仿生蛇形机器人的导航与控制[D].杭州:浙江大学,2019.
[6] 肖朋振,刘爽.小型有缆无人水下机器人控制系统设计[J].小型微型计算机系统,2019,40(2):451-455.
[7] 林维河.基于姿态规划的攀爬蛇形机器人研究与实现[D].广州:华南理工大学,2015.
[8] 刘怀,黄建新.一类分布式控制系统中带有优先约束的周期性任务容错调度方法[J].小型微型计算机系统,2016,37(4):830-834.
[9] 田路.蛇形机器人的机构设计及控制系统研究[D].北京:北京化工大学,2017.
[12] 应利伟.蛇形机器人的头部控制器研制[D].哈尔滨:哈尔滨工业大学,2017.
[13] 王生栋.蛇形机器人结构设计与运动控制研究[D].哈尔滨:哈尔滨工业大学,2016.
[14] 王健,魏武.缆索检测蛇形机器人控制系统设计[J].计算机测量与控制,2010,18(10):2312-2314+2322.
[15] 张珂,郭栋,秦文甫.基于STM32的小型化伺服控制器设计[J].微特电机,2016,44(5):83-86.
[16] 牛国臣,张云霄.基于STM32的24路舵机同步控制系统设计[J].现代电子技术,2019,42(10):151-155.
文章转自中国知网,如有侵权,联系删除。
地址:青岛市西海岸新区海滨工业园香海路168号
手机:13806390681 服务热线:0532-86131102
邮箱:qdhengchangkeji@163.com
鲁ICP备18013584号