一种机械臂的控制方法与控制装置制造方法及图纸

本发明专利技术的一种机械臂的控制方法与控制装置，属于机械臂技术领域，包括有以下步骤：步骤一：在机械臂的基座对应的基座坐标系下建立机械臂的正运动学模型，本发明专利技术通过对运行图像信息的处理确定得到运行状态信息，再利用速度控制规则确定得到用于指示对机械臂进行速度控制的目标控制参数信息，有利于实现对机械臂的精准控制，从而提高机械臂的控制精度和控制效能，正运动学模型、第一关系以及期望位姿数据均为在基座坐标系下的信息，因此，在计算对各个关节进行转动的目标角度时，可以直接利用同一坐标系下的上述信息进行计算，而无需通过一系列坐标系转换，可以减小计算上述目标角度的计算量，提高计算效率。提高计算效率。提高计算效率。

【技术实现步骤摘要】
一种机械臂的控制方法与控制装置


[0001]本专利技术涉及机械臂
，具体讲是一种机械臂的控制方法与控制装置。

技术介绍

[0002]机器人可以安装有多关节的机械臂，机械臂中每一关节可绕自身轴线进行转动，在机器人工作过程中，机器人可以获得机械臂末端的期望位姿数据，通过控制关节转动来调整机械臂的位姿，使得机械臂末端的位姿数据为所设置的期望位姿数据，从而实现对机械臂的控制。
[0003]现有装置还存在以下不足之处：
[0004](1)在机械臂控制过程中，由于受端口开放权限的限制，通常难以实现对机械臂的精准控制，控制效率低。

技术实现思路

