【技术实现步骤摘要】
本专利技术涉及自动控制技术与机器人控制，特别是指一种基于力感知的机器人人机物理协作共享可变导纳控制方法。
技术介绍
1、随着机器人技术的飞速发展，人机协作逐渐成为工业、医疗、服务等领域的重要研究热点。在人机协作中，人类在处理复杂任务和突发情况方面表现出更强的适应性，而机器人在体力和精度方面提供帮助。为了实现智能高效的人机协作，变导纳控制和人机共享控制这两个关键概念在提高协作性能和灵活性方面发挥了关键作用。
2、人机协作搬运是一种常见的协作应用方式。在人机协作搬运任务中人类操作者直接通过对机器人末端执行器施加力来操纵机器人，机器人表现出顺应性。我们希望协作机器人能够更加主动响应人类的期望运动而并非完全被动的跟随人类执行，加重人类的操作负担，这就要求机器人能够获取人类的操作意图和运动意图。协作机器人根据获取到的力和速度等信息对人类的操作意图进行估计与预测，调整自身协作特性，提高人机交互过程的易用性和灵活性。
3、在早期的研究工作中，可变阻抗控制器的设计依赖于对人体手臂阻抗的估计，根据估计的刚度调整阻尼参数，这种做法对实验条件的要求比较苛刻，只能实现实验室层面的应用。另外，一些研究通过识别不同模式的高频外力，相应地调整阻抗参数，使机器人能够适应外力，该方法由于需要分类识别算法，很大程度上会影响算法的实时性。
4、从以上可看出，当前协作机器人的变导纳控制方案大多存在实时性差、难以应用等问题，很少能应用于实际的人机协作场景。此外，在一些非结构化环境和半结构化环境中，协作任务不能完全由人类引导与控制，而是
技术实现思路
1、本专利技术提供了一种基于力感知的机器人人机物理协作共享可变导纳控制方法，以解决现有的控制方案所存在的实时性差、难以应用的技术问题。
2、为解决上述技术问题，本专利技术提供了如下技术方案：
3、一方面，本专利技术提供了一种基于力感知的机器人人机物理协作共享可变导纳控制方法，用于人机协作控制系统，所述人机协作控制系统包括协作机械臂和计算机；所述协作机械臂的末端设置有夹爪，用于夹持待搬运物体；所述协作机械臂的各关节上内置有关节力矩传感器，用于获取协作机械臂的关节力矩；所述协作机械臂与所述计算机通信连接，所述计算机用于实现所述基于力感知的机器人人机物理协作共享可变导纳控制方法，以控制所述协作机械臂与操作者配合，完成搬运任务；所述机器人人机物理协作共享可变导纳控制方法包括：
4、获取协作机械臂当前的状态信息；其中，所述状态信息包括协作机械臂的末端位置、速度以及与外界的交互力；交互力通过协作机械臂各关节力矩计算；
5、基于协作机械臂当前的状态信息，采用基于力的变导纳共享控制框架，生成所述协作机械臂的期望轨迹；其中，所述基于力的变导纳共享控制框架采用导纳控制模型基于所述状态信息生成所述协作机械臂的期望轨迹；且所述导纳控制模型中的阻尼项与刚度项能够根据操作者的运动意图实时调节；
6、控制所述协作机械臂按照所述期望轨迹移动，以与操作者进行配合搬运。进一步地，所述末端位置、速度与关节力矩表现形式如下：
7、xe＝[x,y,z]t
8、v＝[vx,vy,vz]t
9、τ＝[τ1,τ2,…,τ7]t
10、其中，xe表示协作机械臂的末端位置；x、y、z分别表示协作机械臂末端执行器相对于协作机械臂基坐标系的x轴、y轴和z轴坐标；v表示协作机械臂的末端速度；vx、vy、vz分别表示协作机械臂末端执行器相对于协作机械臂基坐标系的x轴、y轴和z轴运动速度；τ表示协作机械臂各关节力矩；τi表示协作机械臂与所搬运物体交互时第i个关节的关节力矩，i＝1,2,3,4,5,6,7。
11、进一步地，所述协作机械臂末端与所搬运物体产生的交互力与所述协作机械臂各关节力矩关系表示如下：
12、τ＝jtfh
13、其中，jt表示所述协作机械臂的雅各比矩阵的转置；fh表示所述协作机械臂末端与所搬运物体产生的交互力。
14、进一步地，所述基于力的变导纳共享控制框架在导纳控制模型的阻尼项中设计阻尼自适应律，使得所述导纳控制模型中的阻尼项能够根据操作者的运动意图实时调节，从而使协作机械臂对操作者运动意图表现出不同的特性，以降低操作者在任务中的负担；并且所述基于力的变导纳共享控制框架在导纳控制模型的刚度项中设计刚度自适应律，使得所述导纳控制模型中的刚度项能够根据操作者的运动意图实时调节，从而使协作机械臂在与操作者存在控制目标分歧时能够及时调整自身的笛卡尔刚度，从而使操作者能够干预协作机械臂的子任务并在必要时进行主导，从而完成一些类似紧急避障的附加任务。
15、进一步地，在导纳控制模型的阻尼项中设计阻尼自适应律，包括：
16、通过协作机械臂的末端速度，得到阻尼自适应调节的初步判定条件如下：
17、
18、其中，v和vthres分别表示协作机械臂相应维度的速度和速度阈值；b表示阻尼值；b(|fh|)表示随交互力变化的阻尼值函数；
19、通过协作机械臂末端与所搬运物体产生的交互力fh，使协作机械臂尽可能根据操作者的操作意图来调节阻尼项；得到阻尼自适应调节的最终判定条件如下：
20、
21、其中，bmax和bmin分别最大和最小阻尼设定值；ft1和ft2表示两个力阈值，ft1和ft2的中间值为fm；kf表示正增益参数；e表示自然常数。
22、进一步地，在导纳控制模型的刚度项中设计刚度自适应律，包括：
23、通过协作机械臂的末端位置xe和交互力fh，设计刚度自适应律形式如下：
24、
25、ψ＝afδ+bdδ
26、
27、
28、其中，k(t)表示当前时刻的刚度值；-α(k(t)-k0)为刚度恢复项，与时间t相关；α为恢复项正增益参数；-βψ表示衰减项；β为衰减项正增益参数；k0表示刚度初始值，初始化为最大值；b是影响刚度对偏差距离dδ变化敏感性的常数；a是影响刚度对交互力与设定阈值的差fδ变化敏感性的常数；d表示所搬运物体当前位置与设定工作平面在z方向的偏差距离；fthres和dthres分别表示设定的力阈值与偏差距离阈值；fh,z表示协作机械臂在z方向的交互力。
29、进一步地，所述基于力的变导纳共享控制框架表示为：
30、
31、
32、
33、x0＝[0,0,z0]t
34、其中，x0表示协作机械臂在z方向上的参考位置；x、分别表示所述协作机械臂通过所述导纳模型计算得到的期望位置、速度和加速度；fh表示所述协作机械臂末端与所搬运物体产生的交互力；madm、分别为所述导纳模型的惯性、阻尼和刚度参数矩阵；c本文档来自技高网...
【技术保护点】
1.一种基于力感知的机器人人机物理协作共享可变导纳控制方法，用于人机协作控制系统，所述人机协作控制系统包括协作机械臂和计算机；所述协作机械臂的末端设置有夹爪，用于夹持待搬运物体；所述协作机械臂的各关节上内置有关节力矩传感器，用于获取所述协作机械臂的关节力矩；所述协作机械臂与所述计算机通信连接，所述计算机用于实现所述基于力感知的机器人人机物理协作共享可变导纳控制方法，以控制所述协作机械臂与操作者配合，完成搬运任务；其特征在于，所述机器人人机物理协作共享可变导纳控制方法包括：
2.如权利要求1所述的基于力感知的机器人人机物理协作共享可变导纳控制方法，其特征在于，所述末端位置、速度与关节力矩表现形式如下：
3.如权利要求2所述的基于力感知的机器人人机物理协作共享可变导纳控制方法，其特征在于，所述协作机械臂末端与所搬运物体产生的交互力与所述协作机械臂各关节力矩关系表示如下：
4.如权利要求1所述的基于力感知的机器人人机物理协作共享可变导纳控制方法，其特征在于，所述基于力的变导纳共享控制框架在导纳控制模型的阻尼项中设计阻尼自适应律，使得所述导纳控制模型中
5.如权利要求4所述的基于力感知的机器人人机物理协作共享可变导纳控制方法，其特征在于，在导纳控制模型的阻尼项中设计阻尼自适应律，包括：
6.如权利要求5所述的基于力感知的机器人人机物理协作共享可变导纳控制方法，其特征在于，在导纳控制模型的刚度项中设计刚度自适应律，包括：
7.如权利要求6所述的基于力感知的机器人人机物理协作共享可变导纳控制方法，其特征在于，所述基于力的变导纳共享控制框架表示为：
8.如权利要求1所述的基于力感知的机器人人机物理协作共享可变导纳控制方法，其特征在于，控制所述协作机械臂按照所述期望轨迹移动，包括：
...【技术特征摘要】
1.一种基于力感知的机器人人机物理协作共享可变导纳控制方法，用于人机协作控制系统，所述人机协作控制系统包括协作机械臂和计算机；所述协作机械臂的末端设置有夹爪，用于夹持待搬运物体；所述协作机械臂的各关节上内置有关节力矩传感器，用于获取所述协作机械臂的关节力矩；所述协作机械臂与所述计算机通信连接，所述计算机用于实现所述基于力感知的机器人人机物理协作共享可变导纳控制方法，以控制所述协作机械臂与操作者配合，完成搬运任务；其特征在于，所述机器人人机物理协作共享可变导纳控制方法包括：
2.如权利要求1所述的基于力感知的机器人人机物理协作共享可变导纳控制方法，其特征在于，所述末端位置、速度与关节力矩表现形式如下：
3.如权利要求2所述的基于力感知的机器人人机物理协作共享可变导纳控制方法，其特征在于，所述协作机械臂末端与所搬运物体产生的交互力与所述协作机械臂各关节力矩关系表示如下：
4.如权利要求1所述的基于力感知的机器人人机物理协作共享可变导纳控制方法，其特征在于，所述基于力的变导纳共享控制框架在导纳控制模型的阻尼项中设计阻尼自适应律，使得所述导纳控制模型中的阻尼项...
【专利技术属性】
技术研发人员：于欣波，黄伟，吴逸帆，张爽，冯楠，侯静怡，张冬浩，贺威，李擎，
申请(专利权)人：北京科技大学，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。