基于ROS的消毒机器人控制系统设计与实现

2021年6月电器触点
第49卷第11期
机床与液压
MACHINETOOL&HYDRAULICS
Jun 2021
Vol 49No 11
DOI:10.3969/j issn 1001-3881 2021 11 004
本文引用格式:刘小军,温宏愿,周军,等.基于ROS的消毒机器人控制系统设计与实现[J].机床与液压,2021,49(11):17-21.
LIUXiaojun,WENHongyuan,ZHOUJun,etal.Designandimplementationofcontrolsystemofdisinfectionrobot
basedonROS[J].MachineTool&Hydraulics,2021,49(11):17-21.
收稿日期:2020-04-07
基金项目:2018年江苏省高校 青蓝工程 项目-优秀青年骨干教师(201812);江苏省 六大人才高峰 资助项目
(XYDXX-257);2019年江苏省高等教育教改研究项目(2019JSJG539);2018教育部产学合作协同育人项目(201801141026);江苏省高校 青蓝工程 优秀教学团队项目(2020)
作者简介:刘小军(1982 ),男,硕士,高级工程师,主要研究方向为智能机器人控制与应用㊂E-mail:93429706@qq com㊂
基于ROS的消毒机器人控制系统设计与实现
刘小军,温宏愿,周军,崔宇豪
(南京理工大学泰州科技学院智能制造学院,江苏泰州225300)
摘要:针对公共卫生领域消毒机器人存在开发成本高㊁维护性差等问题,提出一种基于机器人操作系统(ROS)的消毒机器人控制系统方案㊂该方案基于分层控制的理念将消毒机器人的控制系统分为
用户层㊁决策层以及执行层,各层次功能明确,耦合性低㊁复用性好㊁灵活性高㊂用户层主要用来接收用户的应用指令,起到人机交互的作用;决策层主要承担机器人语音识别㊁定位与导航㊁路径规划等核心预算;执行层主要执行决策层发送过来的控制指令,控制机器人运动以及消毒工作㊂试验结果表明,该控制系统具有可靠性高㊁灵活性好㊁低成本等优点㊂
关键词:消毒机器人;ROS;分层控制;即时定位与地图构建;路径规划中图分类号:TP242
DesignandImplementationofControlSystemofDisinfectionRobotBasedonROS
LIUXiaojun,WENHongyuan,ZHOUJun,CUIYuhao
(SchoolofIntelligentManufacturing,TaizhouInstituteofSci.&Tech.,NanjingUniversityof
Science&Technology,TaizhouJiangsu225300,China)
Abstract:Aimingattheproblemsofhighdevelopmentcostandpoormaintenanceofdisinfectionrobotin
publichealthfield,acontrolsystemschemefordisinfectionrobotwasproposedbasedonrobotoperatingsystem(ROS).Basedontheconceptofhierarchicalcontrol,thecontrolsystemofthedisinfectionrobotwasdividedintouserlayer,decision⁃makinglayerandexecutivelayer.Eachlevelhadclearfunctions,lowcoupling,goodreusabilityandhighflexibility.Theuserlayerwasmainlyusedtoreceivetheuser sapplicationinstructionsandplaytheroleofhuman⁃computerinteraction.Thedecision⁃makinglayerwasmainlyusedtoundertakethecorebudgetofrobotvoicerecognition,positioningandnavigation,pathplanning,etc.Theexecutivelayerwasmainlyusedtocarryoutthecontrolinstructionssentbythedecision⁃makinglayer,tocontroltherobotmovementanddisinfectionwork.Thetestresultsshowthatthecon⁃trolsystemhastheadvantagesofhighreliability,goodflexibilityandlowcost.
Keywords:Disinfectionrobot;ROS;Hierarchicalcontrol;Simultaneouslocalizationandmapping;Trajectoryplanning
0㊀前言
机器人从应用领域可分为工业机器人和服务机器人[1]㊂工业机器人已广泛应用于生产制造业,极大地提高了生产力㊂服务机器人的发展晚于工业机器人,根据国际标准化组织的定义,服务机器人是为人类执行有用任务的机器人[2]㊂近年来,服务机器人逐渐进入人们的生活和工作中,为人们执行有用的任务,如医疗服务机器人[3]㊁家庭服务机器人[4]㊁助老助残机器人[5]㊁教育娱乐机器[6]㊁电力机器人[7]等㊂
目前,公共卫生领域消毒机器人的研究和开发效率一直受机器人平台成本高㊁应用场景多变㊁控制方
法复杂等因素限制㊂在机器人操作系统中,ROS[8-
9](RobotOperatingSystem,机器人操作系统)环境中
各功能模块相互独立,可以自由添加或删除某一模块而不影响整个系统,提供了一种硬件抽象㊁
进程管图1㊀消毒机器人实物
理㊁分布式通信等系统环境㊂由于其具有高内聚㊁松耦合㊁分布式的特点,ROS已成为机器人开发者的首选㊂
作者针对公共场所消毒领域,从成本和性能角度考虑,设计一种基于ROS的消毒机器人控制系统方案㊂并针对该
方案开发了一套软硬件平台,消毒机器人实物见图1㊂
1 系统构架设计
基于分层控制的设计理
念,将消毒机器人系统各个功能模块进行分层设计,分为用户层㊁决策层㊁执行层以及设备层,各层次功能明确㊁耦合性低㊁复用性好㊁灵活性高,系统架构如图2所示
图2㊀系统架构
1 1㊀用户层
用户层主要包括安装在消毒机器人上的触摸屏㊁麦克风以及手机端APP[10],主要用来接收用户的应用指令并发给决策层控制以及显示机器人的工作状态等,起到人机交互的作用㊂
触摸屏给用户提供一种离线操作机器人的工作方式,采用17 78cm(7 0寸)㊁分辨率为800像素ˑ480像素的组态工业串口屏,通过RS232与主控制器进行通信㊁显示和反馈数据,稳定性高,可以在恶劣的户外进行工作㊂软件设计方面利用配套的上位机VisualTFT[11]软件进行控件配置㊁界面编辑和程序下载,主要完成人脸识别㊁消毒地点选择㊁密码解锁等功能,设计界面如图3所示㊂此外系统配备了麦克风,实现语音识别与交互功能
图3㊀触摸屏设计界面
相比离线式操作,本文作者还提供一种简单的非接触式在线操作方法,方便用户通过手机APP直接操作和控制机器人,实现如密码登录㊁消毒地点选择等常用功能㊂
1 2㊀决策层
决策层是系统的核心层,类似于人的大脑,主要承担机器人语音识别㊁定位与导航㊁路径规划等核心预算㊂硬件设备主控制器采用目前性能较为强劲且体积较小的mini机(IntelNUC),安装ubuntu16 04系统环境,安装于底盘内部㊂在该环境下,通过麦克风识别语音指令以及激光雷达采集环境信息,对这些信息进行融合处理,并根据控制指令和位姿信息,借助ROS开源算法包实现机器人的即时定位与地图构建㊁路径规划以及导航避障等功能㊂决策层的系统框图如图4所示
图4㊀决策层系统框图
1 3㊀执行层
执行层主要负责执行决策层发送过来的控制指
令,控制电机的开启㊁调速以及消毒灯管的开启和关闭等,主要包括电机控制器和辅助控制器两部分㊂电机控制器和辅助控制器都是基于STM32F103处理器芯片开发,该芯片外设丰富㊁功耗低㊁成本低㊁性能稳定㊂其中为了支持手机APP可以通过网络启动机器人,辅助控制器增加了WiFi无线模块㊂执行层系统框图如图5所示
图5㊀执行层系统框图
1 4㊀设备层
机器人采用三轮全向的运动结构,使机器人具有更灵活的运动能力㊂直流电机与全向轮的连接采用高强度铝合金联轴器,能够保证承受足够的扭矩㊂系统采用锂电池作为电源提供能量,使用PWM信号驱动电机,控制方式简单高效;选用性能优异的飞利浦紫外线消毒灯管进行高效杀菌消毒;采用USB摄像头获取人脸信息以及高采样率㊁远测距的激光雷达采集环境二维地图信息用于激光SLAM导航㊂相关设备参数说明如表1所示㊂
81㊃机床与液压第49卷
表1㊀设备参数说明
设备名称型号数量参数说明电源
锂电池
124V,40A㊃H电机驱动WSDC2412D
神仙树学名叫双翅六道木
额定电压24V,PWM通信,
最大持续电流12A
直流电机MD603额定电压24V,额定转速175r/min,额定功率100W,
额定扭矩5.57N㊃m激光雷达思岚RplidarA3125m测量半径,采样率16000次/s,360ʎ全方位扫描
全向轮Ballbot3直径127mm,单轮负载能力400N摄像头JX⁃H621100ʎ广角镜头,USB摄像头720P
消毒灯管
飞利浦
功率30W/根,直径25mm,
ELSTEIN辐射器长度900mm
2㊀消毒机器人运动学分析
假设消毒机器人工作时在平整的地面上移动,定义地面坐标系为XOY,机器人坐标系为xoy,如图6所示
图6㊀坐标系
两坐标系旋转角度为θ,地面坐标系X轴方向的
速度为vGX,Y轴方向的速度为vGY,角速度为W;机器人坐标系x轴方向速度为vx,y轴方向速度为vy,
角速度为ω㊂坐标系速度转换公式如下:
vxvyωéëêêêùûúúú=cosθsinθ0-sinθcosθ0001éëêêêùûúúú㊃vGXvGYWéëêêêùû
ú
úú(1)
假设机器人底盘全向轮轮轴之间的角度为绝对的
120ʎ,全向轮C的轴线和y轴重合,vA㊁vB㊁vC分别为3个全向轮的转速,3个全向轮之间
的相切圆半径为r,vᶄx和vᵡx是机器人坐标系x轴速度vx分解到全向轮A和全向轮B方向上的分量,vᶄy和vᵡy是机器人坐标系y轴速度vy分解到全向轮A和全向轮B方向上的分量,如图7所示
图7㊀速度计算分解图
通过计算可以得到全向轮A的速度公式:
vA=vᶄx+vᶄy
+ωr(2)因为
vᶄx=-vx㊃cos60ʎvᶄy
=-vy㊃cos30ʎ{
(3)
所以可得机器人坐标系下全向轮A的速度为vA=-vx㊃cos60ʎ-vy㊃cos30ʎ+ωr(4)同理,可得机器人坐标系下全向轮B和全向轮C
的速度分别为
vB=-vx㊃cos60ʎ+vy㊃cos30ʎ+ωr(5)vC=vx+ωr
(6)
由此,可得3个全向轮的速度变换矩阵:
vAvBvCéëêêêùûúúú=-cos60ʎ-cos30ʎr-cos60ʎcos30ʎr10
réë
ê
êêù
ûúúú㊃vxvyωéëêêêù
û
úú
ú(7)
与式(1)进行联合,得到机器人的一般运动学方程:
vAvBvCéëêêêùû
úúú=-cos(60ʎ+θ)-sin(θ+60ʎ)
r-cos(60ʎ-θ)
-sin(60ʎ-θ)
rcosθsinθ
réëê
êêùû
ú
úú㊃vGXvGYWéëêêêùû
ú
úú(8)
3㊀消毒机器人定位与导航3 1㊀ROS简介
从本质上来说,ROS是运行在主操作系统上的
软件模块 ,是一种分布式模块化的开源软件框架,实现机器人底层硬件抽象化,为机器人的开发提供一个与硬件无关的接口[12]㊂ROS的核心功能是创建了一个能够连接所有节点(进程)的抽象 网络 ,各个独立的节点可以对这个 网络 进行点对点的通信㊂同一项目中的不同节点允许在不同的设备上运行,实现分布式运算㊂此外ROS支持C++㊁Python等多语言开发,提供三维可视化工具rviz以及物理仿真环境gazebo等组件,为开发者带来了极大的便利㊂
㊃91㊃第11期刘小军等:基于ROS的消毒机器人控制系统设计与实现
㊀㊀㊀净烟器
3 2㊀地图构建
利用ROS中的Gmapping软件包实现地图构建,如图8所示㊂其中椭圆形表示各功能节点,主要包括Gmapping节点㊁激光雷达节点㊁手柄控制节点㊁机器人底盘控制节点和地图服务节点5个节点;矩形方框表示主题,主题指向节点则表示该节点订阅了相应的消息,节点指向主题表示该主图发布了相应的消息㊂为了获得精确的地图数据,在构建地图过程中,需要反复调试Gmapp
ing算法的参数:其中地图精度设置为0 1;粒子数量设为8;地图更新间隔设置为0 01s㊂
图8㊀Gmapping建图节点图玻璃钢全向天线
此外,为了减少机器人建图的盲区以及操作的便利性,采用手柄代替键盘手动控制机器人完成建图工作,试验地点选择在体育馆内㊂体育馆室内构建的整体效果如图9所示,可见构图效果基本能够展现真实的物理环境
图9㊀体育馆室内地图构建效果
3 3㊀导航规划
机器人导航规划流程如图10所示,首先需要对机器人位姿进行初始化设置,得到当前位置,获取栅格地图;然后为机器人设置全局目标点,准备全局路径规划;全局规划器global_planer通过A∗算法根据机器人当前位姿和目标点位姿规划出一条全局最优路径;将全局路径分割成多个局部目标点;如果在行进过程中检测到障碍物,会启动局部规划器local_plan⁃er通过DWA算法规划出机器人局部最优路径,实现动态避障;机器人实时判断当前所在位置是否为全局目标点,如果不是就返回之前步骤继续形成局部目标点,如果是就结束此次导航㊂
根据上述导航规划流程,基于图9所建栅格地图对机器人的导航功能进行相关试验,效果如图11所示㊂试验结果表明:机器人能完成导航任务,并成功绕开障碍物,到达全局目标点
图10㊀
导航规划流程
图11㊀导航规划效果
4㊀结束语
针对公共卫生领域,提出了一种基于ROS的消毒机器人控制系统解决方案,该系统采用分层控制的设计理念,将控制系统分为用户层㊁决策层以及执行层,各层次功能明确㊁耦合性低㊁复用性好㊁灵活性高㊂并给出了系统总体设计以及软硬件设计,进行了功能验证㊂试验结果表明,该控制系统具有可靠性高㊁灵活性好㊁成本低等优点㊂
参考文献:
[1]陶永,王田苗,刘辉,等.智能机器人研究现状及发展趋
势的思考与建议[J].高技术通讯,2019,29(2):149-
163.
TAOY,WANGTM,LIUH,etal.Insightsandsuggestionsonthecurrentsituationanddevelopmenttrendofintelligent
robots[J].ChineseHighTechnologyLetters,2019,29(2):149-163.
[2]IFR.Service⁃robots[Z/OL].https://ifr.org/service-robots.
[3]杨晶东,郭远首.基于联合点线特征的医疗服务机器人
同时定位与地图构建算法研究[J].第二军医大学学报,2019,40(5):507-511.
YANGJD,GUOYS.Simultaneouslocalizationandmap⁃
pingalgorithmbasedonpointandlinefeaturesformedicalservicerobots[J].AcademicJournalofSecondMilitaryMedicalUniversity,2019,40(5):507-511.
[4]王年文,王剑.面向感性需求的家庭服务机器人造型设
计研究[J].机械设计,2018,35(11):111-116.
WANGNW,WANGJ.Modelingdesignoffamilyservicerobotorientedtoperceptualdemand[J].JournalofMachineDesign,2018,35(11):111-116.
㊃02㊃机床与液压第49卷
[5]赵雅婷,顾东晓,赵树平,等.基于Kano模型的养老服务机器人功能需求研究[J].合肥工业大学学报(自然科学版),2019,42(10):1419-1423.
ZHAOYT,GUDX,ZHAOSP,etal.StudyonfunctionalrequirementsofpensionservicerobotbasedonKanomodel[J].JournalofHefeiUniversityofTechnology(NaturalSci⁃ence),2019,42(10):1419-1423.
[6]李艳燕,李新,王君秀.教育机器人的设计与关键问题分析[J].现代教育技术,2020,30(1):12-17.
LIYY,LIX,WANGJX.Thedesignandkeyproblemsanalysisofeducationalrobot[J].ModernEducationalTech⁃nology,2020,30(1):12-17.
[7]江维,王杰,陈伟,等.半结构环境中电力作业机器人机械手鲁棒轨迹跟踪控制[J].北京理工大学学报,2019,39(4):391-398.
JIANGW,WANGJ,CHENW,etal.Manipulatorrobusttrajectorytrackingcontrolforelectricpoweroperationrobotinsemi⁃structuredenvironment[J].TransactionsofBeijingInstituteofTechnology,2019,39(4):391-398.[8]白亮亮,平雪良,陈盛龙,等.分布式移动机器人控制系统设计与实现[J].机械设计与制造,2015(10):180-183.
BAILL,PINGXL,CHENSL,etal.Designandimple⁃mentationofdistributingmobilerobotcontrolsystem[J].MachineryDesign&Manufacture,2015(10):180-183.[9]王权,胡越黎,张贺.基于ROS与Kinect的移动机器人同时定位与地图构建[J].计算机应用研究,2017,34(10):3184-3187.
WANGQ,HUYL,ZHANGH.MobilerobotsimultaneouslocalizationandmappingbasedonROSandKinect[J].Ap⁃
plicationResearchofComputers,2017,34(10):3184-3187.
[10]李梦男,邵振洲,渠瀛,等.Android与ROS交互通信的可靠性设计[J].计算机应用与软件,2018,35(3):106-113.
LIMN,SHAOZZ,QUY,etal.Reliabilitydesignofin⁃teractivecommunicationbetweenAndroidandROS[J].ComputerApplicationsandSoftware,2018,35(3):106-113.
[11]王佳,赵耕云,雷小强.基于串口屏的纯电动汽车组合仪表设计[J].汽车实用技术,2018(8):15-17.
WANGJ,ZHAOGY,LEIXQ.Designofapureelectricvehiclecombinationinstrumentbasedonserialportscreen[J].AutomobileAppliedTechnology,2018(8):15-17.[12]安峰.基于开源操作系统ROS的机器人软件开发[J].单片机与嵌入式系统应用,2017,17(5):27-29.
ANF.Robotsoftwaredevelopmentbasedonopen⁃sourceoperatingsystemROS[J].Microcontrollers&EmbeddedSystems,2017,17(5):27-29.
(责任编辑:张艳君)
(上接第16页)
[17]游泳.非线性单摆系统的Hopf分岔[J].振动与冲击,2017,36(22):104-110.
YOUY.Hopfbifurcationinnonlinearforcedsinglependu⁃
lumsystems[J].JournalofVibrationandShock,2017,36(22):104-110.
[18]时培明,刘彬,韩东颖,等.时滞反馈非线性扭振系统的稳定性与Hopf分岔研究[J].燕山大学学报,2011,35(2):162-166.
SHIPM,LIUB,HANDY,etal.StudyonstabilityandHopfbifurcationofanonlineartorsionalsystemwithtime⁃delayfeedback[J].JournalofYanshanUniversity,2011,35(2):162-166.
[19]王万永,陈丽娟.非线性时滞反馈对共振附近动力学行为的影响[J].信阳师范学院学报(自然科学版),2014,27(1):15-18.
WANGWY,CHENLJ.Effectsofdelayednonlinearfeed⁃backonthedynamicsnearresonance[J].JournalofXin⁃yangNormalUniversity(NaturalScienceEdition),2014,27(1):15-18.
镁钙砖
[20]刘杰,管俊彪.时滞反馈控制系统的稳定性及Hopf分岔[J].杭州电子科技大学学报(自然科学版),2019,39(3):88-91.
LIUJ,GUANJB.StudyonstabilityandHopfbifurcationofachaoticsystemwithtime⁃delay[J].JournalofHang⁃
zhouDianziUniversity(NaturalSciences),2019,39(3):88-91.
[21]李德奎,连玉平.单时滞类Lorenz系统的Hopf分岔分析[J].数学杂志,2015,35(3):635-642.
LIDK,LIANYP.HopfbifurcationanalysisoftheLorenz⁃likesystemwiththesingletime⁃delay[J].JournalofMathematics,2015,35(3):635-642.
[22]JICH,QIAOYH,MIAOJ,etal.StabilityandHopfbifur⁃cationanalysisofacomplex⁃valuedWilson⁃Cowanneuralnetworkwithtimedelay[J].Chaos,Solitons&Fractals,2018,115:45-61.
[23]宋作军.基于中心流形理论的四轮转向汽车Hopf分岔分析[J].振动与冲击,2016,35(13):219-223.
SONGZJ.Hopfbifurcationofanautomobilewithfour⁃
wheelsteeringbasedoncentermanifoldtheory[J].JournalofVibrationandShock,2016,35(13):219-223.[24]JIANGSY,XUJ,YANY.Stabilityandoscillationsinaslow⁃fastflexiblejointsystemwithtransformationdelay[J].ActaMechanicaSinica,2014,30(5):727-738.[25]NAYFEHAH.Orderreductionofretardednonlinearsys⁃tems:themethodofmultiplescalesversuscenter⁃manifoldreduction[J].NonlinearDynamics,2008,51(4):483-500.
[26]刘延柱,陈立.非线性振动[M].北京:高等教育出版社,2001:224-231.(责任编辑:张楠)
㊃12㊃
第11期刘小军等:基于ROS的消毒机器人控制系统设计与实现㊀㊀㊀

本文发布于:2024-09-21 19:33:31,感谢您对本站的认可!

本文链接:https://www.17tex.com/tex/3/297738.html

版权声明:本站内容均来自互联网,仅供演示用,请勿用于商业和其他非法用途。如果侵犯了您的权益请与我们联系,我们将在24小时内删除。

标签:机器人   消毒   系统   控制   设计   节点
留言与评论(共有 0 条评论)
   
验证码:
Copyright ©2019-2024 Comsenz Inc.Powered by © 易纺专利技术学习网 豫ICP备2022007602号 豫公网安备41160202000603 站长QQ:729038198 关于我们 投诉建议