[0005]本专利技术的目的在于提供一种机械臂的控制方法与控制装置，以解决上述
技术介绍
中提出在机械臂控制过程中，由于受端口开放权限的限制，通常难以实现对机械臂的精准控制，控制效率低的问题。
[0006]本专利技术的技术方案是：包括有以下步骤：
[0007]步骤一：在机械臂的基座对应的基座坐标系下建立机械臂的正运动学模型；
[0008]步骤二、获取图像信息，获取机械臂末端在所述基座坐标系下的期望位姿数据,获取机械臂的当前实际速度和传感器采集的当前外力；
[0009]步骤三、根据图像信息，确定运行状态信息,根据当前外力，确定目标控制方向对应的目标外力；
[0010]步骤四、根据运行状态信息和预设的速度控制规则，确定出目标控制参数信息；目标控制参数信息用于指示对机械臂进行速度控制；
[0011]步骤五、基于预设静摩擦阻抗模型，根据所述目标虚拟静摩擦力、所述目标外力、预设质量参数、预设阻尼参数和预设弹簧参数进行阻抗控制；
[0012]步骤六、根据正运动学模型、第一关系以及期望位姿数据，计算对所述机械臂中各个关节进行转动的目标角度；
[0013]步骤七、控制各个关节按照对应的目标角度转动，以使得所述机械臂末端在基座坐标系下的位姿数据为所述期望位姿数据。
[0014]进一步的，所述运行状态信息包括位姿参数信息和目标状态信息，所述根据所述运行图像信息，确定出运行状态信息，包括：利用预设的位姿估计模型对所述运行图像信息进行处理，得到所述位姿参数信息，根据所述位姿参数信息，确定出所述目标状态信息。
[0015]进一步的，所述正运动学模型中所述机械臂各个关节相对于预设基准位置的转动角度为零，所述机械臂配置有六个关节，第一关节、第二关节、第三关节、第四关节、第五关节和第六关节通过连杆依次连接，所述第一关节的一端与所述机械臂基座相连，所述第六
关节的一端与所述机械臂末端相连，所述第二关节、第三关节以及第四关节的轴线平行。
[0016]所述第一关系按照以下表达式表示：
[0017]n＝N G＝|elia c(o)
[0018]其中，所述G为所述机械臂末端在所述基座坐标系下的位姿数据，所述N为所述机械臂中关节总数量，所述e为自然常数，所述为第n个关节在所述正运动学模型中的运动旋量，所述8。为第n个关节相对于所述预设基准位置的转动角度，所述G(0)为所述机械臂末端在所述正运动学模型中的初始位姿数据。
[0019]进一步的，若基于所述当前实际速度检测到当前不满足预设传感器零漂条件，则获取当前配置的目标动摩擦系数，并基于所述目标动摩擦系数和预设虚拟压力，确定所述目标控制方向对应的目标虚拟动摩擦力；基于预设动摩擦阻抗模型，根据所述目标虚拟动摩擦力、所述目标外力、预设质量参数、预设阻尼参数和预设弹簧参数进行阻抗控制，确定所述目标控制方向对应的下一期望位置。
[0020]进一步的，包括有模型建立模块、关系确定模块、获取模块、第一确定模块、第二确定模块、目标外力确认模块、目标虚拟静摩擦力确定模块、角度计算模块以及关节控制模块；
[0021]所述模型建立模块，用于在机械臂的基座对应的基座坐标系下建立机械臂的正运动学模型，其中，在所述正运动学模型中所述机械臂各个关节相对于预设基准位置的转动角度为零；
[0022]所述关系确定模块，用于根据所述正运动学模型确定所述机械臂末端在基座坐标系下的位姿数据与所述机械臂中各个关节的转动角度之间的第一关系；
[0023]所述获取模块，用于获取运行图像信息；所述运行图像信息是在对机械臂与目标物的位置关系进行调整控制时触发，用于获得所述机械臂末端在所述基座坐标系下的期望位姿数据，用于获取机械臂的当前实际速度和传感器采集的当前外力；
[0024]所述第一确定模块，用于根据所述运行图像信息，确定出运行状态信息；
[0025]所述第二确定模块，用于根据所述运行状态信息和预设的速度控制规则，确定出目标控制参数信息；所述目标控制参数信息用于指示对所述机械臂进行速度控制；
[0026]所述目标外力确认模块，用于根据所述当前外力，确定目标控制方向对应的目标外力；
[0027]所述目标虚拟静摩擦力确定模块，用于若基于所述当前实际速度检测到当前满足预设传感器零漂条件，则根据所述目标外力确定目标虚拟静摩擦力；
[0028]所述角度计算模块，用于根据所述正运动学模型、第一关系以及期望位姿数据，计算对所述机械臂中各个关节进行转动的目标角度；
[0029]所述关节控制模块，用于控制各个关节按照对应的目标角度转动，以使得所述机械臂末端在基座坐标系下的位姿数据为所述期望位姿数据，用于根据所述下一期望位置，确定所述目标控制方向对应的目标关节运动信息，并基于所述目标关节运动信息控制所述机械臂进行相应运动。
[0030]进一步的，所述角度计算模块包括有：数据获得子模块、第一计算模块、第二获得子模块以及坐标预测子模块；
[0031]所述数据获得子模块，用于在所述正运动学模型中获得所述第五关节和第六关节
的轴线交点的交点坐标以及平行关节的关节轴线向量，其中，所述平行关节为：所述第二关节、第三关节或第四关节；
[0032]所述第一计算模块，用于根据所述期望位姿数据和所述第一角度，计算所述机械臂末端在转动第一角度后的第一关节对应的目标关节坐标系下的期望坐标；
[0033]所述第二获得子模块，根据计算得到的期望坐标，获得对转动的角度；
[0034]所述坐标预测子模块，用于根据所述获取的角度在所述正运动学模型中的关节坐标，预测关节转动后在所述基座坐标系下的关节坐标。
[0035]本专利技术通过改进在此提供一种机械臂的控制方法与控制装置，与现有技术相比，具有如下改进及优点：
[0036]本专利技术通过对运行图像信息的处理确定得到运行状态信息，再利用速度控制规则确定得到用于指示对机械臂进行速度控制的目标控制参数信息，有利于实现对机械臂的精准控制，从而提高机械臂的控制精度和控制效能，正运动学模型、第一关系以及期望位姿数据均为在基座坐标系下的信息，因此，在计算对各个关节进行转动的目标角度时，可以直接利用同一坐标系下的上述信息进行计算，而无需通过一系列坐标系转换，可以减小计算上述目标角度的计算量，提高计算效率，从而本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种机械臂的控制方法，其特征在于：包括有以下步骤：步骤一：在机械臂的基座对应的基座坐标系下建立机械臂的正运动学模型；步骤二、获取图像信息，获取机械臂末端在所述基座坐标系下的期望位姿数据,获取机械臂的当前实际速度和传感器采集的当前外力；步骤三、根据图像信息，确定运行状态信息,根据当前外力，确定目标控制方向对应的目标外力；步骤四、根据运行状态信息和预设的速度控制规则，确定出目标控制参数信息；目标控制参数信息用于指示对机械臂进行速度控制；步骤五、基于预设静摩擦阻抗模型，根据所述目标虚拟静摩擦力、所述目标外力、预设质量参数、预设阻尼参数和预设弹簧参数进行阻抗控制；步骤六、根据正运动学模型、第一关系以及期望位姿数据，计算对所述机械臂中各个关节进行转动的目标角度；步骤七、控制各个关节按照对应的目标角度转动，以使得所述机械臂末端在基座坐标系下的位姿数据为所述期望位姿数据。2.根据权利要求1所述的一种机械臂的控制方法，其特征在于：所述运行状态信息包括位姿参数信息和目标状态信息，所述根据所述运行图像信息，确定出运行状态信息，包括：利用预设的位姿估计模型对所述运行图像信息进行处理，得到所述位姿参数信息，根据所述位姿参数信息，确定出所述目标状态信息。3.根据权利要求1所述的一种机械臂的控制方法，其特征在于：所述正运动学模型中所述机械臂各个关节相对于预设基准位置的转动角度为零，所述机械臂配置有六个关节，第一关节、第二关节、第三关节、第四关节、第五关节和第六关节通过连杆依次连接，所述第一关节的一端与所述机械臂基座相连，所述第六关节的一端与所述机械臂末端相连，所述第二关节、第三关节以及第四关节的轴线平行。4.根据权利要求1所述的一种机械臂的控制方法，其特征在于：所述第一关系按照以下表达式表示：n＝N G＝|elia c(o)其中，所述G为所述机械臂末端在所述基座坐标系下的位姿数据，所述N为所述机械臂中关节总数量，所述e为自然常数，所述为第n个关节在所述正运动学模型中的运动旋量，所述8。为第n个关节相对于所述预设基准位置的转动角度，所述G(0)为所述机械臂末端在所述正运动学模型中的初始位姿数据。5.根据权利要求1所述的一种机械臂的控制方法，其特征在于：若基于所述当前实际速度检测到当前不满足预设传感器零漂条件，则获取当前配置的目标动摩擦系数，并基于所述目标动摩擦系数和预设虚拟压力，确定所述目标控制方向对应的目标虚拟动摩擦力；基于预设动摩擦阻抗模型，根据所述目标虚拟动摩擦力、所述目标外力、预设质量参数、预设阻尼参数和预设弹簧参数进行阻抗控制，确定所述目标控制方向对应的下一期...

【专利技术属性】
技术研发人员：苏燕云，连俊芳，
申请(专利权)人：闽南理工学院，
类型：发明
国别省市：