基于在线接触增量辨识的灵巧手自适应抓取力控制方法
本发明涉及电子信息,具体地涉及一种基于在线接触增量辨识的灵巧手自适应抓取力控制方法。
背景技术:
1、灵巧手抓取未知或半未知物体时,目标物体的材料、局部形状、接触姿态以及手指机构的传动特性存在差异。即使主动关节执行相同的角度增量,不同接触条件下产生的法向接触力变化也可能明显不同。
2、现有灵巧手抓取力控制方法通常采用固定控制参数、预设接触模型或预先标定的力-位移映射关系。在相对柔软的接触条件下,单位主动关节角度变化引起的法向接触力变化较小,容易导致抓取力建立速度较慢;在相对刚硬的接触条件下,法向接触力上升较快,容易产生峰值超调和抓取力波动。因此,同一组固定控制参数难以同时适应不同接触条件。
3、部分现有方法通过在线估计环境刚度或接触参数调整控制量,但在接触初期有效数据较少,辨识结果的可靠程度尚未稳定,直接依据辨识结果进行较大幅度调节仍可能引起超调。与此同时,多指灵巧手的各手指通常不能同时建立接触,先接触手指与未接触手指之间还存在低力保持和继续闭合的协调问题,不能很好适应多指异步接触过程。
技术实现思路
1、鉴于此,本发明提供一种基于在线接触增量辨识的灵巧手自适应抓取力控制方法,以解决现有技术中固定参数抓取力控制方法难以适应不同接触条件、不能很好适应多指异步接触过程的问题。
2、一种基于在线接触增量辨识的灵巧手自适应抓取力控制方法,包括:
3、s1,接触建立阶段,采用位置控制使各手指运动,获取各手指的法向接触力测量值和主动关节状态,根据法向接触力确定接触状态,使已接触手指维持低力接触、未接触手指继续闭合;全部手指建立接触后,切换至抓取力调节状态,对法向接触力测量值进行平滑处理,得到平滑法向接触力,并构造平滑法向接触力增量、平滑法向接触力变化率和等效压入量增量;
4、s2,根据上一控制周期的平滑法向接触力增量和等效压入量增量,建立用于预测当前控制周期平滑法向接触力增量的在线接触增量响应模型,并以接触力增量记忆系数和等效接触增量增益作为待辨识参数;
5、s3,根据在线接触增量响应模型计算当前控制周期的平滑法向接触力增量预测值,将该预测值与实际值之差作为模型残差,利用模型残差更新接触力增量记忆系数和等效接触增量增益;对模型残差的绝对值进行平滑处理得到残差平滑值,并根据模型残差和有效辨识条件更新辨识可靠度;
6、s4,根据更新后的等效接触增量增益确定相对接触柔软度,并将相对接触柔软度和辨识可靠度映射为非线性收敛权重;
7、s5,根据残差平滑值确定动态预测时域,根据当前控制目标法向接触力与平滑法向接触力计算当前法向接触力误差,并结合平滑法向接触力变化率和动态预测时域计算预测力误差;根据预测力误差和非线性收敛权重确定下一控制周期的期望平滑法向接触力增量;
8、s6,利用更新后的在线接触增量响应模型,将期望平滑法向接触力增量反解为未经单调加载约束的等效压入量增量,并根据当前法向接触力误差对等效压入量增量施加单调加载约束,得到最终期望等效压入量增量;
9、s7,将最终期望等效压入量增量转换为期望主动关节角度增量,计算下一控制周期的主动关节指令角并执行;执行后重新获取各手指的法向接触力测量值和主动关节状态,进行下一控制周期的闭环迭代。
10、根据本发明提供的基于在线接触增量辨识的灵巧手自适应抓取力控制方法,具有以下有益效果:
11、1.本发明直接利用平滑法向接触力增量和等效压入量增量,在线辨识实际接触增量响应模型,无需预先获取目标物体的接触刚度或材料类别,从而提高了对不同接触条件的适应能力,解决了现有方法因依赖先验模型而难以应用于未知物体的技术问题。
12、2.本发明根据模型残差实时更新模型参数和辨识可靠度,并创造性地利用辨识出的等效接触增量增益映射为相对接触柔软度,进而调整非线性收敛权重。在软接触(增益小)时允许更积极的建力作用,在硬接触(增益大)时反解出的压入量自然减小,从而兼顾了抓取力建立速度和超调抑制效果。
13、3.本发明在平滑法向接触力未超过当前控制目标法向接触力时,对等效压入量增量施加单调加载约束,使手指继续加载或暂停加载而不进行反向卸载;在平滑法向接触力超过当前控制目标法向接触力时,解除所述单调加载约束,允许采用负向增量修正法向接触力超调,从而减少抓取力反复调节和波动。
14、4.本发明使已经建立接触的手指维持低力接触,使尚未建立接触的手指继续闭合,并在参与抓取的全部手指建立接触后统一进行抓取力调节,避免先接触手指在等待过程中持续增大接触力,从而适应多指异步接触过程。
15、5.本发明以各手指的法向接触力和主动关节状态作为控制输入,将最终期望等效压入量增量转换为主动关节位置指令,并通过执行后的反馈信息逐控制周期进行闭环迭代,使所述方法能够接入现有灵巧手主动关节位置控制系统。
1.一种基于在线接触增量辨识的灵巧手自适应抓取力控制方法,其特征在于,包括:
2.根据权利要求1所述的基于在线接触增量辨识的灵巧手自适应抓取力控制方法,其特征在于,步骤s1中,采用接通阈值和断开阈值确定各手指的接触状态,且;当未接触手指的法向接触力测量值不低于时,判定手指与目标物体建立接触;当已接触手指的法向接触力测量值低于时,判定手指与目标物体分离;当法向接触力测量值位于与之间时,保持上一控制周期的接触状态不变。
3.根据权利要求2所述的基于在线接触增量辨识的灵巧手自适应抓取力控制方法,其特征在于,步骤s1中,第根手指在第个控制周期的平滑法向接触力、平滑法向接触力增量、平滑法向接触力变化率、等效压入量增量分别满足:
4.根据权利要求3所述的基于在线接触增量辨识的灵巧手自适应抓取力控制方法,其特征在于,步骤s2中,所述在线接触增量响应模型满足:
5.根据权利要求4所述的基于在线接触增量辨识的灵巧手自适应抓取力控制方法,其特征在于,步骤s3中,将当前控制周期的平滑法向接触力增量与平滑法向接触力增量预测值之间的差值作为模型残差,利用力尺度和压入量尺度构造归一化更新分母:
6.根据权利要求5所述的基于在线接触增量辨识的灵巧手自适应抓取力控制方法,其特征在于,步骤s3中,对模型残差的绝对值进行平滑处理以得到残差平滑值:
7.根据权利要求6所述的基于在线接触增量辨识的灵巧手自适应抓取力控制方法,其特征在于,步骤s4中,根据更新后的等效接触增量增益计算相对接触柔软度,并根据相对接触柔软度和辨识可靠度计算非线性收敛权重:
8.根据权利要求7所述的基于在线接触增量辨识的灵巧手自适应抓取力控制方法,其特征在于,步骤s5中,根据残差平滑值计算预测偏差权重,并在最小预测时域和最大预测时域之间确定动态预测时域:
9.根据权利要求8所述的基于在线接触增量辨识的灵巧手自适应抓取力控制方法,其特征在于,步骤s6中,将下一控制周期的期望平滑法向接触力增量代入更新后的在线接触增量响应模型,反解得到未经单调加载约束的等效压入量增量:
10.根据权利要求9所述的基于在线接触增量辨识的灵巧手自适应抓取力控制方法,其特征在于,步骤s7中,期望主动关节角度增量和下一控制周期的主动关节指令角满足:
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com