基于5G室内分布式系统的医用机器人定位增强方法及系统与流程

本发明属于机器人交互技术领域，具体地说涉及基于5g通信的医用机器人多跳数据传输方法及系统。

背景技术：

5g代表着当今移动通信领域的最新技术，具有高速率、高可靠性、低时延等技术优势。将5g与医用机器人结合将有巨大的市场空间。目前5g正在快速建设期，室内覆盖是建设的重点之一，目前如何将医用机器人进行准确定位，获取医用机器人的绝对位置坐标，是医用机器人在室内能否进行衍生应用，能否拓展医用机器人用途的关键。

因此，现有技术还有待于进一步发展和改进。

技术实现要素：

针对现有技术的种种不足，为了解决上述问题，现提出基于5g室内分布式系统的医用机器人定位增强方法及系统，本方法基于网络设备能对医用机器人进行准确定位。

本发明提供如下技术方案：

一种基于5g室内分布式系统的医用机器人定位增强方法，包括：

5g定位服务器接收第一医用机器人发送的定位服务请求，根据定位服务请求确定给所述第一医用机器人的定位配置信息，并将所确定定位配置信息发送至第一医用机器人；

第一医用机器人接收所述定位配置信息，根据所接收的定位配置信息中包含的待测网络设备标识进行搜索并对与标识相对应的网络设备发送的定位参考信号进行测量，并向5g定位服务器发送定位测量结果；

5g定位服务器接收所述定位测量结果，并获取网络设备的坐标，确定第一医用机器人的位置坐标信息，发送至第一医用机器人；

第一医用机器人接收位置坐标信息，利用基于传感定位得到的相对位置信息，将所接收位置坐标信息与得到的相对位置信息发送至第一医用机器人控制器；

第一医用机器人控制器利用所接收的位置坐标信息与相对位置信息生成对应的绝对坐标信息。

优选的，所述定位服务请求包括，第一医用机器人的标识信息或数字签名及第一医用机器人的服务小区对应的网络设备标识。

优选的，所述定位配置信息包括，不少于三个用于定位测量的网络设备标识，及其坐标信息

优选的，所述5g定位服务器接收所述定位测量结果，并获取网络设备的坐标，确定第一医用机器人的位置坐标信息的具体方法为：

所述5g定位服务器通过接口获取所述网络设备发送定位参考信号的等效全向辐射功率eirpi，以及坐标信息；

所述5g定位服务器获取所述第一医用机器人与所述待测网络设备之间的路径损耗，具体方法为pathlossi＝eirpi-rsrpi，根据自由空间传播模型pathlossi＝27.56+20lgdistancei(m)+20lgf(mhz)，f为所述第一医用机器人与所述网络设备通信的频率；

所述5g定位服务器确定所述第一医用机器人与所述待测网络设备之间的距离distancei，具体方法为distancei＝10^(pathlossi-27.56-20lgf)/20；

则根据如下公式可以确定所述第一医用机器人的位置坐标(x，y，z)，

(x-x1)²+(y-y1)²+(z-z1)²＝distance1²

(x-x2)²+(y-y2)²+(z-z2)²＝distance2²

(x-x3)²+(y-y3)²+(z-z3)²＝distance3²

其中x1，y1，z1为第一网络设备的三维坐标，x2、y2、z2为第二网络设备的三维坐标，x3，y3，z3为第三网络设备的三维坐标。

优选的，所述测量结果包括所述网络设备的标识及定位参考信号的接收功率值rsrpi。

优选的，所述相对位置信息具体获得方法为：所述第一医用机器人利用传感器感知确定第一医用机器人在预设的电子地图中的相对位置信息。

优选的，所述绝对坐标信息具体获得方法为：根据电子地图的基准坐标信息，确定电子地图上的每个坐标点的相对位置信息，并进一步根据所述第一医用机器人在电子地图上的相对位置信息和所述第一医用机器人的坐标信息，确定电子地图的基准，从而生成对应的绝对坐标信息。

优选的，所述第一医用机器人向第二医用机器人发送第二医用机器人位置识别信息，所述第二医用机器人根据利用传感器和通信设备，根据第二医用机器人位置识别信息，确定与第一医用机器人之间的相对位置信息，从而确定第二医用机器人的坐标信息。

进一步的，所述第二医用机器人位置识别信息包括，第一医用机器人的设备标识、第一医用机器人的位置坐标信息、第一医用机器人的位置坐标信息时间戳。

一种基于5g室内分布式系统的医用机器人定位增强系统，包括：

第一医用机器人，被配置为与5g定位服务器通信连接，并根据5g定位服务器提供的定位配置信息测量并计算位置坐标信息，及与第一医用机器人控制器通信连接，向第一医用机器人控制器发送位置坐标信息和相对位置信息；

5g定位服务器，被配置为与第一医用机器人进行通信连接，并为第一医用机器人提供定位配置信息；

