履带式核应急机器人攀爬台阶性能分析_程根茂.pdf

履带式核应急机器人攀爬台阶性能分析程根茂1，2，唐德文1，2，张德2，3（1.南华大学机械工程学院，湖南衡阳421001；2.核设施应急安全技术与装备湖南省重点实验室，湖南衡阳421001；3.南华大学资源环境与安全工程学院，湖南衡阳421001）摘要：针对核事故环境中核应急机器人的越障能力特点，设计了倒梯型履带式核应急机器人。与普通型履带结构相比，该机器人具有强越障性同时结构更加简单紧凑。张紧装置在机器人越障过程中可时刻让履带处于张紧状态，并且可以有效减小机器人所受到的冲击力。在此基础上，以攀越台阶为例对机器人进行数学模型计算分析，分析了机器人越障的临界条件与最大理论值。并用 RecurDyn 动力学软件建立仿真模型，对比分析机器人越障能力的理论值和仿真试验值，分析张紧装置对机器人爬越台阶稳定性的影响。结果验证了最大理论高度的准确性，为研究核事故环境下机器人越障性能提供了参考。关键词：履带机器人强越障稳定性中图分类号：TH16；U462.1；N94文献标识码：A文章编号：1003-773X（2023）02-0001-04引言在核事故环境下进行应急作业，核应急机器人的应用极为重要。而考虑到核事故环境的特点，要求机器人具备攀爬包含楼梯、障碍物等地形的强越障能力，这也是机器人能否顺利到达作业点最重要的要求之一。结合核事故环境下机器人作业的特点1，核应急机器人行走系统需要有着较好的越障能力和稳定性。并且强越障性与稳定性也是机器人行走系统的关键性能指标。结合核事故环境下作业地形特征，核应急机器人常用履带式行走系统2，履带式机器人相比于其他行走机构在越障能力、速度、结构复杂程度等方面都有一定优势3。机器人的结构设计、环境特点等因素都会影响履带式机器人越障稳定性4-5，其中在结构设计中，结构参数的选取对机器人的越障能力有着较大影响，所以选择合适的履带式行走系统非常重要。国内外对各种机器人越障性能分析、越障倾翻稳定性分析等方面进行了相关的研究6-10。其中在国内外较著名的是美国iRobot 公司研制的 Warrior 履带式核应急机器人11、日本千叶工业大学研制的 Quince 系列机器人12、中国辐射防护研究院研发的遥控式探测机器人13-14等。但是由于技术不太成熟，履带式机器人仍有些技术难点迫待解决，如结构复杂、不易转弯、机动性差等。因此，本文建立一种类似倒梯型履带式核应急机器人，研究分析机器人在攀爬台阶的越障性能。首先，理论分析机器人攀爬单极台阶时的最大理论越障高度，并通过给模型增加张紧装置来仿真分析张紧装置对机器人越障稳定性的影响，然后用 RecurDyn 动力学软件进行仿真验证。仿真结果验证了机器人的最大越障高度、张紧装置可以有效降低外界对履带板的冲击力，提高了机器人的整体稳定性。1机器人移动平台动力学建模结合核事故环境下机器人应急作业的环境特点，履带式机器人需要满足越障能力强、稳定性高、体型小、重量轻以及结构复杂程度等要求。故采用类似倒梯型的双履带结构，保留倒梯型机器人前进方向所带有履带的接近角，驱动轮位于机器人后端，相比于传统倒梯型双履带结构，既保证了倒梯型双履带机器人的越障性能，还简化了机器人整体结构的复杂性，能使结构更加紧凑和稳定性更高。履带式移动平台结构，如图 1 所示。平台结构包括驱动轮、支重轮、托带轮、履带架、履带板、张紧装置、导向轮。机器人主体前端保留倒梯型的结构特点，在机器人攀越台阶时由带有角度端首先接触障碍物，提高了机器人的越障性能；机器人的动力系统采用后置的方式，可以有效避免机器人在越障时惯性冲击对电机的影响。缺点就是部分降低了履带行走系统的传动效率。倒梯型履带式核应急机器人参数，如下页表1 所示。为了保证不同环境下履带系统的稳定运行，防止收稿日期：2022-08-19基金项目：国防基础项目（JCKY2019403D003）；湖南省教育厅科学研究项目（19B502）；衡阳市科技创新重大项目（202150013986）；湖南省教育厅项目（212JSJ002、2018JG026）第一作者简介：程根茂（1997），男，安徽阜阳人，南华大学机械工程学院在读硕士，研究方向为机器人技术。通讯作者：唐德文（1976），男，湖南邵阳人，博士，教授，博士生导师，研究方向为高速加工与超硬材料加工技术、先进制造技术与核电装备技术。总第 238 期2023 年第 2 期机械管理开发MechanicalManagementandDevelopmentTotal 238No.2，2023DOI:10.16525/14-1134/th.2023.02.001试验研究机械管理开发第 38 卷出现打滑现象，提高履带行走系统的整体稳定性，可应用张紧装置，其能有效地在机器人越障过程中调节履带板的受力，防止出现履带脱落的情况。一般平均轨道张紧力是张紧器弹力的 50%，所以可以通过调节张紧弹簧的预紧力来调整履带板所受轴向力。选取各部件的摩擦系数为 0.7。履带板与路面接触参数如表 2 所示。在前轮与箱体之间设立了张紧装置（如图 2 所示），其中图 2-1 为装有履带张紧装置，图 2-2 禁用了张紧装置，并与履带支撑架锁死防止移动。履带张紧装置不仅可以使机器人的履带时刻紧密地缠绕在带轮上，避免了履带松弛或脱落，还可以在越障过程中部分减少对机器人的冲击，提高了机器人的越障性能与整体稳定性。张紧弹簧的参数如表 3 所示。2机器人攀爬台阶理论分析以攀爬台阶为例，对机器人进行越障性能分析。机器人行走系统在攀越台阶过程中，当机器人的综合质心所在位置的竖直线和台阶外角线在同一竖直线上时，机器人达到临界状态，此时质心位置必须在竖线右侧才能完成攀爬过程。如图 3 所示为机器人数学模型，建立空间坐标系 xO1y，设主履带轮心 O1、O2的间距为 L1，质心 G 坐标为（xG，yG）；O2、O3为机器人的前轮和张紧轮的轮心，主履带轮半径为 R1，机器人后端和地面间的夹角为 1，台阶的高度为 H，求得函数如下：H（xG，yG，1）=R1+xGsin1+yGcos1-yG+R1cos1.（1）为了提高理论分析的准确性，需让机器人后端与台阶接触，故 1应在（0，/2）上取值，当机器人质心为参变量时，H（xG，yG，1）分别对 xG、yG求偏导可得：H/xG=sin10.（2）H/yG=-sin21cos10.（3）由于 1（0，/2），所以由式（2）、式（3）可得，H（xG，yG，1）为关于 xG的增函数，关于 yG的减函数。通过式（2）、式（3）得知，当 xG的值越大、yG的值越小，即机器人的质心靠前、偏下时，机器人攀越台阶的最大高度 Hmax越大。对 H（xG，yG，1）求 1的一次、二次偏导得：H/1=xGcos1-yGsin1-（yG+R1）sin1cos21.（4）2H/12=-xGsin1-yGcos1-（yG+R1）sin21+cos1cos31.（5）因为二阶偏导2H/120，（1（0，/2），确定 H（xG，yG，1）有最大值，当且仅当一阶偏导H/1=0 时，可求出 Hmax。将表 1 中的机器人各参数带入式（1）、式（4）、式（5）中，求出机器人质心坐标为（560，40），当 1=43.5时，机器人的最大越障高度 Hmax=258.6 mm，即该机器人攀越台阶最大理论高度为 258.6 mm。3RecurDyn 仿真分析为了验证分析机器人的越障性能，在 RecurDyn的 TL 模块（低速履带）中建立虚拟样机模型，并分别建立高度不同的台阶，根据理论数据对机器人进行了仿真验证，通过研究机器人在不同高度下台阶的仿真数据，分析机器人爬楼梯时的越障性能。1驱动轮；2支重轮；3托带轮；4履带架；5履带板；6张紧装置；7导向轮图 1履带式核应急机器人履带系统参数数据参数数据底盘长度/mm1 000底盘高度/mm400底盘宽度/mm700最大速度/（m s-1）1.4轮半径/mm110/70自重/kg95履带宽度/mm150接地长度/cm74表 1倒梯型履带式核应急机器人参数刚度/（N mm-1）阻尼/（N s mm-1）自然状态长度/mm预紧力/N0.1100703 000表 3履带张紧弹簧参数2-1装有履带张紧装置2-2禁用了张紧装置图 2机器人履带系统张紧装置设置类型刚度/（N mm-1）阻尼/（N s mm-1）摩擦系数1 5000.10.7表 2履带板与路面接触参数图 3攀越台阶临界状态示意图1234567右履带左履带O1O2O3O412HGyx22023 年第 2 期机器人攀爬台阶的详细过程如图 4 所示，在攀越台阶过程中，机器人呈一定角度的履带前端率先与台阶接触，可以很大程度较少履带与台阶发生打滑现象。3.1机器人攀爬楼梯极限高度仿真验证在 RecurDyn 中分别建立不同高度台阶的路面模型（统一爬越 4 层台阶楼梯），底盘采用低速挡进行纵向爬楼梯，为了仿真分析的准确性，速度函数统一设定（STEP（TIME，0.1，0，0.5，360D），经过多次仿真试验，通过仿真分析观察履带底盘在爬坡过程中驱动轮力矩、质心 Y 方向位移变化规律。如图 5 所示，机器人在 0.5 s 履带接触楼梯到 1 s机器人开始攀爬第一层台阶，由于机器人在攀爬较高台阶初始阶段会有一段时间履带前端未与第二层台阶接触，此阶段若机器人质心位于第一层台阶竖直外角线右侧时，机器人靠自身重量使机器人整体与楼梯接触完成攀爬过程，相反机器人则会发生侧翻。由图 5 得到，机器人攀爬台阶的极限高度Hmax=262 mm。在仿真中越障高度比之前计算的理论值 258.6 mm略大，这是因为机器人的履带和路面都不是刚体，具有一定的弹性，所以在越障过程中履带会产生形变会使得机器人的实际重心位置比理论值偏低，结合上述对机器人的理论分析，该情况会有助于机器人攀越台阶。由图 6-1、图 6-2、图 6-3 可知，机器人在攀爬台阶时受到较大的冲击分别发生在机器人开始攀爬台阶（0.51.5 s）和攀爬结束时（44.5 s）。在 1.54.5 s过程中，随着台阶高度的增加，机器人在攀爬过程中稳定性降低；由图 6-4 可知，在台阶高度为 263 mm时，机器人发生了侧翻，机器人的最大转矩发生在侧图 4机器人攀爬台阶过程图 5攀爬过程质心 Y 方向位移变化6-1台阶高度为 250 mm6-2台阶高度为 260 mm6-3台阶高度为 262 mm6-4台阶高度为 263 mm图 6攀爬不同高度台阶行走系统驱动力矩1 5001 00050000123456时间/s质心 Y 向位移/mm台阶高度 H=250 mm台阶高度 H=260 mm台阶高度 H=262 mm台阶高度 H=263 mm3105210511050-1105-2105力矩/（N mm）0123456时间/s3105210511050-1105-2105力矩/（N mm）0123456时间/s3105210511050-1105-2105力矩/（N mm）0123456时间/s810571056105510541053105210511050-1105-2105力矩/（N mm）0123456时间/sabcdefgh程根茂，等：履带式核应急机器人攀爬台阶性能分析3机械管理开发第 38 卷翻后。3.2张紧装置对机器人行走系统越障稳定性的影响为了进一步验证履带张紧装置对机器人越障性能的影响，以机器人爬越 4 层 250 mm 台阶为例，分别对装有张紧装置、未装张紧装置的机器人攀爬台阶的稳定性进行分析。通过对比分析图 7-1 与图 7-2 可知，装有张紧装置的机器人在攀爬过程中履带板的受力更加稳定，在4.24.7 s 过程中，履带板受轴向力矩减小，这是因为履带板与驱动轮接触会有短暂的减小。并且可以看出在 2 s 之后，履带板轴向平均力矩为 1 500 N mm，为张紧器弹力的 50%，仿真结果与理论一致。对比分析图 8-1 和图 8-2 可知，机器人受较大冲击发生在开始攀爬台阶与结束攀爬台阶两个阶段，在1.54.5 s 过程中，装有张紧装置的机器人攀爬台阶过程稳定性更高。并结合上述对履带板受力的仿真分析，说明张紧装置可以有效降低外界对履带板的冲击力，提高机器人的整体稳定性。4结语本文所提出的类似倒梯型履带式核应急机器人相比于传统的双角度式机器人除保留了强越障能力之外，结构更加简单紧凑。并分析了该机器人在攀越台阶过程中质心对越障性能的影响。对机器人攀爬台阶的性能进行了理论分析，得出机器人攀越台阶的最大理论高度，并仿真验证了最大越障高度，分析了机器人在有、无张紧装置两种情况下攀爬楼梯的稳定性，仿真结果表明张紧装置在机器人越障时可以有效降低机器人受到的冲击力，避免履带松弛或脱落的情况，提高机器人结构的稳定性，为研究核事故环境下机器人越障稳定性提供了参考。参考文献1张齐昊，赵伟，褚胜男，等.耐辐照核应急机器人研究现状及关键技术分析J.核科学与工程，2019，39（4）：629-645.2陈松松，李允旺，李彬，等.具有柔性悬架的履带式移动底盘设计及其越障机理分析J.中国科技论文，2016，11（16）：1813-1816.3朴春日，颜国正，王志武，等.一种履带式机器人设计及其越障分析J.现代制造工程，2013（3）：24-27.4MATTH IESL，XIONGY，HOGGR，et al.Aportable,autonomous,ur-ban reconnaissance robot J.Robotics and Autonomous Systems，2002，40（23）：163-172.5信建国，李小凡，王忠，等.履带腿式非结构环境移动机器人特性分析J.机器人，2004，22（1）：35-39.6李允旺，葛世荣，朱华，等.四履带双摆臂机器人越障机理及越障能力J.机器人，2010，32（2）：157-165.7翟旭东，刘荣，洪青峰，等.一种关节式履带移动机器人的爬梯机理分析J.机械与电子，2010（1）：62-65.8宗成国，刘纪新，于岩，等.关节式双履带移动机器人越障稳定性分析J.科学技术与工程，2020，20（10）：4 004-4 008.9张德，邹树梁，唐德文，等.基于 RecurDyn 的防辐射履带式挖掘机越障性能研究J.机械设计与制造，2015（5）：83-88.10邹树梁，刘昌福，王湘江，等.双履带式巡检机器人翻越圆管能力分析J.机械设计与制造，2020（1）：270-273.11TEPCO.National Project Development of a Remote Controllable De-contamination Technique inside the Reactor Buildings D B/O L.（2013-12-18）2018-08-29.12Nagatani K，Kiribayashi S.，Okada Y，et al.Emergencyresponse tothenuclear accident at the FuKushima Daiichi nuclear power plants us-ing mobile rescue robotsJ.Journal of Field Robotics，2013，30（1）：44-63.13沈华亚，朱万宁，董强敏，等.耐强辐射遥控探测机器人研制J.核电子学与探测技术，2015，45（1）：74-78.14陈法国，朱万宁，董强.遥控机器人耐辐射设计和测试J.核电子学与探测技术，2016，36（2）：121-124.（编辑：李俊慧）7-1无张紧装置7-2有张紧装置图 7攀爬过程履带板轴向力矩8-1无张紧装置8-2有张紧装置图 8攀爬过程中驱动力矩1 2001 00080060040020000123456时间/s力矩/（N mm）3 5003 0002 5002 0001 5001 0005000力矩/（N mm）0123456时间/s3105210511050-1105力矩/（N mm）0123456时间/s3105210511050-1105-2105力矩/（N mm）0123456时间/s（下转第 7 页）42023 年第 2 期本数据变更归一方式，分别采用线性、对数和反余切函数分别对数据重新进行归一化，完成同样的训练后再用相同的故障事件检验识别能力，比较训练效果见表 3。从故障识别能力检验中可见，在样本有限的前提下，归一化处理所用的方法对训练得到的识别能力影响极大，采用高斯函数实现归一化在训练效率上具有明显优势。主控模块 B 和模块 C 的故障诊断训练方式及其训练后具备的故障识别能力与主控模块 A 类似，故不再赘述3-4。4结语本文针对某型无人潜水器的自动操舵仪的控制结构进行了讨论，提出了一种基于 RBF 神经网络的诊断模型。模拟事件数据测试显示，这种故障诊断方法在样本有限的前提下能够较好实现故障识别诊断。其不足之处在于故障诊断识别能力的进一步提升需要大量的故障样本用于神经网络事件，因此对于历史故障数据不足的新研设备领域识别能力有限，必须结合其他的方法同步开展故障诊断。参考文献1黄利华，于俊，王长杰，等.低噪声工况下潜艇自动舵控制策略研究J.舰船科学技术，2011，33（8）：24-26.2王晓靖.潜艇自动操舵系统J.舰船导航，2001（3）：13-15.3刘百顺，徐玉如.基于神经网络的船舶自动舵设计J.海洋工程，2002，20（1）：28-30.4刘胜，刘业明.潜艇位姿控制系统故障诊断研究J.自动化技术与应用，2009（9）：51-52.（编辑：贾娟）序号Y1Y2Y3Y4Y5诊断效果 实际故障1-0.095 8 0.009 2-0.040 2 0.000 6 0.010 1 无故障点 无故障点20.122 5-0.034 2 0.088 1-0.036 2 0.000 2Y1无故障点30.000 2 0.000 1-0.000 2-0.000 1 1.000 0Y5Y5400001.000 0Y5Y550001.000 00Y4Y460.014 7 0.026 6-0.005 9 0.969 9 0.018 7Y4Y47-0.003 7-0.000 3 0.997 0 0.005 9-0.000 7Y3Y380.043 4 0.997 00.803 2 0.148 7 0.014 0Y3Y39-0.079 7 1.000 0-0.027 3-0.004 7-0.001 5Y2Y2100.065 6 0.931 10.070 8-0.024 0 0.031 9Y2Y2110.997 0-0.008 4-0.011 4-0.015 5 0.011 2Y1Y1120.985 3-0.013 0 0.044 0-0.020 7-0.001 9Y1Y1表 2诊断测试序号数据预归一方式 诊断案例数量诊断正确数量 诊断正确率/%1线型归一法12433.32高斯函数121191.73对数函数12650.04反余切函数12541.7表 3归一化效果对比Fault Diagnosis Study of Submersible Automatic Steering Gear Based on Neural NetworkLi Xiangyuan,Huang Hao,Li Hai（Wuhan Marine Machinery Co.,Ltd.,Wuhan Hubei 430084）Abstract:The analysis of the functional structure of a type of submersible automatic steering gear was carried out,based on which a faultdiagnosis process based on RBF neural network was designed,the neural network was trained using historical fault event database data,and the fault event data was used to test the diagnostic recognition capability,and a new idea was proposed for the fault diagnosisrecognition of submersible automatic steering gear.Key words:automatic steering instrument;fault diagnosis;RBF neural network;Gauss functionPerformance Analysis of Climbing Steps of Crawler Nuclear Emergency RobotCheng Genmao1,2,Tang Dewen1,2,Zhang De2,3（1.School of Mechanical Engineering,South China University,Hengyang Hunan 421001;2.KeyLaboratory of Emergency Safety Technology and Equipment for Nuclear Facilities in Hunan Province,Hengyang Hunan 421001;3.School of Resource,Environment and Safety Engineering,South ChinaUniversity,Hengyang Hunan 421001）Abstract:According to the characteristics of the obstacle-surmounting ability of the nuclear emergency robot in the nuclear accidentenvironment,an inverted ladder crawler-type nuclear emergency robot is designed.The tensioning device can keep the crawler in a state oftension at all times when the robot is over obstacles,and can effectively reduce the impact force on the robot.On this basis,taking climbingsteps as an example,the mathematical model of the robot is calculated and analyzed,and the critical conditions for the robot to overcomeobstacles are analyzed at the maximum theoretical value.A simulation model is established with RecurDyn dynamics software,and thetheoretical value and simulation test value of the robots ability to overcome obstacles are compared and analyzed,and the influence of thetensioning device on the stability of the robots climbing steps is analyzed.The results verify the accuracy of the dynamic model and providea reference for studying the stability of the robot over obstacles in the nuclear accident environment.Key words:tracked robot;strong obstacle surmounting;stability（上接第 4 页）李相远，等：基于神经网络的潜水器自动操舵仪故障诊断研究7