一种机器人姿势保持拖动示教的方法及系统技术方案

本发明专利技术属于工业机器人领域，具体涉及一种机器人姿态保持拖动示教的方法及系统，方法包括以下步骤：步骤1：获得t时刻的机器人所有关节的角度值向量、位姿向量以及速度向量；步骤2：建立机器人关节空间控制模型；步骤3：计算机器人在t时刻下机器人所有关节的期望驱动力矩值：步骤4：将t时刻下所有关节的期望驱动力矩向量中的每个关节的期望驱动力矩值与该关节的安全阈值进行对比，实现姿态保持的拖动示教。本发明专利技术能在姿态保持固定的状态下拖动机器人末端执行器在任务空间中运动，扩展了拖动示教的应用场景。

A Method and System of Robot Posture Holding and Dragging Instruction

The invention belongs to the field of industrial robots, and specifically relates to a method and system for robot attitude holding and dragging instruction. The method comprises the following steps: step 1: obtaining the angle vector, position vector and velocity vector of all joints of a robot at t time; step 2: establishing the space control model of a robot joint; step 3: computer robot at t time; and all joints of a robot at t time. Expected driving moment of the joint: Step 4: Compare the expected driving moment of each joint in the expectant driving moment vector of all joints under T-Time with the safety threshold of the joint, and realize the drag teaching of attitude preservation. The invention can move the end effector of the dragging robot in the task space while the attitude remains fixed, and expands the application scenario of the dragging demonstration.

