人机相互作用机械臂的控制方法技术

人机相互作用机械臂的控制方法，它涉及机械臂在未知环境工作过程中的一种安全控制方法，解决了现有机械手在与人类紧密接触工作时不能准确的对工作环境建模而造成对人类产生误伤害的问题。本发明专利技术机械臂控制器通过关节传感器实时采集关节位置并利用正运动学将关节位置ｑ转换为笛卡尔位置ｘ；计算具有笛卡尔力反馈的实时轨迹规划ｘ↓［ｐｇ］；机械臂控制器通过关节传感器实时采集关节扭矩τ，且通过笛卡尔阻抗控制计算出期望扭矩τ↓［ｒ］；通过电机动态性补偿计算机械臂关节的输入扭矩τ↓［ｍ］。本发明专利技术可有效的检测来自机械臂各个关节的力，当接触对象时，机械臂能够柔顺的接触；当碰撞发生时，机械臂能够保证各方向的接触力在期望力范围内，从而保证机械臂和操作对象的安全。

【技术实现步骤摘要】

本专利技术涉及机械臂的一种控制方法。
技术介绍
传统的工业机器人大多是在已建模的环境中重复相同的操作任务。如今，越来越多的机器人开始应用于医疗、家庭服务、空间探索等未精确建模环境中。相对于传统机器人，这些机器人并不需要很高的速度，但与人类和环境稳定、柔顺和安全的共存是其首要考虑的问题。 机械臂的安全操作从设计上可以分为三类。一类是结构设计，包括减轻机器人的惯性和重量并引进一些柔顺部件，例如柔性关节，弹性连杆和机械阻尼调节器等，这样机械臂在接触物体时能够保证一定的柔性，但并不能避免与环境发生碰撞而损坏对象，而过于柔性的设计，将使机械臂在跟踪效果和响应速度上不够理想；第二类是采用力矩传感器，如此就能快速检测到机器人本身的受力并控制其与环境的接触力，现行的机械臂大多利用力矩传感器检测到碰撞力后，通过紧急制动保护机器人，然而这种方法对于动态环境并不适宜，当人继续撞击机械臂时，将会对人产生伤害；第三类是采用实时的轨迹规划，传统的机械臂路径规划都是离线计算得到，没有融入当前机械臂的状态，这些规划对于已建模的环境适用，但对于未知环境容易引起机械臂与环境间的碰撞。
技术实现思路
本专利技术提供一种，以解决现有机械手在与人类紧密接触工作时不能准确的对工作环境建模而造成对人类产生误伤害的问题。由以下步骤完成一、通过CAD建模准确计算出机械臂的运动学和动力学参数；二、通过基于位置的轨迹规划给定机械臂的末端期望轨迹xd、给定机械臂末端的期望接触力Fcd和机械臂的阻抗参数；三、机械臂控制器通过关节传感器实时采集关节的位置q、速度 和加速度 并利用正运动学将关节的位置q、速度 和加速度 转换为笛卡尔位置x、速度 和加速度 且根据笛卡尔阻抗控制公式计算预接触力 四、通过基于力跟踪的轨迹规划计算具有笛卡尔力反馈的实时轨迹规划xpg；五、机械臂控制器通过关节传感器实时采集关节扭矩τ，且通过笛卡尔阻抗控制计算出期望扭矩τr；六、通过电机动态性补偿计算机械臂关节的输入扭矩τm。 本专利技术具有以下有益效果本专利技术可有效的检测来自机械臂各个关节的力，当接触对象时，机械臂能够柔顺的接触；当碰撞发生时，机械臂能够保证各方向的接触力在期望力范围内，从而保证机械臂和操作对象的安全，本专利技术的优点是适用于具有位置和力感知的串联机器人系统，控制结构简单，便于调节，控制精度高，可以进行人机交互的医疗、家庭作业以及深空探测等未知环境领域。 附图说明 图1是机械臂的控制框图，图2是四自由度机械臂在躲避障碍物时的X-Y坐标位置跟踪曲线图，其中实线代表机械臂的实际位置，虚线代表离线期望位置，点滑线代表实时规划的位置，点线代表障碍物，图3是四自由度机械臂在躲避障碍物时的X-Y方向受力曲线图，其中实线代表X方向的受力，虚线代表Y方向的受力。 具体实施例方式具体实施方式一结合图1说明本实施方式，本实施方式由以下步骤完成一、通过CAD建模准确计算出机械臂的运动学和动力学参数；二、通过基于位置的轨迹规划给定机械臂的末端期望轨迹xd、给定机械臂末端的期望接触力Fcd和机械臂的阻抗参数；三、机械臂控制器通过关节传感器实时采集关节的位置q、速度 和加速度 并利用正运动学将关节的位置q、速度 和加速度 转换为笛卡尔位置x、速度 和加速度 且根据笛卡尔阻抗控制公式计算预接触力 四、通过基于力跟踪的轨迹规划计算具有笛卡尔力反馈的实时轨迹规划xpg；五、机械臂控制器通过关节传感器实时采集关节扭矩τ，且通过笛卡尔阻抗控制计算出期望扭矩τr；六、通过电机动态性补偿计算机械臂关节的输入扭矩τm。机器人运动碰到障碍即可柔顺的接触障碍物，并自动产生新的轨迹xpg。具体实施方式二本实施方式与具体实施方式一的不同点是本实施方式在步骤三中的笛卡尔阻抗控制公式为 其中，是机械臂笛卡尔空间位置误差；x、xd是实际末端点位置和期望位置；Ad、Dd，和Kd为对称正定阵，分别为机械臂的期望惯性、阻尼和刚度；Fext是外力分量；笛卡尔速度 和加速度 根据雅克比矩阵求得。具体实施方式三本实施方式与具体实施方式一或二的不同点是本实施方式在步骤五中所述的笛卡尔阻抗控制过程如下 依据拉格朗日方程，机械臂的位置x和关节扭矩τ之间的动态特性表示为公式(2) 其中，J(q)-Tg(q)为机械臂的重力项；g(q)为关节的重力项；Λ(x)和 可通过公式(3)和公式(4)得到； Λ(x)＝J(q)-TM(q)J(q)-1 (3) 其中，M(q)和 分别代表各关节的惯性矩阵和哥氏力与离心力合力的矩阵； 依据公式(2)和步骤三的笛卡尔阻抗控制公式(1)直接求得笛卡尔阻抗控制器公式，且控制输入Fτ＝J(q)-Tτ求得如下 (5) 将期望惯性Λd与机械臂惯性Λ(x)设计成一致，由此上式可变为 如此，机械臂就具有柔顺特性。具体实施方式四本实施方式与具体实施方式三的不同点是本实施方式在步骤四中所述的实时轨迹规划过程如下 依据步骤三的笛卡尔阻抗控制公式，机械臂末端的预估接触力 可以表示成 定义恒力值Fcd为期望碰撞力；在T时刻，经过一段时间Δt，满足公式8时表示碰撞发生， 此时，机械臂所受的力矩与Fcd相等，假定xpg是机械臂末端重新规划的轨迹，则 (9) 选定 和 分别是基于位置轨迹规划和基于力的运动规划权重系数，所规划的轨迹形式如下 将公式(10)代入公式(9)中，可以表示为 则权重系数 为 将公式(10)取代阻抗方程式(1)的xd可以推导出 由此，我们就可以得知当预估力小于期望力时，机械臂表现的是二阶阻抗特性，当预估力达到期望力时，机械臂将以恒力接触碰撞物，与人手相似，根据操作对象的不同，我们可以调整期望接触力矩Fcd的大小，当碰撞发生时，机械臂能够根据期望力矩随意移动而不损害机械臂和操作对象。具体实施方式五本实施方式与具体实施方式四的不同点是本实施方式中基于笛卡尔力反馈的轨迹规划满足以下几个条件 a、当碰撞未发生时xpg＝xd，即且 b、 和 只与预估力 有关，且随着 增大， 逐渐减小， 随之增大； c、当 时，为保证末端力仍然维持恒力值Fcd，则且 d、且保证xpg， 均连续； e、 具体实施方式六本实施方式与具体实施方式四的不同点是本实施方式在步骤六中所述的电机动态补偿过程如下 将基于笛卡尔力反馈的轨迹规划公式(10)代入阻抗控制器公式(6)中，并根据Fτ＝J(q)-Tτ可求得关节的所需力矩为 考虑电机的动态性能 其中，θ代表除以关节减速比的电机角度；K和B分别代表关节刚性和电机的惯性；τm、τF分别是电机的输入扭矩和摩擦项， 将公式(13)代入公式(14本文档来自技高网...

【技术保护点】
人机相互作用机械臂的控制方法，其特征在于它由以下步骤完成：一、通过ＣＡＤ建模准确计算出机械臂的运动学和动力学参数；二、通过基于位置的轨迹规划给定机械臂的末端期望轨迹ｘ↓［ｄ］、给定机械臂末端的期望接触力Ｆ↓［ｃｄ］和机械臂的阻抗参数；三、机械臂控制器通过关节传感器实时采集关节的位置ｑ、速度＊和加速度＊并利用正运动学将关节的位置ｑ、速度＊和加速度＊转换为笛卡尔位置ｘ、速度＊和加速度＊，且根据笛卡尔阻抗控制公式计算预接触力＊；四、通过基于力跟踪的轨迹规划计算具有笛卡尔力反馈的实时轨迹规划ｘ↓［ｐｇ］；五、机械臂控制器通过关节传感器实时采集关节扭矩τ，且通过笛卡尔阻抗控制计算出期望扭矩τ↓［ｒ］；六、通过电机动态性补偿计算机械臂关节的输入扭矩τ↓［ｍ］。

【技术特征摘要】

【专利技术属性】
技术研发人员：黄剑斌，谢宗武，熊根良，刘宏，蒋再男，
申请(专利权)人：哈尔滨工业大学，
类型：发明
国别省市：93[中国|哈尔滨]