[发明专利]一种基于虚拟夹具的双人遥操作训练方法

摘要

本发明涉及一种基于虚拟夹具的双人遥操作训练方法，把虚拟夹具引导力加入到教练员与新手之间的训练中，导引新手进行操作，新手感受到的引导力的大小与教练员导引操作的偏离程度成正相关系，方向与偏离成相反关系，且虚拟夹具评价指标随新手的训练程度可进行调整。根据新手训练程度，调整新手训练的评价指标，可实时更新训练进程和训练强度。

主权项

1.一种基于虚拟夹具的双人遥操作训练方法，其特征在于步骤如下：步骤1：建立模型在操作主端，包括教练员和新手，所述的教练员是指具有丰富操作经验的人员，在操作训练中，起决定控制作用，所述的新手指缺少操作经验的人员，需要在引导下进行操作；在操作从端，包括一个双臂机器人，教练员和新手分别通过手控器控制双臂机器人；在操作训练任务过程中，建立教练员与新手的双人动力学模型：其中，和分别表示教练员和新手对手控器的作用力；和分别表示教练员和新手的控制力；和分别表示教练员和新手左右手驱动力的质量模型阻抗，s为拉普拉斯算子；和分别表示教练员和新手的速度变量；和分别表示从端双臂的控制力；和分别表示从端环境对从端操作双臂的实际作用力；和分别表示从端左右两个机械臂驱动力的质量模型阻抗；和分别表示从端操作臂的速度；在训练新手的过程中，教练员起导引作用，接受来自从端的环境力，即将从端环境力反馈给教练员：F_h1＝F_e  (2)其中，表示教练员左手和右手的操作力，表示作用于从端双臂上的从端环境力；新手根据教练员手的运动，在虚拟夹具的导引下，作用在新手上的虚拟力为：F_h2＝F_VF  (3)其中，表示新手左手和右手的操作力，表示作用于新手上的虚拟夹具引导力，本发明采用导引型虚拟夹具；因此，建立基于虚拟夹具的教练员对新手的位置模型：χ_sd(t)＝α_adχ_h1(t)+α_1‑adχ_h2(t)  (4)其中，表示双臂机器人的从端期望位置，和分别表示教练员和新手操作的机器人末端位置，α_ad表示对应于教练员的评价指标，α_1‑ad＝1‑α_ad表示对应于新手的评价指标；步骤2：设计自适应导引型虚拟夹具本发明采用导引型管道虚拟夹具作为引导新手运动的引导路径，将虚拟夹具评价指标作为新手操作的一个约束；虚拟夹具的生成是由教练员操作的机器人末端位置χ_h1(t)和管道半径R_VF确定的，教练员手的运动路径就是虚拟夹具管道的形状，新手操作的机器人末端位置χ_h2(t)在虚拟夹具管道内运动，在教练员训练新手操作的过程中，将会有一个阻尼系数为K_VF的力加在新手上，防止新手越过教练员加给新手的管道型虚拟夹具的边界；判断新手操作的机器人末端是否越过教练员手运动生成的虚拟夹具的准则是其中，和分别表示新手操作的机器人左右手的末端位置，和分别表示教练员操作的机器人左右手的末端位置，和分别为作用在新手操作的左右机械臂上的虚拟夹具管道的半径；当新手操作的机器人末端超过虚拟夹具管道的时候，此时，加在新手上的虚拟力为F_VF＝K_VF(χ_h2‑χ_h1)，其中，K_VF为对应于虚拟力的阻尼系数；根据教练员给予的主观判断和新手受训程度，虚拟夹具管道半径R_VF的大小采用下式R_VF＝R₀‑G₀ln(1‑α_1‑ad+ε)  (7)其中，R₀为管道最小半径，G₀为增益，α_1‑ad为新手训练的自适应训练律，ε是一个0～0.1的很小的数，目的是确保ln(·)有值；步骤3：设计虚拟夹具评价指标将新手感受到的虚拟力作为虚拟夹具评价指标的表现形式，当新手运动方向偏离教练员手的时候，作用在新手上的虚拟力将变大；当新手运动方向能很好地跟随教练员手的时候，作用在新手上的虚拟力将变小；作用于新手上的虚拟力的特性值Π_h2(t)，采用基于广义高斯函数表示，即其中，F_VF(t)表示t时刻的F_VF，δ_VF和m_VF用来描述特性值Π_h2(t)的特征，δ_VF表示高斯函数隐节点的扩展常数，m_VF通常取1；因此，根据特性值Π_h2(t)，得到虚拟夹具评价指标如下式，其取值范围为0～1；α_Π(t)＝1‑Π_h2(t)  (9)α_Π(t)值为1表示教练员的引导力在操作训练中起绝对作用，新手的运动路径完全不能逾越教练手的运动路径范围；α_Π(t)值为0表示虚拟夹具不起任何作用，新手的运动不受教练员导引的影响；步骤4：建立新手训练的评价指标α_1‑ad＝α_Π(t)  (10)上式的评价指标仅仅考虑了从端反馈给操作者力的影响，以及新手对于操作训练的影响，没有将教练员的主观操控影响考虑进去，但实际上，教练员对整个操控起支配决定作用，并具有否决权，因此，新手训练的评价指标α_1‑ad修改为α_1‑ad＝α_Δ(t)·α_Π(t)  (11)其中，0<α_Δ<1表示由教练员根据实际操作任务所确定的新手操作修正参数；步骤5：操作训练在操作训练中，根据式(11)建立的新手训练的评价指标α_1‑ad，通过特性值和α_Δ的乘积后得到的评价指标实现教练员对新手的操作训练，当α_1‑ad较小时，教练员对新手的控制较强，新手感受到的虚拟力较大；随着训练的进行，新手熟练度增加，α_1‑ad也开始增大，教练员对新手的控制减弱，新手能够较好地跟随教练员手的运动，感受到的虚拟力也变小；通过评价指标α_1‑ad，实现教练员对新手的导引，利用虚拟夹具生成虚拟力，施加在新手上，达到训练新手的目的。