一种实现机器人与人之间物品传递的人机协作方法及装置

1.本发明涉及人机协作技术，具体地说，涉及一种实现机器人与人之间物品传递的人机协作方法及装置。


背景技术：

2.机器人技术发展迅速，在工业生产、科学研究、军事军备和社会生活等方面都有广泛的应用。在今天的现代化工厂中，已经有大量的自动化生产过程由工业机器人完成，比如上下料、搬运、焊接、喷涂、打磨等。传统的工业机器人虽然具有执行速度快、精度高的优点，但灵活适应性是其一大短板。相对的，人虽然有着很好的灵活适应性，但在速度和精度上很难达到机器人的水平。机器人和人是工业生产中的两大主要生产力，他们有着各自的优势，但出于安全性考虑，二者通常是分开独立工作的，无法实现优势互补，这不仅限制了生产效率也影响了生产线的灵活性。
3.而人机协作，即机器人与人在共同的工作空间下协作完成任务，很好地结合了机器人在速度、精度方面的优势和人类强大的灵活适应能力，能够满足任务多样性和环境复杂性的要求，可以用于执行与未知环境和人发生交互作用的操作任务，进一步提高生产效率和生产线的灵活性。在机器人与人协同工作的过程中很多时候都需要完成物品传递的任务，比如机器人向工人提供工具，所以人机之间的物品传递是人机协作的一项重要功能。综合应用并优化计算机视觉、操作机器人运动规划等技术，可以构建一个安全可靠的人机交接系统，实现机器人与人之间的物品传递。


技术实现要素：