【技术实现步骤摘要】
一种机器人姿势保持拖动示教的方法及系统
本专利技术属于工业机器人领域，具体涉及一种机器人姿态保持拖动示教的方法及系统。
技术介绍
工业机器人在投入生产之前通常需要编程者采用各种示教方法“告知”机器人所要进行的动作信息和作业信息，现有的示教方法包括示教盒示教和拖动示教。传统的示教盒示教要求操作者具有一定的机器人技术知识和经验，示教效率较低。与示教盒示教相比，拖动示教可以无需操作者具备机器人编程经验，操作简单且快速，极大地提高了示教的友好度和效率。现有的拖动示教方法是通过建立机器人逆动力学模型，求解各关节在任意角度时需要补偿的重力矩和摩擦力矩来实现的。然而在机器人的实际使用过程中，往往要求在拖动示教过程中保持末端执行器姿态的固定，例如医药行业常出现的移液操作。现有的拖动示教方法无法满足此类使用要求，造成拖动示教方法实际应用中的不便。
技术实现思路
为了解决现有技术中存在的拖动示教过程中末端执行器姿态无法固定导致实际应用中不便的问题，本专利技术提供了一种机器人姿态保持拖动示教方法及系统，采用如下的技术方案：一种机器人姿态保持拖动示教的方法，包括以下步骤：步骤1：获得t时刻的机器人所有关节的角度值向量q、位姿向量X以及速度向量t≥0；步骤2：设置拖动硬度参数、拖动阻尼参数、所有关节的安全阈值和运动模型参数，建立机器人关节空间控制模型；步骤3：将步骤1测量的t时刻所有关节的角度值向量q、位姿向量X以及速度向量代入步骤2建立的机器人关节空间控制模型，采用式Ⅰ计算机器人在t时刻下机器人所有关节的期望驱动力矩值：其中，Γ表示t时刻机器人所有关节的期望驱动力矩向量，J(q)表示t时刻的机器人速度雅各比矩阵，B表示拖动阻尼参数，K表示拖动硬度参数，Xd表示t时刻下期望位姿向量，表示t时刻下期望速度向量，G表示t时刻下所有关节的重力补偿向量；步骤4：将步骤3得到的机器人在t时刻下所有关节的期望驱动力矩向量中的每个关节的期望驱动力矩值与该关节的安全阈值进行对比，若均未超出安全阈值则将所有关节的期望驱动力矩值发送给关节电机驱动系统，实现姿态保持的拖动示教，若存在超出安全阈值的期望驱动力矩值，则向关节电机驱动系统发送停止运动指令。一种机器人姿态保持拖动示教系统，该示教系统包括：参数设置模块、状态观测模块、模型构建模块、力矩计算模块和安全保护模块；所述参数设置模块，用于设置拖动硬度参数、拖动阻尼参数、所有关节的安全阈值和机器人关节空间控制模型需要的运动模型参数；所述状态观测模块，用于监测所述机器人在某一时刻的所有关节的角度测量值；所述模型构建模块，用于建立机器人关节空间控制模型；所述力矩计算模块，用于计算获得某一时刻下机器人所有关节的期望驱动力矩值；所述安全保护模块，用于根据某一时刻下机器人所有关节的期望驱动力矩值和每个关节的安全阈值，判断所述机器人是否处于安全状态，并根据所述状态输出机器人停止运动指令。进一步的，所述参数设置模块中的运动模型参数为DH参数。进一步的，所述状态观测模块通过关节电机尾部的绝对式编码器获得所有关节的角度测量值。进一步的，所述力矩计算模块是一个结合PD控制律的机器人关节空间控制模型。本专利技术还具有以下有益效果：(1)本专利技术能在姿态保持固定的状态下拖动机器人末端执行器在任务空间中运动，扩展了拖动示教的应用场景，通过将机器人任务空间控制模型转换到关节空间；将PD控制律应用于机器人关节空间控制模型；调节控制模型中的参数矩阵，实现机器人姿态保持的拖动示教功能。(2)本专利技术解决了机器人在拖动示教的过程中，无法保持末端执行器姿态固定的问题，通过设置参数可以方便地修改可拖动的方向，提升了用户的使用体验。附图说明图1为根据本专利技术的一个实施例的机器人姿态保持拖动示教系统的结构示意图；图2为根据本专利技术的一个实施例的关节空间控制模型框架图；图3为根据本专利技术的一个实施例的机器人末端执行器所受外力随时间的变化关系示意图；图4为根据本专利技术的一个实施例的机器人末端执行器的位置变化曲线；图5为根据本专利技术的一个实施例的机器人末端执行器的姿态变化曲线。具体实施方式一种机器人姿态保持拖动示教的方法，包括以下步骤：步骤1：获得t时刻的机器人所有关节的角度值向量q、位姿向量X以及速度向量t≥0；所述位姿表示机器人末端执行器的位置和姿态；步骤2：设置拖动硬度参数、拖动阻尼参数、所有关节的安全阈值和运动模型参数，建立机器人关节空间控制模型；步骤3：将步骤1测量的t时刻所有关节的角度值向量q、位姿向量X以及速度向量代入步骤2建立的机器人关节空间控制模型，采用式Ⅰ计算机器人在t时刻下机器人所有关节的期望驱动力矩值：其中，Γ表示t时刻机器人所有关节的期望驱动力矩向量，J(q)表示t时刻的机器人速度雅各比矩阵，B表示拖动阻尼参数，K表示拖动硬度参数，Xd表示t时刻下期望位姿向量，表示t时刻下期望速度向量，G表示t时刻下所有关节的重力补偿向量；步骤4：将步骤3得到的机器人在t时刻下所有关节的期望驱动力矩向量中的每个关节的期望驱动力矩值与该关节的安全阈值进行对比，若均未超出安全阈值则将所有关节的期望驱动力矩值发送给关节电机驱动系统，实现姿态保持的拖动示教，若存在超出安全阈值的期望驱动力矩值，则向关节电机驱动系统发送停止运动指令。本专利技术能在姿态保持固定的状态下拖动机器人末端执行器在任务空间中运动，扩展了拖动示教的应用场景，通过将机器人任务空间控制模型转换到关节空间；将PD控制律应用于机器人关节空间控制模型；调节控制模型中的参数矩阵，实现机器人姿态保持的拖动示教功能。具体的，在计算式Ⅰ中关节重力补偿向量时，通过局部坐标系的空间变换矩阵和机器人的运动模型参数计算获得所述机器人运动学模型，通过牛顿-欧拉方法搭建逆动力学模型的框架，对利用机器人运行特性的激励轨迹以及运动数据进行滤波，根据滤波后的结果辨识得到动力学参数，完成完整逆动力学模型的搭建，通过逆动力学模型得到关节重力补偿向量。优选的，所述机器人刚体逆动力学模型为：其中，τ为关节驱动力矩、M为机器人惯性矩阵、C为科里奥力矩阵、G为关节重力补偿向量，即机器人所受重力在各关节的映射、τf为摩擦力矩、τext为作用在机器人上的外力在各关节的映射、q为所有关节的角度值向量。具体的，步骤3的推导过程为(1)：首先通过式Ⅲ在频域建立机器人任务空间控制模型，用于描述任务空间中作用在机器人上的力与末端执行器位姿的映射关系：F(s)＝sZ(s)X(s)(式Ⅲ)其中，F为任务空间中作用在机器人上的力，Z为机器人系统的等效阻抗，X为末端执行器在任务空间中位姿，s是控制工程中传递函数的组成部分；优选的，将机器人刚体等效为二阶质量-弹簧-阻尼器系统得到阻抗Z的传递函数，所述阻抗Z的传递函数可以用式Ⅳ表示为：sZ(s)＝As2+Bs+K(式Ⅳ)其中，A、B、K分别为惯性、阻尼、刚度参数矩阵。(2)：如图3所示，通过式Ⅴ将机器人任务空间控制模型转换到关节空间：JT(q)F(s)＝sZ(s)f(q)(s)(式Ⅴ)其中，F为任务空间中作用在机器人上的力，J(q)为运动学模型中机器人速度雅各比矩阵，q为机器人所有关节的角度值向量，f(q)为机器人正运动学变换矩阵。(3)：忽略机器人系统的高阶动态项，根据PD控制思想，将式Ⅴ中sZ(s)f(q)(s)改写本文档来自技高网...

