1.本发明涉及医用机器人技术领域，具体涉及一种医用护理机器人运动预测和故障诊断的方法。
背景技术：2.随着移动机器人技术逐渐成熟，国内掀起了医用护理机器人研究和应用的热潮。
3.由于国内医用护理机器人起步较晚，大部分机器人无法做到面对医院庞大的人流量，快速变化的动态环境做出安全的局部路径规划，或是协助患者进行舒适、安全的交互。因此，需要提供一种方法使医用护理机器人可以加快机器人机械臂的故障检测进度、降低试错过程中不必要的损失，同时解决医用护理机器人在医疗护理环境中的安全性控制问题。
技术实现要素：4.本发明要解决在医院复杂，快速变化的动态环境下，机器人移动底盘无法做到安全、高效动态避障以及医用护理机器人机械臂出现故障时，因为其复杂的机械结构而无法快速诊断故障的问题，提出一种基于数字孪生的医用护理机器人运动预测和故障诊断的方法：
5.本发明采用的技术方案为：
6.提供了一种基于数字孪生的医用护理机器人的方法，包括医院环境数字孪生体的创建、基于数字孪生系统的医用护理机器人底盘移动路径的最优规划、基于数字孪生的医用护理机器人机械臂运动状态检测与故障诊断。
7.本发明的基于数字孪生的医用护理机器人运动预测和故障诊断的方法，具体包括以下步骤：
8.1、构建基于数字孪生的医用护理机器人系统总体框架。
9.2、创建包含医院环境与机器人硬件结构在内的基础3d模型。
10.3、将基础3d模型与传感器信息交互，形成医用护理机器人数字孪生体的虚拟区。
11.4、通过预先录入的多种局部路径规划方法之间的对比，预测、获取底盘的最佳运动控制。
12.5、采集物理层机械臂各关节运行的位姿数据，预测机械臂运动状态和对机械臂进行故障诊断。
13.步骤1中，将基于数字孪生的医用护理机器人系统分为以下四个区块：
14.区块1物理层，主要包含实物有：现实空间中的医院环境与医用护理机器人，其中医用护理机器人用于执行虚拟区下达指令。
15.区块2数据连接层，存放从物理层中采集的实时数据与历史数据以及虚拟层对物理层下达的指令。
16.区块3虚拟层，用于实现医用护理机器人与医院环境的逻辑交互。交互结果下达物
理层的同时，服务于应用层。
17.区块4应用层，实现对医用护理机器人移动底盘的最优路径规划预测功能以及对机械臂故障的诊断与检测功能。
18.步骤2中，构建包含医院环境与机器人硬件结构在内的基础3d模型可具体包括：
19.步骤2.1在数字孪生系统的虚拟层中建立动态环境区，用于存放除医用护理机器人外的医院环境数字孪生体。根据医用护理机器人在医院现场进行循环建图时所反馈的建筑结构信息，采用solid works建模软件，建立初始的医院环境 3d模型，该模型需要在建模过程中进行轻量化才可以加入动态环境区中，其中轻量化主要包括减少零件的个数与简化模型两方面。
20.步骤2.2采集医用护理机器人各零件的物理参数，与进行轻量化后的医用护理机器人模型(医用护理机器人的建模步骤同初始的医院环境3d模型的建模步骤)在unity3d虚拟环境中共同构成医用护理机器人的数字孪生体，进而保证模型的高保真建模并将该模型放入虚拟层的机器人区中。
21.步骤3中，形成医用护理机器人数字孪生体的虚拟区具体包括：
22.步骤3.1在数据连接层中建立实时数据库用于存放医用护理机器人的传感器所采集的医院环境信息,所用的信息传递中间件选择为rabbitmq。
23.实时数据库在医用护理机器人创建初始医院环境数字孪生体的同时，对各个房间位置加入语义信息。并加入容易变动的动态信息。
24.步骤3.2将实时数据库中的动态信息需要根据雷达或双目相机等传感器获得的物体与其位姿信息来进行快速地更新。
25.从而提高医用护理机器人在孪生空间中进行运动控制的安全性与精准性，如：路径规划，医疗物品抓取等。实时数据库中的动态采集信息内容需要通过 orb算法提取相关特征才可放入动态环境区中，用于加快医院中动态环境在医院数字孪生体中的映射速度，达到实时映射的效果。
26.步骤3.3建立逻辑区，用于体现机器人与环境之间运行逻辑的认知能力。包括预测在当前环境下医用护理机器人移动底盘最优规划路径与机械臂的状态检测。
27.步骤4预测、获取底盘的最佳运动控制在步骤3中的逻辑区中进行，具体包括：
28.步骤4.1当路径规划开始时，率先由用户在人机交互平面输入医用护理机器人移动的目标点，继而对指令下达区发送通过全局路径规划算法得到的运动指令，物理层的机器人移动底盘收到指令开始移动。
29.步骤4.2将物理底盘依照控制信号所做出实际运动状态数据按照较短的时间周期进行传输至数据反馈库中，该数据无需进行轻量化处理，主要用于检测，分析故障，可直接上传至虚拟层的机器人区中。
30.步骤4.3当底盘传感器检测到有动态采集数据与规划的全局路径有所冲突时，虚拟层将机器人区的底盘移动位置，姿态信息与实时数据库中的冲突信息在逻辑区进行交互，再通过动态窗口法，遗传算法，时间弹性带法的对比，可预测、获取底盘的最优局部路径规划与最佳运动控制。
31.对比的主要指标按重要性从高到低分别为安全性，运动控制可行性，路径长短。
32.最终将规划的最优局部路径规划算法反馈给物理空间中的底盘芯片完成移动底
盘的最佳运动。
33.步骤5中预测机械臂运动状态和进行机械臂故障诊断中，具体包括：
34.步骤5.1对医用护理机器人机械臂的数字模型的实现，虚拟层中机械臂的关节运动与物理层中的机械臂关节运动方式相同，但是由于传统机器人使用的运动描述方法d-h法与unity所建机器人区的坐标系的方向有所不同，前者为右手坐标系，后者为左手坐标系，因此需要通过坐标系转换的方法来实现虚拟环境下对机械臂运动状态的描述即得到对unity3d虚拟环境下机械臂各个关节的位姿变化的描述。
35.设物理区机械臂关节绕z1轴旋转θ1角后，由o
1-x
1-y
1-z1得到坐标系 o1′‑
x1′‑
y1′‑
z1′
，对应unity3d中机械臂关节绕y2旋转θ2，o
2-x
2-y
2-z2到o2′‑
x
′
2-y2′‑
z2′
，因为d-h坐标系为右手坐标系，局部坐标系为左手坐标系，因此有θ1＝-θ2。
36.坐标系转换的步骤可细分为以下三个步骤：
37.步骤5.1.1，此步骤中，o2′‑
x
′
2-y2′‑
z2′
是最终的位置，只需要考虑如何在世界坐标系旋转对应欧拉角来变换到o2′‑
x
′
2-y2′‑
z2′
。
38.主要获得从世界坐标系到o
2-x
2-y
2-z2的欧拉角，设欧拉角为α1、β1、。o
2-x
2-y
2-z2到o2′‑
x
′
2-y2′‑
z2′
的转换为原坐标轴绕y2旋转θ2。由上述符号表示转换矩阵r
′
见等式(1)。
[0039][0040]
其中，r(y,β1)，r(x,α1)，r(y2,θ2)分别为o
1-x
1-y
1-z1旋转到o
2-x
2-y
2-z2有关欧拉角β1，α1，以及o
2-x
2-y
2-z2转动θ2角度到o2′‑
x
′
2-y2′‑
z2′
的旋转矩阵。
[0041]
步骤5.1.2通过直接用三个欧拉角α、β、的旋转矩阵来表示o-x-y＝z 到o
′
2-x
′
2-y2′‑
z2′
的旋转矩阵，得到以下等式：
[0042][0043]
步骤5.1.3将等式(2)与等式(3)进行等式运算，可得：
[0044][0045][0046][0047]
其中，有关参数见以下等式：
[0048][0049]
其中c表示cos,s表示sin。
[0050]
然后将α、β、作为transform eulerangles函数的参数来实现虚拟环境下机械臂关节的转动。
[0051]
步骤5.2将采集物理层机械臂各关节运行的位姿数据，传入数据反馈层中。通过与
应用界面。
具体实施方式
[0066]
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地表达，显然，所描述的实施例也仅仅是本发明中一部分的实施例，并不是全部的实施例。
[0067]
参照图1，一种基于数字孪生的医用护理机器人工作流程图，如图所示，该流程为：
[0068]
步骤s101：构建基础的3d模型，其中包括物理区100中医用护理机器人硬件设备与初始医院中不易变化的环境的模型，在医护机器人硬件设备的建模中需要采集医用护理机器人各零件的物理参数，如减震器弹簧系数，相机与雷达有效范围，电机系数，机械臂各关节的惯性矩阵等，从而来确保数字孪生系统建模的高保真性。由于该部分基本不会发生大规模变动，因此采用solidworks 建模。
[0069]
此步骤中，建模模块过多，采用轻量化处理，主要从两方面进行轻量化处理。一方面是减少零件的个数，对于不可见的零件进行隐藏或者压缩处理，隐藏零件可以简化模型的显示部分，提高模型的显示性能。另一方面是对模型进行简化，减少零件的不可见的圆角、凹槽、切角等信息，减少对资源的消耗。
[0070]
建模完成后，将初始医院环境模型经过轻量化后放入虚拟层300中的动态环境区，医用护理机器人模型经过轻量化后放入虚拟层300中的机器人区。
[0071]
步骤s102：将步骤s101构建的3d模型与医用护理机器人的传感器信息在三维软件中进行逻辑交互，形成医用护理机器人数字孪生体的虚拟区300。本发明提供一个优选实施例，选用unity3d作为三维开发软件平台，该平台具有通用性、兼容性以及丰富的物理属性。
[0072]
此步骤中，物理层100中的动态物体信息主要由双目摄像头101采集rgb 信息，激光雷达103采集深度信息，力传感器104采集。采集的主要信息内容有医用物品位置，病房所对应的病人姓名，过道流动人群等，采集完的数据直接放入数据连接层200中的实时数据库；
[0073]
数据连接层200中的数据反馈库主要由编码器105采集信息与机械臂旋转关节1、旋转关节2、旋转关节3、旋转关节4、旋转关节5、旋转关节6、旋转关节7采集机械臂关节的位姿信息以及双目相机113与机械爪114的力传感器信息获取目标抓取的医用物品信息组成。
[0074]
数据连接层200中的信息需要进行快速更新。从而提高医用护理机器人在孪生空间中进行运动控制的安全性与精准性，其次实时数据库中的动态采集信息内容需要进行提取相关特征才可放入动态环境区中，用于加快医院中动态环境在医院数字孪生体中的映射速度，本发明提供一个优选实施例，选取orb算法提取特征提取。
[0075]
数据连接层200中的历史数据与实时数据都存储于工控机201中。
[0076]
此步骤中，虚拟区300中的动态环境区由轻量化后的初始医院环境模型与特征提取后的实时数据库中的信息组成。
[0077]
此步骤中，虚拟区300中的机器人区由初始医用护理机器人模型以及数据反馈库组成。
[0078]
动态环境区与机器人区完成了对医用护理机器人以及医院环境物理层面的实时映射。
[0079]
虚拟区300中的逻辑区由动态环境区以及机器人区交互产生，该区数据主要用于应用层，产生逻辑由应用界面401反馈给用户以及下达逻辑指令传输到数据连接层200的指令下达库，再将指令传输至物理层100中的机器人硬件设备。
[0080]
逻辑指令是对机器人与环境之间运行逻辑的认知能力。
[0081]
此步骤中，本发明提供一个优选实施例，所用的信息传递中间件选择为 rabbitmq，其实现了brocker架构，又支持amqp、xmpp、smtp、stomp等多种通讯机制。
[0082]
步骤s103，虚拟层300中的逻辑区通过多种局部路径规划方法的对比来预测在当前环境下医用护理机器人移动底盘最优规划路径。
[0083]
此步骤中，当用户在应用平面401输入医用护理机器人移动的目标点，机器人开始导航任务，通过全局路径规划算法得到的运动指令，发送到指令下达区，物理层的机器人移动底盘收到指令开始移动。
[0084]
将物理底盘依照控制信号所做出实际运动状态数据按照较短的时间周期进行传输至数据反馈库中，该数据无需进行轻量化处理，主要用于检测，分析故障，可直接上传至虚拟层的机器人区中。
[0085]
当底盘传感器检测到有动态采集数据与规划的全局路径有所冲突时，虚拟层将底盘移动位置，姿态信息与实时数据库在逻辑区进行交互，进行多种局部路径规划方法之间的性能对比。
[0086]
此步骤中，对最优局部路径规划的性能评估指标按重要性从高到低分别为：安全性，运动控制可行性，路径长短，其中安全性占比为60％，运动控制可行性为20％，路径长短为20％。
[0087]
对比的局部路径规划主要包含动态窗口法，遗传算法，时间弹性带法。
[0088]
此步骤中，提供一种优选实施例，对多种局部路径规划对比的方法并非每次遍历完所有算法，而是设定主要算法，例如动态窗口法，当对其进行性能评分达到合格阈值时，直接选取该法，当未达到阈值时，再进行后续算法的性能评分，当都未达到所设阈值，则选取最高评分算法来对数据连接层200的指令下达区传输底盘运动指令，因此可减少运算时间，得到最终得分的等式如下：
[0089][0090]
最终将规划的最优局部路径规划算法反馈给物理空间中的底盘芯片完成移动底盘的最佳运动。
[0091]
步骤s104，通过存储在数据连接层200中数据反馈库以及指令下达库里的信息以及对各个机械臂关节的位姿分析，从而做到对医用护理机器人的机械臂的状态检测和故障诊断。
[0092]
本步骤中，最主要的实现内容为当机械臂物理空间中各个关节旋转时，得到unity3d虚拟环境下机械臂各个关节的位姿变化，从而存储于数据连接库200 中。
[0093]
此步骤中，由于在unity3d虚拟环境下机械臂的数字运动描述方法与传统机器人使用的运动描述方法d-h法有所不同，因此本方法主要通过将机器人区坐标系的原点作为
关节中心，即将两个坐标系原点重合，再将局部坐标系的y 轴与d-h法的z轴重合，再将局部坐标系的x轴与d-h法的x轴平行。
[0094]
具体案例可见图5为机械臂物理空间的关节坐标系、图6为机械臂在 unity3d空间中的局部坐标系。
[0095]
此步骤中，虚拟区的机械臂运动通过unity3d中的transform组件来实现。
[0096]
此步骤中，为减少不必要工作量，不采取通过局部坐标轴直接表示虚拟区机械臂关节的运动规划，而是确定一个与局部坐标系原点重合且不随关节运动而发生变化的坐标系，命名世界坐标系来描述虚拟区机械臂关节的运动规划。
[0097]
世界坐标轴与局部坐标轴是一组坐标系的对应关系，在unity3d中它们只有旋转关系，设置物理区机械臂关节绕z1轴旋转θ1角后，由o
1-x
1-y
1-z1得到坐标系o1′‑
x1′‑
y1′‑
z1′
，对应unity3d中关节绕y2旋转θ2，o
2-x
2-y
2-z2到o2′‑
x
′
2-y2′‑
z2′
，因为d-h坐标系为右手坐标系，局部坐标系为左手坐标系，因此有θ1＝-θ2。
[0098]
此步骤中，o2′‑
x
′
2-y2′‑
z2′
是最终的位置，只需要考虑如何在世界坐标系旋转对应欧拉角来变换到o2′‑
x
′
2-y2′‑
z2′
。
[0099]
主要获得从世界坐标系到o
2-x
2-y
2-z2的欧拉角，设欧拉角为α1、β1、o
2-x
2-y
2-z2到o2′‑
x
′
2-y2′‑
z2′
的转换为原坐标轴绕y2旋转θ2。由上述符号表示转换矩阵r
′
见等式(1)。
[0100][0101]
等式(1)中等式右边各个矩阵见等式(2)、等式(3)、等式(4)、等式(5)：
[0102][0103][0104][0105][0106]
又将转换矩阵r
′
合并为一个矩阵，见等式(6)：
[0107][0108]
等式(6)中个参数值在等式(7)中表示：
[0109][0110]
其中c表示cos,s表示sin。在欧拉角设置为以x、y、z的顺序旋转,所以从世界坐标轴直接转换到o
′
2-x
′
2-y2′‑
z2′
需要以下转换矩阵r,
[0111][0112]
将等式(8)等式右边三个矩阵合并，得到等式(9):
[0113][0114]
因为都是从o-x-y＝z到o2′‑
x
′
2-y2′‑
z2′
的旋转矩阵,所以r＝r
′
因此, 换算出α、β、的值：
[0115][0116][0117][0118]
至此,只需要输入θ2,输出为α、β、然后将α、β、作为transformeulerangles函数的参数来实现关节的转动。
[0119]
此步骤中，以上方法可实现虚拟机器人的一个关节旋转一个角度,连续运动是依靠连续旋转多个角度来实现。
[0120]
将世界坐标系作为描述坐标系的方法，不仅可以得到更加清晰，快速地表达虚拟环境中的机械臂的运动轨迹，也可以在数据传输库200中具体地记录下每个节点每次运动的位姿。
[0121]
获得的位姿可以实时检测机械臂的运动状态以及当机械臂出现故障时，对其进行诊断，使具有较为复杂机械结构的机械臂可以省去复杂的维修时间，从而快速地再次投入到医护工作中。
[0122]
需要说明的是，对于前述的各方法实施例，为了简便描述，故将其都表述为一系列的动作组合，但本发明并不受所描述的动作顺序的限制，因为依据本发明，某些步骤可以采用其它顺序或者同时进行。
技术特征：1.基于数字孪生的医用护理机器人运动预测和故障诊断的方法，具体包括以下步骤：步骤1.构建基于数字孪生的医用护理机器人系统总体框架；将基于数字孪生的医用护理机器人系统分为以下四个区块：区块1物理层，主要包含实物有：现实空间中的医院环境与医用护理机器人，其中医用护理机器人用于执行虚拟区下达指令；区块2数据连接层，存放从物理层中采集的实时数据与历史数据以及虚拟层对物理层下达的指令；区块3虚拟层，用于实现医用护理机器人与医院环境的逻辑交互；交互结果下达物理层的同时，服务于应用层；区块4应用层，实现对医用护理机器人移动底盘的最优路径规划预测功能以及对机械臂故障的诊断与检测功能；步骤2.创建包含医院环境与机器人硬件结构在内的基础3d模型；具体包括：步骤2.1在数字孪生系统的虚拟层中建立动态环境区，用于存放除医用护理机器人外的医院环境数字孪生体；根据医用护理机器人在医院现场进行循环建图时所反馈的建筑结构信息，采用solid works建模软件，建立初始的医院环境3d模型，该医院环境3d模型需要在建模过程中进行轻量化才可以加入动态环境区中，其中轻量化主要包括减少零件的个数与简化模型两方面；步骤2.2采集医用护理机器人各零件的物理参数，与进行轻量化后的医用护理机器人模型(在unity3d虚拟环境中共同构成医用护理机器人的数字孪生体，进而保证模型的高保真建模并将该模型放入虚拟层的机器人区中；医用护理机器人的建模步骤同初始的医院环境3d模型的建模步骤；步骤3.将基础3d模型与传感器信息交互，形成医用护理机器人数字孪生体的虚拟区；具体包括：步骤3.1在数据连接层中建立实时数据库用于存放医用护理机器人的传感器所采集的医院环境信息,所用的信息传递中间件选择为rabbitmq；实时数据库在医用护理机器人创建初始医院环境数字孪生体的同时，对各个房间位置加入语义信息，如病人房间，特定医用设备房间，医护人员房间等；并加入容易变动的动态信息，如医用物品位置，病房所对应的病人姓名，过道流动人群等信息；步骤3.2将实时数据库中的动态信息需要根据雷达或双目相机等传感器获得的物体与其位姿信息来进行快速地更新；从而提高医用护理机器人在孪生空间中进行运动控制的安全性与精准性，如：路径规划，医疗物品抓取；实时数据库中的动态采集信息内容需要通过orb算法提取相关特征才可放入动态环境区中，用于加快医院中动态环境在医院数字孪生体中的映射速度，达到实时映射的效果；步骤3.3建立逻辑区，用于体现机器人与环境之间运行逻辑的认知能力；包括预测在当前环境下医用护理机器人移动底盘最优规划路径与机械臂的状态检测；步骤4.通过预先录入的多种局部路径规划方法之间的对比，预测、获取底盘的最佳运动控制；具体包括：步骤4.1当路径规划开始时，率先由用户在人机交互平面输入医用护理机器人移动的
目标点，继而对指令下达区发送通过全局路径规划算法得到的运动指令，物理层的机器人移动底盘收到指令开始移动；步骤4.2将物理底盘依照控制信号所做出实际运动状态数据按照较短的时间周期进行传输至数据反馈库中，该数据无需进行轻量化处理，用于检测，分析故障，直接上传至虚拟层的机器人区中；步骤4.3当底盘传感器检测到有动态采集数据与规划的全局路径有所冲突时，虚拟层将机器人区的底盘移动位置，姿态信息与实时数据库中的冲突信息在逻辑区进行交互，再通过各类算法，即动态窗口法，遗传算法，时间弹性带法的对比，可预测、获取底盘的最优局部路径规划与最佳运动控制；对比的主要指标按重要性从高到低分别为安全性，运动控制可行性，路径长短；最终将规划的最优局部路径规划算法反馈给物理空间中的底盘芯片完成移动底盘的最佳运动；步骤5.采集物理层机械臂各关节运行的位姿数据，预测机械臂运动状态和对机械臂进行故障诊断；具体包括：步骤5.1对医用护理机器人机械臂的数字模型的实现，虚拟层中机械臂的关节运动与物理层中的机械臂关节运动方式相同，但是由于传统机器人使用的运动描述方法d-h法与unity所建机器人区的坐标系的方向有所不同，前者为右手坐标系，后者为左手坐标系，因此需要通过坐标系转换的方法来实现虚拟环境下对机械臂运动状态的描述即得到对unity3d虚拟环境下机械臂各个关节的位姿变化的描述；设物理区机械臂关节绕z1轴旋转θ1角后，由o
1-x
1-y
1-z1得到坐标系o
′
1-x
′
1-y
′
1-z
′1，对应unity3d中机械臂关节绕y2旋转θ2，o
2-x
2-y
2-z2到o
′
2-x
′
2-y
′
2-z
′2，因为d-h坐标系为右手坐标系，局部坐标系为左手坐标系，因此有θ1＝-θ2；坐标系转换的步骤可细分为以下三个步骤：步骤5.1.1，此步骤中，o
′
2-x
′
2-y
′
2-z
′2是最终的位置，只需要考虑如何在世界坐标系旋转对应欧拉角来变换到o
′
2-x
′
2-y
′
2-z
′2；主要获得从世界坐标系到o
2-x
2-y
2-z2的欧拉角，设欧拉角为α1、β1、o
2-x
2-y
2-z2到o
′
2-x
′
2-y
′
2-z
′2的转换为原坐标轴绕y2旋转θ2；由上述符号表示转换矩阵r
′
见等式(1)；其中，r(y，β1)，r(x，α1)，r(y2，θ2)分别为o
1-x
1-y
1-z1旋转到o
2-x
2-y
2-z2有关欧拉角β1，α1，以及o
2-x
2-y
2-z2转动θ2角度到o
′
2-x
′
2-y
′
2-z
′2的旋转矩阵；步骤5.1.2通过直接用三个欧拉角α、β、的旋转矩阵来表示o-x-y＝z到o
′
2-x
′
2-y
′
2-z
′2的旋转矩阵，得到以下等式：步骤5.1.3将等式(1)与等式(2)进行等式运算，可得：
其中，有关参数见以下等式：其中c表示cos,s表示sin；然后将α、β、作为transform eulerangles函数的参数来实现虚拟环境下机械臂关节的转动；步骤5.2将采集物理层机械臂各关节运行的位姿数据，传入数据反馈层中；通过与动态环境区的目标医用物体位姿在逻辑区进行交互，模拟机械臂各关节最优的运动姿态并规划机械臂运动控制；步骤5.3将规划运动通过指令下达层反馈给物理层中的机械臂；通过数据反馈层和指令下达层的历史数据实现对机械臂在故障情况下的诊断以及正常情况下对机械臂运动状态的检测。2.如权利要求1所述的基于数字孪生的医用护理机器人运动预测和故障诊断的方法，其特征在于：步骤2.1所述的建筑结构信息包括：房间布局、电梯、支撑柱的位置与体积；步骤2.2所述的医用护理机器人各零件的物理参数包括：减震器弹簧系数、相机与雷达有效范围、电机系数、机械臂各关节的惯性矩阵。3.如权利要求1所述的基于数字孪生的医用护理机器人运动预测和故障诊断的方法，其特征在于：步骤3.1所述的对各个房间位置加入语义信息包括：病人房间，特定医用设备房间，医护人员房间，所述的容易变动的动态信息包括：医用物品位置，病房所对应的病人姓名，过道流动人群信息；步骤3.2所述的医用护理机器人在孪生空间中进行运动控制包括：路径规划、医疗物品抓取。4.如权利要求1所述的基于数字孪生的医用护理机器人运动预测和故障诊断的方法，其特征在于：步骤4.3所述的各类算法的对比同样需要设置优先级，按重要等级排名为：动态窗口法，遗传算法，时间弹性带法，再按照重要等级排名依次进行评分，评估得分分别为：α，δ，β，采用合格分数为ε，当某算法评分达到合格分数时，选取该算法，当都不达标时，选取最高得分算法，可减少运算时间，得到最终得分的等式如下：。
技术总结基于数字孪生的医用护理机器人运动预测和故障诊断的方法，包括：步骤1.构建基于数字孪生的医用护理机器人系统总体框架；步骤2.创建包含医院环境与机器人硬件结构在内的基础3D模型；步骤3.将基础3D模型与传感器信息交互，形成医用护理机器人数字孪生体的虚拟区；步骤4.通过预先录入的多种局部路径规划方法之间的对比，预测、获取底盘的最佳运动控制；步骤5.采集物理层机械臂各关节运行的位姿数据，预测机械臂运动状态和对机械臂进行故障诊断。本发明能在医院复杂、快速变化的动态环境下，机器人移动底盘无法做到安全、高效动态避障以及医用护理机器人机械臂出现故障时，针对医用机器人复杂的机械结构快速诊断故障。机器人复杂的机械结构快速诊断故障。机器人复杂的机械结构快速诊断故障。
技术研发人员：付明磊 郑家豪 刘锦元 张文安 仇翔 刘安东 杨旭升 史秀纺 周叶剑 吴麒 胡佛
受保护的技术使用者：浙江工业大学
技术研发日：2022.04.25
技术公布日：2022/7/5
