一种基于改进型人工势场的医院智能机器人路径规划系统技术方案

技术编号:32517213 阅读:61 留言:0更新日期:2022-03-02 11:14
本发明专利技术公开了智慧医院技术领域的一种基于改进型人工势场的医院智能机器人路径规划系统;包括信息输入、定位系统、整体路径选择系统、避障系统和姿态调整系统。本发明专利技术的有益效果是:本发明专利技术解决医院特殊科室的人力资源短缺等问题,为解决智能机器人路径规划中最佳路径的选取,以及智能机器人避障过程中的局部最小值问题,结合医院特有的环境以及硬件条件,由于医院人流量巨大,机器人所遇见的障碍类型基本都为动态障碍,所以本文运用区分障碍性质,区别对待解决局部极限小值问题。区别对待解决局部极限小值问题。区别对待解决局部极限小值问题。

【技术实现步骤摘要】
一种基于改进型人工势场的医院智能机器人路径规划系统


[0001]本专利技术涉及智慧医院
,具体是一种基于改进型人工势场的医院智能机器人路径规划系统。

技术介绍

[0002]路径规划是智能机器人的关键技术,合理的路径规划能让智能机器人的办事效率大大提高,当下最常用的路径规划算法为人工势场,主要由于其应用灵活,可以在保证安全的情况下获得一条平滑路径,并且对于动态环境可以实现实时运动控制等优点,但是传统的人工势场局部极小值问题,导致机器人在该处停止或在其周围振动,从而无法到达目标位置。针对此问题,文献中提出了许多解决方法例如沿墙跟踪法、极限环法、虚拟水流法等,虽然此类方法能一定层度上缓解局部最小值的出现,但是在实际应用中都存在一定的问题。因此,本领域技术人员提供了一种基于改进型人工势场的医院智能机器人路径规划系统,以解决上述
技术介绍
中提出的问题。

技术实现思路

[0003]本专利技术的目的在于提供一种基于改进型人工势场的医院智能机器人路径规划系统,以解决上述
技术介绍
中提出的问题。
[0004]为实现上述目的,本专利技术提供如下技术方案:包括信息输入、定位系统、整体路径选择系统、避障系统和姿态调整系统:
[0005]S1:定位系统:包括蓝牙定位系统、无线网络系统和电子罗盘;
[0006]S2:整体路径选择系统:包括位置获取、目标地获取、路径规划、路径选择和路径确认;
[0007]S3:避障系统:包括障碍物检测、地图生成、创建人工势场、构件函数、局部判断、结束算法;
>[0008]S4:姿态调整系统:包括航向角度计算、期望角度计算、实质角度偏移、期望角度矫正;
[0009]所述定位系统中的蓝牙定位用于确认当前位置,通过无线网络系统对当前位置楼层进行定位,进而通过电子罗盘进行姿态调整,所述整体路径选择与智能地图服务器信号连接,通过定位系统中获取的位置信息,及外部输入的目标地信息规划至少三条导航路径,对导航路径的人流量进行监控,根据不同的人流量通过遗传算法得出最佳导航路径,直至到达目的地。
[0010]作为本专利技术进一步的方案:所述定位系统包括如下子系统:S101,利用蓝牙定位系统获取智能机器人位置坐标,从而实现的位置定位;S102,利用不同楼层的无线网络系统获取智能机器人所在的楼层信息,从而实现楼层定位;S103,利用电子罗盘实现进行方向定位,实现智能机器人的方向点位。
[0011]作为本专利技术再进一步的方案:S201、根据步骤S1获得智能机器人当前所在的位置,
所在楼层,以及其自身方向的定位信息;S202,输入目标地的定位信息;S203,以智能机器人当前所在的定位信号为起点,目标地所在的点位信息为终点利用智能地图服务器规划出至少3条导航路径;S204,使用医院内部的摄像网络系统对不同导航路径的人流量进行监控,得出不同路径人流量的大小;S205,结合步骤S205得出不同路径的人流量,通过遗传算法(GA)得到最佳导航路径。
[0012]作为本专利技术再进一步的方案:所述避障系统包括如下子系统:S301,利用智能机器人自带的摄像头实时的获取周围信息,以及检测障碍物类型;S302,根据步骤S301获取的周围信息,通过映射转化为规划算法中需要的整体地图;S303,创建人工势场,得出空间的和势场为引力势场和斥力势场的和即:U(x)=U
a
(x)