【技术保护点】
1.一种机器人姿态保持拖动示教的方法，其特征在于，包括以下步骤：步骤1：获得t时刻的机器人所有关节的角度值向量q、位姿向量X以及速度向量

【技术特征摘要】
1.一种机器人姿态保持拖动示教的方法，其特征在于，包括以下步骤：步骤1：获得t时刻的机器人所有关节的角度值向量q、位姿向量X以及速度向量t≥0；步骤2：设置拖动硬度参数、拖动阻尼参数、所有关节的安全阈值和运动模型参数，建立机器人关节空间控制模型；步骤3：将步骤1测量的t时刻所有关节的角度值向量q、位姿向量X以及速度向量代入步骤2建立的机器人关节空间控制模型，采用式Ⅰ计算机器人在t时刻下机器人所有关节的期望驱动力矩值：其中，Γ表示t时刻机器人所有关节的期望驱动力矩向量，J(q)表示t时刻的机器人速度雅各比矩阵，B表示拖动阻尼参数，K表示拖动硬度参数，Xd表示t时刻下期望位姿向量，表示t时刻下期望速度向量，G表示t时刻下所有关节的重力补偿向量；步骤4：将步骤3得到的机器人在t时刻下所有关节的期望驱动力矩向量中的每个关节的期望驱动力矩值与该关节的安全阈值进行对比，若均未超出安全阈值则将所有关节的期望驱动力矩值发送给关节电机驱动系统，实现姿态保持的拖动示教，若存在超出安全阈值的期望驱动力矩值，则向关节电机驱动系统发送停止运动指令。2.一种机器人...

【专利技术属性】
技术研发人员：阳涵疆，伍祁林，宋君毅，
申请(专利权)人：深圳市大象机器人科技有限公司，
类型：发明
国别省市：广东,44