第一医用机器人控制器，被配置与第一医用机器人进行通信连接，并控制第一医用机器人，利用第一医用机器人发送的位置坐标信息和相对位置信息生成绝对坐标信息。

第二医用机器人，被配置为与第一医用机器人进行通信连接，利用第一医用机器人发送的第二医用机器人位置识别信息确定自身坐标信息。

有益效果：

本发明提供一种基于5g室内分布式系统的医用机器人定位增强方法，该方法能实现单一医用机器人通过与5g网络5g定位服务器进行通信，获得定位服务确定自身位置后，向机器人控制器和其他医用机器人发送自身位置信息，辅助建立自身的绝对位置坐标并让其他医用机器人获得绝对位置坐标，支持基于绝对位置信息的衍生应用需求。

附图说明

图1是本发明具体实施例中基于5g室内分布式系统的医用机器人定位增强方法流程图；

具体实施方式

为了使本领域的人员更好地理解本发明的技术方案，下面结合本发明的附图，对本发明的技术方案进行清楚、完整的描述，基于本申请中的实施例，本领域普通技术人员在没有做出创造性劳动的前提下所获得的其它类同实施例，都应当属于本申请保护的范围。此外，以下实施例中提到的方向用词，例如“上”“下”“左”“右”等仅是参考附图的方向，因此，使用的方向用词是用来说明而非限制本发明创造。

如图1所示为本发明提供一种基于5g室内分布式系统的医用机器人定位增强方法包括：

s100：5g定位服务器接收第一医用机器人发送的定位服务请求，所述定位服务请求包括，第一医用机器人的标识信息或数字签名及第一医用机器人的服务小区对应的网络设备标识，根据定位服务请求确定给所述第一医用机器人的定位配置信息，所述定位配置信息包括，不少于三个用于定位测量的网络设备标识，及其坐标信息，并将所确定定位配置信息发送至第一医用机器人。

s200：第一医用机器人接收所述定位配置信息，根据所接收的定位配置信息中包含的待测网络设备标识进行搜索并对与标识相对应的网络设备发送的定位参考信号进行测量，具体测量方法为：

所述5g定位服务器通过接口获取所述网络设备发送定位参考信号的等效全向辐射功率eirpi，以及坐标信息；

所述5g定位服务器获取所述第一医用机器人与所述待测网络设备之间的路径损耗，具体方法为pathlossi＝eirpi-rsrpi，根据自由空间传播模型pathlossi＝27.56+20lgdistancei(m)+20lgf(mhz)，f为所述第一医用机器人与所述网络设备通信的频率；

所述5g定位服务器确定所述第一医用机器人与所述待测网络设备之间的距离distancei，具体方法为distancei＝10^(pathlossi-27.56-20lgf)/20；

则根据如下公式可以确定所述第一医用机器人的位置坐标(x，y，z)，

(x-x1)²+(y-y1)²+(z-z1)²＝distance1²

(x-x2)²+(y-y2)²+(z-z2)²＝distance2²

(x-x3)²+(y-y3)²+(z-z3)²＝distance3²

其中x1，y1，z1为第一网络设备的三维坐标，x2、y2、z2为第二网络设备的三维坐标，x3，y3，z3为第三网络设备的三维坐标。

测量完成后向5g定位服务器发送定位测量结果，所述测量结果包括所述网络设备的标识及定位参考信号的接收功率值rsrpi。

s300：5g定位服务器接收所述定位测量结果，并获取网络设备的坐标，确定第一医用机器人的位置坐标信息，具体获得方法为：所述第一医用机器人利用传感器感知确定第一医用机器人在预设的电子地图中的相对位置信息，并发送至第一医用机器人。

s400：第一医用机器人接收位置坐标信息，利用基于传感定位得到的相对位置信息，将所接收位置坐标信息与得到的相对位置信息发送至第一医用机器人控制器。

s500：第一医用机器人控制器利用所接收的位置坐标信息与相对位置信息生成对应的绝对坐标信息，具体方法为：根据电子地图的基准坐标信息，确定电子地图上的每个坐标点的相对位置信息，并进一步根据所述第一医用机器人在电子地图上的相对位置信息和所述第一医用机器人的坐标信息，确定电子地图的基准，从而生成对应的绝对坐标信息。

在一些实施例中所述第一医用机器人向第二医用机器人发送第二医用机器人位置识别信息，所述第二医用机器人根据利用传感器和通信设备，根据第二医用机器人位置识别信息，确定与第一医用机器人之间的相对位置信息，从而确定第二医用机器人的坐标信息，其中所述第二医用机器人位置识别信息包括，第一医用机器人的设备标识、第一医用机器人的位置坐标信息、第一医用机器人的位置坐标信息时间戳。

本发明还提供一种基于5g室内分布式系统的医用机器人定位增强系统，包括：

第一医用机器人，被配置为与5g定位服务器通信连接，并根据5g定位服务器提供的定位配置信息测量并计算位置坐标信息，及与第一医用机器人控制器通信连接，向第一医用机器人控制器发送位置坐标信息和相对位置信息；