U
r
(x)
[0013]其中其中,U
a
(x)是目标产生的引力势场;U
r
(x)是各障碍物产生即
[0014]S304,构建引力势场函数和斥力势场函数:
[0015][0016][0017]其中,ξ标识引力势的相对影响;η
j
表示第j个障碍物的斥力势的相对影响;x表示机器人当前位置;G表示目标点位置;d(x,G)表示机器人距离目标的距离;的作用是在机器人距离目标较远时;削弱目标引力势的作用;d
j
(x)表示机器人距离第j个障碍物的距离;表示第j个障碍物的斥力势作用范围;
[0018]S305,利用步骤S303中构造的引力势函数和斥力势函数的梯度计算得到机器人收到的假想引力和斥力:
[0019][0020][0021];S306,当机器人的运行环境中包含形状复杂或者距离很近的障碍物时,可能出现势场局部极小点,判断是否出现极小值点,判断公式如下:
[0022]其中,ε是一个很小的正数,其含义是机器人受到的虚拟合力接近0,若虚拟合力满足上述公式则表示出现极小值点;
[0023]S307,若不满足步骤S305中的公式则继续执行S308,若满足步骤S305中的公式则出现极小值,首先利用步骤S301的摄像头判断障碍物是否为动态障碍物,若是,则智能机器
人线性降速至停止,待局部极小值消失后执行S308;S308,若为静态障碍物,机器人沿着斥力场等势线运动,开始绕行行为,直至离开局部最小值点;S309,继续向目标地点前行,若出现局部极小值点则执行S307;S310,到达目标地点,退出算法。
[0024]作为本专利技术再进一步的方案:所述S4姿态调整系统包括下述子系统:S401,对比机器人的当前定位信息和S202目标定位信息,计算横向偏差和航向角偏差;S402,将步骤S401得到的两个偏差输入到自适应模糊PID控制器,控制器通过模糊自适应PID算法计算输出期望角度;S403,智能机器人的转向执行机构将期望角度执行为实际角度;S404,实时监测转向执行机构的实际角度,并作为自适应模糊PID控制器的反馈,实时校正期望角度,控制智能机器人到达目标地。
[0025]与现有技术相比,本专利技术的有益效果是:本专利技术解决医院特殊科室(例如传染科,放射科)的人力资源短缺等问题,为解决智能机器人路径规划中最佳路径的选取,以及智能机器人避障过程中的局部最小值问题,结合医院特有的环境以及硬件条件,首先利用智能地图服务器规划多条备选路径,然后利用医院的监控系统,监控备选路径的人流量,通过得到的人流量利用遗传算法得到最佳路径,在遇见局部极限值时,首先智能机器人的监控摄像头识别障碍为动态障碍还是静态障碍,若为动态障碍智能机器人线性减速直至停止,若为静态障碍智能机器人沿着斥力场等势线运动,开始绕行行为直至局部最小值消失。由于医院人流量巨大,机器人所遇见的障碍类型基本都为动态障碍,所以本文运用区分障碍性质,区别对待解决局部极限小值问题。
附图说明
[0026]图1为本专利技术的系统结构示意图;
[0027]图2为本专利技术中定位系统的结构示意图;
[0028]图3为本专利技术中避障系统的结构示意图;
[0029]图4为本专利技术中映射势力场的结构示意图;
[0030]图5为本专利技术中姿态调整系统的结构示意图。
具体实施方式
[0031]下面将结合本专利技术实施例中的附图,对本专利技术实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本专利技术一部分实施本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于改进型人工势场的医院智能机器人路径规划系统,包括信息输入、定位系统、整体路径选择系统、避障系统和姿态调整系统,其特征在于:S1:定位系统:包括蓝牙定位系统、无线网络系统和电子罗盘;S2:整体路径选择系统:包括位置获取、目标地获取、路径规划、路径选择和路径确认;S3:避障系统:包括障碍物检测、地图生成、创建人工势场、构件函数、局部判断、结束算法;S4:姿态调整系统:包括航向角度计算、期望角度计算、实质角度偏移、期望角度矫正;所述定位系统中的蓝牙定位用于确认当前位置,通过无线网络系统对当前位置楼层进行定位,进而通过电子罗盘进行姿态调整,所述整体路径选择与智能地图服务器信号连接,通过定位系统中获取的位置信息,及外部输入的目标地信息规划至少三条导航路径,对导航路径的人流量进行监控,根据不同的人流量通过遗传算法得出最佳导航路径,直至到达目的地。2.根据权利要求1所述的一种基于改进型人工势场的医院智能机器人路径规划系统,其特征在于:所述定位系统包括如下子系统:S101,利用蓝牙定位系统获取智能机器人位置坐标,从而实现的位置定位;S102,利用不同楼层的无线网络系统获取智能机器人所在的楼层信息,从而实现楼层定位;S103,利用电子罗盘实现进行方向定位,实现智能机器人的方向点位。根据权利要求1所述的一种基于改进型人工势场的医院智能机器人路径规划系统,其特征在于:所述整体路径规划系统包括如下子系统:S201、根据步骤S1获得智能机器人当前所在的位置,所在楼层,以及其自身方向的定位信息;S202,输入目标地的定位信息;S203,以智能机器人当前所在的定位信号为起点,目标地所在的点位信息为终点利用智能地图服务器规划出至少3条导航路径;S204,使用医院内部的摄像网络系统对不同导航路径的人流量进行监控,得出不同路径人流量的大小;S205,结合步骤S205得...

【专利技术属性】
技术研发人员:吴俊宏姚志江
申请(专利权)人:浙江远图互联科技股份有限公司
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1