4.为了克服现有技术的不足，本发明的目的在于提供一种实现机器人与人之间物品传递的人机协作方法及装置，实现机器人与人之间安全可靠的物品交接。本发明是通过以下技术方案来实现的：
5.本发明公开了一种实现机器人与人之间物品传递的人机协作方法，包括以下步骤：
6.1)操作人员手持指定容器进入视觉观测系统的观测范围，视觉观测系统根据视觉观测系统的观测范围内的视觉信息估计操作人员手持的指定容器的六自由度位姿，并将操作人员手持的指定容器的位姿发送给机械臂运动规划与控制系统；
7.2)机械臂运动规划与控制系统根据接收到的操作人员手持的指定容器的位姿，结合机械臂末端的当前位姿以及交接策略，得到机械臂末端的目标位姿，然后根据机械臂末端的目标位姿和当前位姿生成机械臂关节速度控制指令，控制机械臂末端到达目标位姿。
8.作为进一步地改进，本发明所述的视觉观测系统的观测范围指相机视野，视觉信息包括rgb图像和深度图像；
9.视觉观测系统包括以下模块：图像采集模块、语义分割模块、语义分割优化模块、区域提取模块以及位姿估计模块；
10.图像采集模块用于采集相机视野中的rgb图像和深度图像，语义分割模块用于标注rgb图像中每个像素点所属的语义类别，语义类别有两类，一类是操作人员手持的指定容器，另一类是除操作人员手持的指定容器外的其他所有物体，语义分割优化模块用于优化语义分割模块产生的语义分割结果，区域提取模块用于根据语义分割优化模块优化之后的语义分割结果提取rgb图像中表示操作人员手持的指定容器的像素点和深度图像中表示操作人员手持的指定容器的点云，位姿估计模块用于估计操作人员手持的指定容器的位姿。
11.视觉观测系统中的图像采集模块用于采集相机视野中的rgb图像和深度图像，语义分割模块用于标注rgb图像中每个像素点所属的语义类别，语义类别有两类，一类是操作人员手持的指定容器，另一类是除操作人员手持的指定容器外的其他所有物体，语义分割优化模块用于优化语义分割模块产生的语义分割结果，区域提取模块用于根据语义分割优化模块优化之后的语义分割结果提取rgb图像中表示操作人员手持的指定容器的像素点和深度图像中表示操作人员手持的指定容器的点云，位姿估计模块用于估计操作人员手持的指定容器的位姿；
12.视觉观测系统中各模块之间的数据传递关系具体为，图像采集模块将rgb图像发送给语义分割模块，语义分割模块根据接收到的rgb图像进行语义分割，并将结果发送给语义分割优化模块，语义分割优化模块对接收到的语义分割结果进行优化，然后将优化之后的语义分割结果发送给区域提取模块，同时图像采集模块将rgb图像和深度图像发送给区域提取模块，区域提取模块根据接收到的优化后的语义分割结果、rgb图像以及深度图像提取表示操作人员手持的指定容器的像素和点云，并将表示操作人员手持的指定容器的像素和点云发送到位姿估计模块，位姿估计模块根据接收到的表示操作人员手持的指定容器的像素和点云得到操作人员手持的指定容器的位姿。
13.作为进一步地改进，本发明所述的机械臂运动规划与控制系统包括以下模块：目标位姿计算模块、人工势场建立模块以及导纳控制模块；
14.目标位姿计算模块用于根据操作人员手持的指定容器的位姿、机械臂末端的当前位姿以及交接策略得到机械臂末端的目标位姿，人工势场建立模块用于根据机械臂末端目标位姿建立虚拟引力势场并计算机械臂末端所受到的虚拟力和力矩，导纳控制模块用于根据机械臂末端受到的虚拟力和力矩计算机械臂关节速度指令。
15.机械臂运动规划与控制系统各模块之间的数据传递关系具体为，机械臂将机械臂末端的位姿发送给目标位姿计算模块，目标位姿计算模块根据接收到的机械臂末端的位姿、预先设计好的交接策略以及从视觉观测系统传输过来的操作人员手持的指定容器的位姿计算出机械臂末端的目标位姿，并将机械臂末端的目标位姿发送给人工势场建立模块，人工势场建立模块根据接收到的机械臂末端的目标位姿得到机械臂末端受到的虚拟力和力矩，并将机械臂末端受到的虚拟力和力矩发送给导纳控制模块，导纳控制模块根据接收到的机械臂末端受到的虚拟力和力矩计算机械臂关节速度指令，并将机械臂关节速度指令发送给机械臂执行。
16.作为进一步地改进，本发明所述的语义分割模块使用的算法包括但不限于fast
‑
scnn；位姿估计模块使用的算法包括但不限于rede。
17.作为进一步地改进，本发明所述的语义分割结果的初始值由视觉观测系统中语义分割模块得到，该结果会将rgb图像边缘的一些像素点误分类为操作人员手持的指定容器，
视觉观测系统中语义分割优化模块通过分析该结果中被标记为操作人员手持的指定容器的连通区域，当有多个这样的连通区域时，去除在边缘且像素点数量较少的连通区域，从而优化语义分割结果。
18.作为进一步地改进，本发明所述的交接策略以及机械臂末端的目标位姿的确定方法具体为：若机械臂末端与操作人员手持的指定容器的位置偏差较小，且操作人员手持的指定容器的姿态是杯口朝上，则使机械臂末端跟随操作人员手持的指定容器，同时进行倾倒，即设定机械臂末端的目标位置为操作人员手持的指定容器的位置的偏高处，目标姿态为使机械臂末端夹爪所持容器杯口斜向下朝向操作人员手持的指定容器的杯口；否则，使机械臂末端跟随操作人员手持的指定容器，同时保持机械臂末端夹爪所持容器杯口朝上，即设定机械臂末端的目标位置为操作人员手持的指定容器的位置的偏高处，目标姿态为使机械臂末端夹爪所持容器杯口朝上。
19.作为进一步地改进，本发明所述的虚拟引力势场的建立具体为，根据下式建立以机械臂末端的目标位姿为中心的虚拟引力势场：
[0020][0021]
其中，x为待评估处的位姿，x
t
为机械臂末端的目标位姿，k
a
为系数，d
a
为距离阈值，u
att
(x)为x处的虚拟势能；
[0022]
机械臂末端所受到的虚拟力和力矩的计算具体为，根据下式计算机械臂末端在虚拟引力势场中受到的虚拟力和力矩：
[0023][0024]
其中，x
e
为机械臂末端的当前位姿，x
t
为机械臂末端的目标位姿，k
a
为系数，d
a
为距离阈值，f
att
(x
e
)为机械臂末端受到的虚拟力和力矩；
[0025]
机械臂末端的当前位置和目标位置的偏差的具体计算为，机械臂末端的当前位置(x
e
，y
e
，z
e
)
t
，机械臂末端的目标位置(x
t
，y
t
，z
t
)
t
，偏差根据下式进行计算：
[0026]
e
d
＝(x
e
‑
x
t
，y
e
‑
y
t
，z
e
‑
z
t
)
t
#(3)
[0027]
机械臂末端的当前姿态和目标姿态的偏差的具体计算为，机械臂末端的当前姿态对应的旋转矩阵r
e
＝[n
e s
e a
e
]，机械臂末端的目标姿态对应的旋转矩阵r
t
＝[n
t s
t a
t
]，偏差根据下式进行计算：
[0028][0029]
机械臂末端的当前位姿和目标位姿的偏差为：
[0030][0031]
作为进一步地改进，本发明所述的机械臂关节速度指令的计算具体为，首先根据下式计算机械臂末端在虚拟力和力矩作用下的期望速度：
[0032][0033][0034]
其中，m为期望的惯性特性，d为期望的阻尼特性，f
att
为机械臂末端受到的虚拟力和力矩，为k时刻机械臂末端的期望线加速度和角加速度，为k时刻机械臂末端的期望线速度和角速度，期望线速度和角速度，
[0035]
然后根据下式计算机械臂的关节速度：
[0036][0037]
其中，为机械臂的期望关节速度，j(θ)为雅可比矩阵，v为机械臂末端的期望线速度，ω为机械臂末端的期望角速度。
[0038]
本发明还公开了一种实现机器人与人之间物品传递的人机协作方法的装置，其特征在于，装置如下：视觉观测系统中使用的装置包括rgb
‑
d相机以及第一计算模块，所述的rgb
‑
d相机用于获取rgb图像和深度图像，所述的第一计算模块用于运行语义分割模块、语义分割优化模块、区域提取模块以及位姿估计模块中的算法；
[0039]
机械臂运动规划与控制系统中使用的装置包括机械臂和第二计算模块，机械臂用于执行速度控制指令以及反馈机械臂末端位姿，第二计算模块根据视觉观测系统得到的操作人员手持的指定容器的位姿，结合机械臂反馈的末端位姿和设计好的交接策略，建立虚拟引力势场，计算机械臂末端受到的虚拟力和力矩、机械臂末端在虚拟力和力矩作用下的期望速度以及机械臂的期望关节速度；
[0040]
硬件之间的数据传递关系具体为，rgb
‑
d相机将rgb图像和深度图像发送给第一计算模块，第一计算模块根据接收到的rgb图像和深度图像估计操作人员手持的指定容器的位姿，并将操作人员手持的指定容器的位姿发送给第二计算模块，机械臂将机械臂末端位姿发送给第二计算模块，第二计算模块根据操作人员手持的指定容器的位姿、机械臂末端位姿以及设计好的交接策略得到机械臂关节速度指令，并将机械臂关节速度指令发送给机械臂，机械臂根据接收到的机械臂关节速度指令调整运动状态。
[0041]
作为进一步地改进，本发明所述的视觉观测系统使用的rgb
‑
d相机包括但不限于intel realsense l515，机械臂运动规划与控制系统使用的机械臂包括但不限于ur5，rgb
‑
d相机用于获取rgb
‑
d图像，机械臂用于执行速度控制指令和反馈机械臂末端位姿；相机与机械臂之间的位姿相对关系已经事先标定得知。
[0042]
作为进一步地改进，本发明所述的装置还包括处理器、存储器以及存储在存储器中的程序，所述计算机程序被处理器执行时实现实现机器人与人之间物品传递的人机协作方法的步骤。
[0043]
对比现有的技术，本发明的有益效果在于：
[0044]
当操作人员手持指定容器进入视觉观测系统的观测范围，视觉观测系统可以快速、准确、鲁棒地获取操作人员手持的指定容器的六自由度位姿；在此基础上，机械臂可以柔顺、灵敏地跟随操作人员手持的指定容器运动，且在跟随操作人员手持的指定容器运动
的过程中，机械臂始终保持末端夹爪所持容器的杯口朝上，以避免盛装在其中的物品掉落；当操作人员手持的指定容器位置稳定且杯口朝上时，机械臂可以迅速、准确地在该位置进行物品交接；并且如果当机械臂正在进行物品交接时，操作人员将手持的指定容器突然移开，机械臂可以迅速终止倾倒动作，在恢复末端夹爪所持容器杯口朝上的同时跟随操作人员手持的指定容器，从而大概率防止物品掉落。此项技术可以顺利完成机器人与人之间的物品传递任务，能够应用于需要进行人机物品传递的人机协作领域。
附图说明
[0045]
图1为本发明一种实现机器人与人之间物品传递的人机协作方法中人机协作物品传递系统的流程示意图。
具体实施方式
[0046]
本发明公开了一种实现机器人与人之间物品传递的人机协作方法及装置，由以下系统构成：视觉观测系统以及机械臂运动规划与控制系统，每个系统又包含了为实现特定功能而使用的软件算法和硬件装置。
[0047]
本发明公开了一种实现机器人与人之间物品传递的人机协作方法及装置，包括以下步骤：
[0048]
1)操作人员手持指定容器进入视觉观测系统的观测范围，视觉观测系统的观测范围指相机视野，视觉观测系统根据观测范围内的视觉信息估计操作人员手持的指定容器的六自由度位姿，视觉信息包括rgb图像和深度图像，并将操作人员手持的指定容器的位姿发送给机械臂运动规划与控制系统。
[0049]
2)机械臂运动规划与控制系统根据接收到的操作人员手持的指定容器的位姿，结合机械臂末端的当前位姿以及交接策略，得到机械臂末端的目标位姿，然后根据机械臂末端的目标位姿和当前位姿生成机械臂关节速度控制指令，控制机械臂末端到达目标位姿。
[0050]
视觉观测系统中包括了以下模块：图像采集模块、语义分割模块、语义分割优化模块、区域提取模块以及位姿估计模块，每个模块的详细介绍如下：
[0051]
图像采集模块的功能是采集相机视野中的rgb图像和深度图像，并将其传递给后续的各个模块。
[0052]
很多位姿估计算法，尤其是利用深度神经网络提取像素特征的位姿估计算法，一般需要先进行图像分割来缩小数据处理范围、减少杂乱背景的干扰。为了实现上述的功能，本发明设计了语义分割模块。该模块使用fast
‑
scnn实现，能够标注rgb图像中每个像素点所属的语义类别，即判断rgb图像中的每个像素是否属于rgb图像中表示操作人员手持的指定容器的部分。
[0053]
由于视觉传感器精度以及语义分割算法精度的限制，语义分割模块的结果会将rgb图像边缘的一些像素点误分类为操作人员手持的指定容器。语义分割优化模块对语义分割模块产生的语义分割结果进行优化，语义分割优化模块通过分析语义分割模块产生的语义分割结果中被标记为操作人员手持的指定容器的连通区域，当有多个这样的连通区域时，去除在边缘且像素点数量较少的连通区域，从而优化语义分割结果。
[0054]
区域提取模块的功能是根据语义分割优化模块优化之后的语义分割结果提取rgb
图像中表示操作人员手持的指定容器的像素点和深度图像中表示操作人员手持的指定容器的点云。
[0055]
为了使机器人能够成功将物品从机械臂末端夹爪所持容器中移交到操作人员手持的指定容器中，需要操作人员手持的指定容器的位姿信息。为了实现上述功能，本发明设计了位姿估计模块，该模块使用rede实现，能够根据rgb图像中表示操作人员手持的指定容器的像素点和深度图像中表示操作人员手持的指定容器的点云，对操作人员手持的指定容器进行位姿估计，从而得到其六自由度位姿。
[0056]
视觉观测系统中的图像采集模块用于采集相机视野中的rgb图像和深度图像，语义分割模块用于标注rgb图像中每个像素点所属的语义类别，语义类别有两类，一类是操作人员手持的指定容器，另一类是除操作人员手持的指定容器外的其他所有物体，语义分割优化模块用于优化语义分割模块产生的语义分割结果，区域提取模块用于根据语义分割优化模块优化之后的语义分割结果提取rgb图像中表示操作人员手持的指定容器的像素点和深度图像中表示操作人员手持的指定容器的点云，位姿估计模块用于估计操作人员手持的指定容器的位姿；
[0057]
视觉观测系统中各模块之间的数据传递关系具体为，图像采集模块将rgb图像发送给语义分割模块，语义分割模块根据接收到的rgb图像进行语义分割，并将结果发送给语义分割优化模块，语义分割优化模块对接收到的语义分割结果进行优化，然后将优化之后的语义分割结果发送给区域提取模块，同时图像采集模块将rgb图像和深度图像发送给区域提取模块，区域提取模块根据接收到的优化后的语义分割结果、rgb图像以及深度图像提取表示操作人员手持的指定容器的像素和点云，并将表示操作人员手持的指定容器的像素和点云发送到位姿估计模块，位姿估计模块根据接收到的表示操作人员手持的指定容器的像素和点云得到操作人员手持的指定容器的位姿。
[0058]
机械臂运动规划与控制系统中包括了以下模块：目标位姿计算模块、人工势场建立模块以及导纳控制模块，每个模块的详细介绍如下：
[0059]
由于物品传递任务的复杂性，操作人员手持的指定容器的位姿不能直接作为机械臂末端的目标位姿。为了得到可以使机器人成功完成物品交接的机械臂末端位姿，设计了目标位姿计算模块。该模块根据操作人员手持的指定容器的位姿、机械臂末端的当前位姿以及交接策略得到机械臂末端的目标位姿。具体为，若机械臂末端与操作人员手持的指定容器的位置偏差较小，且操作人员手持的指定容器的姿态是杯口朝上，则使机械臂末端跟随操作人员手持的指定容器，同时进行倾倒，即设定机械臂末端的目标位置为操作人员手持的指定容器的位置的偏高处，目标姿态为使机械臂末端夹爪所持容器杯口斜向下朝向操作人员手持的指定容器的杯口；否则，使机械臂末端跟随操作人员手持的指定容器，同时保持机械臂末端夹爪所持容器杯口朝上，即设定机械臂末端的目标位置为操作人员手持的指定容器的位置的偏高处，目标姿态为使机械臂末端夹爪所持容器杯口朝上。
[0060]
人工势场建立模块的功能是根据机械臂末端目标位姿建立虚拟引力势场并计算机械臂末端所受到的虚拟力和力矩。
[0061]
虚拟引力势场的建立具体为，根据下式建立以机械臂末端的目标位姿为中心的虚拟引力势场：
[0062][0063]
其中，x为待评估处的位姿，x
t
为机械臂末端的目标位姿，k
a
为系数，d
a
为距离阈值，u
att
(x)为x处的虚拟势能。
[0064]
机械臂末端所受到的虚拟力和力矩的计算具体为，根据下式计算机械臂末端在虚拟引力势场中受到的虚拟力和力矩：
[0065][0066]
其中，x
e
为机械臂末端的当前位姿，x
t
为机械臂末端的目标位姿，k
a
为系数，d
a
为距离阈值，f
att
(x
e
)为机械臂末端受到的虚拟力和力矩。
[0067]
机械臂末端的当前位姿x
e
与目标位姿x
t
之间偏差的计算具体为，对于位置，机械臂末端的当前位置(x
e
，y
e
，z
e
)
t
，机械臂末端的目标位置(x
t
，y
t
，z
t
)
t
，偏差根据下式进行计算：
[0068]
e
d
＝(x
e
‑
x
t
，y
e
‑
y
t
，z
e
‑
z
t
)
t
#(3)
[0069]
对于姿态，机械臂末端的当前姿态对应的旋转矩阵r
e
＝[n
e s
e a
e
]，机械臂末端的目标姿态对应的旋转矩阵r
t
＝[n
t s
t a
t
]，偏差根据下式进行计算：
[0070][0071]
所以，机械臂末端的当前位姿x
e
与目标位姿x
t
的偏差为：
[0072][0073]
导纳控制模块的功能是根据机械臂末端受到的虚拟力和力矩计算机械臂关节速度指令，从而实现对机械臂运动状态的控制，进而完成物品交接的任务。
[0074]
机械臂关节速度指令的计算具体为，首先根据下式计算机械臂末端在虚拟力和力矩作用下的期望速度：
[0075][0076][0077]
其中，m为期望的惯性特性，d为期望的阻尼特性，f
att
为机械臂末端受到的虚拟力和力矩，为k时刻机械臂末端的期望线加速度和角加速度，为k时刻机械臂末端的期望线速度和角速度，期望线速度和角速度，
[0078]
然后根据下式计算机械臂关节速度：
[0079][0080]
其中，为机械臂的期望关节速度，j(θ)为雅可比矩阵，v为机械臂末端的期望线
速度，ω为机械臂末端的期望角速度。
[0081]
实现机器人与人之间物品传递的人机协作方法通过以下装置执行：
[0082]
视觉观测系统中使用的装置包括rgb
‑
d相机以及第一计算模块，rgb
‑
d相机用于获取rgb图像和深度图像，第一计算模块用于运行语义分割模块、语义分割优化模块、区域提取模块以及位姿估计模块中的算法。
[0083]
机械臂运动规划与控制系统中使用的装置包括机械臂和第二计算模块，机械臂用于执行速度控制指令以及反馈机械臂末端位姿，第二计算模块根据视觉观测系统得到的操作人员手持的指定容器的位姿，结合机械臂反馈的末端位姿和设计好的交接策略，建立虚拟引力势场并计算机械臂末端受到的虚拟力和力矩、机械臂末端在虚拟力和力矩作用下的期望速度以及机械臂的期望关节速度。
[0084]
实现机器人与人之间物品传递的人机协作装置中视觉观测系统使用的rgb
‑
d相机包括但不限于intel realsense l515，机械臂运动规划与控制系统使用的机械臂包括但不限于ur5。
[0085]
硬件之间的数据传递关系具体为，rgb
‑
d相机将rgb图像和深度图像发送给第一计算模块，第一计算模块根据接收到的rgb图像和深度图像估计操作人员手持的指定容器的位姿，并将操作人员手持的指定容器的位姿发送给第二计算模块，机械臂将机械臂末端位姿发送给第二计算模块，第二计算模块根据操作人员手持的指定容器的位姿、机械臂末端位姿以及设计好的交接策略得到机械臂关节速度指令，并将机械臂关节速度指令发送给机械臂，机械臂根据接收到的机械臂关节速度指令调整运动状态。
[0086]
相机与机械臂之间的位姿相对关系已经事先标定得知，装置还包括处理器、存储器以及存储在存储器中的程序，所述计算机程序被处理器执行时实现实现机器人与人之间物品传递的人机协作方法的步骤。
[0087]
下面，结合附图以及具体实施方式，对本发明的技术方案作进一步地描述：
[0088]
图1为本发明一种实现机器人与人之间物品传递的人机协作方法中人机协作物品传递系统的流程示意图。视觉观测系统根据rgb图像和深度图像估计操作人员手持的指定容器的位姿，并传递给机械臂运动规划与控制系统；机械臂运动规划与控制系统根据接收到的操作人员手持的指定容器的位姿，并结合机械臂末端的位姿以及交接策略，得到机械臂末端的目标位姿，然后以目标位姿为中心建立虚拟引力势场并计算机械臂末端受到的虚拟力和力矩，并由此计算机械臂的关节速度指令，进而控制机械臂的运动状态，完成机器人与人之间的物品传递。视觉观测系统包括图像采集模块、语义分割模块、语义分割优化模块、区域提取模块以及位姿估计模块。机械臂运动规划与控制系统包括目标位姿计算模块、人工势场建立模块以及导纳控制模块。
[0089]
使用rgb
‑
d相机，作为视觉观测系统的传感设备，采集rgb图像和深度图像。
[0090]
语义分割模块使用了fast
‑
scnn，在在线使用该模块之前，需要采集图像并进行标注，以制作训练数据集，然后用训练数据集对此模型进行训练。该模块在线运行时，使用训练好的模型进行语义分割，从而获得rgb图像中表示操作人员手持的指定容器的像素点。
[0091]
语义分割优化模块通过分析语义分割模块产生的语义分割结果中被标记为操作人员手持的指定容器的连通区域，当有多个这样的连通区域时，去除位于边缘且像素点数量较少的连通区域，从而优化语义分割结果。
[0092]
区域提取模块根据语义分割优化模块优化之后的语义分割结果，提取rgb图像中表示操作人员手持的指定容器的像素点和深度图像中表示操作人员手持的指定容器的点云。
[0093]
位姿估计模块使用了rede，在在线使用该模块之前，需要采集图像并进行标注，以制作训练数据集，然后用训练数据集对此模型进行训练。该模块在线运行时，使用训练好的模型进行位姿估计，从而获得操作人员手持的指定容器的位姿。
[0094]
在得到操作人员手持的指定容器的位姿以后，目标位姿计算模块根据操作人员手持的指定容器的位姿、机械臂末端的位姿以及交接策略获得机械臂末端的目标位姿。
[0095]
人工势场建立模块建立以机械臂末端位姿为中心的虚拟引力势场，并计算机械臂末端在虚拟引力势场中受到的虚拟力和力矩。
[0096]
导纳控制模块根据机械臂末端受到的虚拟力和力矩，计算机械臂末端的期望速度，进而得到机械臂的期望关节速度，然后其将关节速度指令发送给机械臂执行，从而实现对机械臂运动状态的控制，完成机器人与人之间物品传递的任务。
[0097]
本实施例中的方法与前述实施例中的装置是基于同一发明构思下的两个方面，本领域技术人员可根据前述描述清楚地了解本实施中的系统的结构及实施过程。
[0098]
为了描述的方便，描述以上装置时以功能分为各种模块分别描述。当然，在实施本发明时可以把各模块的功能在同一个或多个软件和/或硬件中实现。
[0099]
通过以上的实施方式的描述可知，本领域的技术人员可以清楚地了解到本发明可借助软件加必需的通用硬件平台的方式来实现。基于这样的理解，本发明的技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来，该计算机软件产品可以存储在存储介质中，如rom/ram、磁碟、光盘等，包括若干指令用以使得一台计算机设备执行本发明各个实施例或者实施例的某些部分所述的方法，计算机设备可以是个人计算机，服务器，或者网络设备等。
[0100]
描述的装置实施例仅仅是示意性的，其中所述作为分离部件说明的模块或单元可以是或者也可以不是物理上分开的，作为模块或单元示意的部件可以是或者也可以不是物理模块，既可以位于一个地方，或者也可以分布到多个网络模块上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。本领域普通技术人员在不付出创造性劳动的情况下，即可以理解并实施。
[0101]
本发明可用于众多通用或专用的计算系统环境或配置中。例如：个人计算机、服务器计算机、多处理器系统、基于微处理器的系统、小型计算机、大型计算机、包括以上任何系统或设备的分布式计算环境等等。
[0102]
上述实施方式仅为本发明的优选实施方式，不能以此来限定本发明保护的范围，本领域的技术人员在本发明的基础上所做的任何非实质性的变化及替换均属于本发明所要求保护的范围。