5g定位服务器，被配置为与第一医用机器人进行通信连接，并为第一医用机器人提供定位配置信息；

第一医用机器人控制器，被配置与第一医用机器人进行通信连接，并控制第一医用机器人，利用第一医用机器人发送的位置坐标信息和相对位置信息生成绝对坐标信息。

第二医用机器人，被配置为与第一医用机器人进行通信连接，利用第一医用机器人发送的第二医用机器人位置识别信息确定自身坐标信息。

下面通过具体实施例详细阐述本发明技术方案，其方法步骤为：

步骤1：第一医用机器人向5g定位服务器发送定位服务请求，所述定位服务请求包含所述第一医用机器人的标识信息或数字签名，第一医用机器人的服务小区对应的网络设备标识。

步骤2：5g定位服务器接收所述定位服务请求，根据所述第一医用机器人的标识信息或数字签名进行鉴权，确认所述第一医用机器人是定位服务的签约用户后，向所述第一医用机器人提供定位服务。

步骤3：5g定位服务器根据所述第一医用机器人的服务小区对应的网络设备标识确定给所述第一医用机器人的定位配置信息，所述定位配置信息包含为所述第一医用机器人配置的进行定位测量的至少三个网络设备标识及坐标信息，优选的所述进行定位测量包含所述第一医用机器人的服务小区对应的网络设备。

步骤4：5g定位服务器向所述第一医用机器人发送定位测量配置信息，所述定位测量配置信息包含至少三个待测网络设备标识，本实施例中，网络设备1(x1，y1，z1)，网络设备2(x2，y2，z2)，网络设备3(x3，y3，z3)。

步骤5：第一医用机器人接收所述定位测量配置信息，根据其中包含的待测网络设备标识进行搜索并对与标识相对应的网络设备发送的定位参考信号进行测量，并向5g定位服务器发送定位测量结果；所述测量结果包含所述网络设备的标识及定位参考信号的接收功率值rsrpi，本实施例中，网络设备1：-98dbm，网络设备2：-102dbm，网络设备3：-90dbm。

步骤6：5g定位服务器接收所述定位测量结果，并获取所述网络设备的坐标，确定所述第一医用机器人的位置坐标信息(x，y，z)，具体方法为：

所述5g定位服务器通过接口获取所述网络设备发送定位参考信号的等效全向辐射功率eirpi，以及坐标信息，例如，网络设备1：43dbm，坐标(x1，y1，z1)，网络设备2：43dbm，坐标(x2，y2，z2)，网络设备3：43dbm，坐标(x3，y3，z3)

所述5g定位服务器获取所述第一医用机器人与所述待测网络设备之间的路径损耗，具体方法为pathlossi＝eirpi-rsrpi，根据自由空间传播模型pathlossi＝27.56+20lgdistancei(m)+20lgf(mhz)，f为所述第一医用机器人与所述网络设备通信的频率

所述5g定位服务器确定所述第一医用机器人与所述待测网络设备之间的距离distancei，具体方法为distancei＝10^(pathlossi-27.56-20lgf)/20

则根据如下公式可以确定所述第一医用机器人的位置坐标(x，y，z)，

(x-x1)²+(y-y1)²+(z-z1)²＝distance1²

(x-x2)²+(y-y2)²+(z-z2)²＝distance2²

(x-x3)²+(y-y3)²+(z-z3)²＝distance3²

步骤7：5g定位服务器向所述第一医用机器人发送所述5g定位服务器计算确定的坐标信息(x，y，z)。

步骤8：第一医用机器人接收所述坐标信息，并向第一医用机器人控制器发送所述坐标信息，以及所述第一医用机器人在预设的电子地图的相对位置信息，所述相对位置信息是所述第一医用机器人利用传感器感知确定的。

步骤9：第一医用机器人控制器接收所述第一医用机器人的坐标信息及在所述电子地图内的相对位置信息，并根据上述信息确定电子地图的基准坐标信息，将电子地图上的每个坐标点同时提供相对坐标信息(相对基准点的相对距离)，并生成对应的绝对坐标信息。

步骤10：第一医用机器人通过广播方式向第二医用机器人发送第二医用机器人位置识别信息，所述第二医用机器人位置识别信息包括第一医用机器人的设备标识、坐标信息(x，y，z)、坐标信息的时间戳，第二医用机器人接收所述设备标识、坐标信息、坐标信息的时间戳，并确定所述当前时间与所述时间戳的差值小于预设门限时，确定所述坐标信息有效，并利用传感器和通信设备感知确定其与所述第一医用机器人之间的相对位置信息，从而确定第二医用机器人自身的坐标信息。

以上已将本发明做一详细说明，以上所述，仅为本发明之较佳实施例而已，当不能限定本发明实施范围，即凡依本申请范围所作均等变化与修饰，皆应仍属本发明涵盖范围内。