绳索驱动三自由度柔性关节刚度测量系统及方法技术方案

本发明专利技术公开了一种绳索驱动三自由度柔性关节刚度测量系统及方法。所述的测量方法包括：在微分流形SO(3)上构建绳索驱动三自由度柔性关节的刚度模型；测量所述柔性关节的外力矩以及其中动平台的位姿变化，并依据所述刚度模型，实现对于所述柔性关节刚度的准确测量。较之现有技术，本发明专利技术提供的绳索驱动三自由度柔性关节的刚度测量方法简单易实施，且还具有准确性好，精度高等优点。

Stiffness measurement system and method of three DOF flexible joint driven by rope

【技术实现步骤摘要】
绳索驱动三自由度柔性关节刚度测量系统及方法
本专利技术属于机器人
，涉及一种绳索驱动机器人，具体涉及一种新型的绳索驱动三自由度柔性关节刚度测量系统及方法。
技术介绍
与传统的刚性机器人相比，绳索驱动机器人能够实现柔顺运动，具有轻量化、安全的特性，在服务机器人里有广泛的应用。由于绳索只能单向受力，因此，绳索驱动机器人通常是冗余驱动的，在同一个位姿下，通过调整绳索的张力，可以调整绳索驱动机器人的刚度。由于绳索驱动机器人具有变刚度特性，因此，刚度测量对于绳索驱动机器人来说非常重要。传统的刚度模型是在欧几里得空间中计算外载荷与位移之间的微商，它对于线性刚度系统和高刚度系统比较精确，但是对于像绳索驱动三自由度柔性关节这样的弱刚度系统，在同样的载荷作用下，它的位移变化通常比较大，非线性程度比较高，如果还是在欧几里得空间中计算，精确度不高。因此需要研究和设计新型的高精度刚度测量方法。
技术实现思路
本专利技术的主要目的在于提供一种绳索驱动三自由度柔性关节的刚度测量系统及方法，从而克服现有技术中的不足。为实现以上专利技术目的，本专利技术采用的技术方案包括：本专利技术实施例提供了一种绳索驱动三自由度柔性关节刚度测量方法，所述绳索驱动三自由度柔性关节包括动平台、定平台和绳索，所述动平台和定平台通过球关节连接，所述绳索与驱动单元传动连接，并且所述绳索用于驱使动平台相对于定平台作旋转运动；其中，所述测量方法包括：将所述动平台相对于定平台进行旋转运动的轨迹以旋转矩阵R(t)∈SO(3)表示，其中SO(3)为微分流形，t>0；依据旋转矩阵的矩阵指数公式，将曲线R(t)表示为：其中以所述曲线R(t)的切向量描述所述柔性关节的速度，并满足下式：其中，所述柔性关节的角速度表示为以所述曲线R(t)的余切向量描述所述柔性关节在各个位姿下的外载荷，定义如下：在所述微分流形SO(3)中定义内积、联络和协变导数，并使所述柔性关节的外载荷相对于瞬时位移的协变导数表示为下式：其中Li(i＝1、2或3)是曲线R(t)切空间的坐标基；以矩阵描述所述柔性关节的刚度，并且所述矩阵K的元素表示为根据所述微分流形SO(3)内积、联络和协变导数的相关性质，获得所述柔性关节刚度的一般形式，即：其中根据所述柔性关节刚度的一般形式，得到所述柔性关节刚度测量的近似表达式，即：测量N组所述柔性关节的外力矩以及所述动平台的位姿变化{Δτ.Δζ},N>3，并获得如下的N组数据：Ψ＝{Δτ1，Δτ2，…，ΔτN}Ω＝{Δζ1，Δζ2，…，ΔζN}再根据最小二乘法计算所述柔性关节的刚度矩阵K，从而得到所述柔性关节的刚度，即：其中表示矩阵Ω的伪逆矩阵。本专利技术实施例还提供了一种绳索驱动三自由度柔性关节刚度测量系统，其应用于前述的任一种测量方法内；并且，所述测量系统包括：绳索驱动三自由度柔性关节；与所述柔性关节配合的驱动单元；用于测量所述柔性关节外载荷的力测量单元；用于测量所述柔性关节的动平台位姿的位姿测量单元；以及至少与所述驱动单元、力传感器和/或力矩传感器和位姿测量单元连接的控制单元。较之现有技术，本专利技术提供的绳索驱动三自由度柔性关节的刚度测量方法简单易实施，且还具有准确性好，精度高等优点。附图说明为了更清楚地说明本专利技术实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本专利技术中记载的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。图1是本专利技术一典型实施例中一种绳索驱动三自由度柔性关节的结构示意图；图2是本专利技术一典型实施例中一种绳索驱动三自由度柔性关节的驱动单元的结构示意图。图3是本专利技术一典型实施例中一种绳索驱动三自由度柔性关节刚度测量系统的照片。具体实施方式以下结合附图、实施例对本专利技术作进一步详细说明。需要指出的是，以下所述实施例旨在便于对本专利技术的理解，而对其不起任何限定作用。如前所述，鉴于现有技术的不足，本案专利技术人经长期研究和大量实践，得以提出本专利技术的技术方案，其可以被概括为：在微分流形SO(3)上构建绳索驱动三自由度柔性关节的刚度模型，该模型相比现有刚度模型，精确度更高；继而，借助该刚度模型，实现对于绳索驱动三自由度柔性关节刚度的准确测量，从而克服现有技术中对于绳索驱动三自由度柔性关节这种弱刚度系统精度不高的问题。请参阅图1，本专利技术一典型实施例中的一种绳索驱动三自由度柔性关节主要由动平台、定平台、球关节、绳索组成，其中动平台通过球关节与定平台连接，而绳索穿过定平台后与动平台传动连接，同时，绳索还与其驱动单元传动连接。请进一步参阅图2，所述驱动单元可以包括力矩电机、同步带、绞盘以及相应的安装机架，绳索穿过所述安装机架后绕卷在绞盘上，同时力矩电机还与编码器连接。在本专利技术的该实施例中，利用微分流形理论建立了绳索驱动三自由度柔性关节的刚度模型，并依据该模型建立了该柔性关节的刚度测量算法。进一步的，本专利技术实施例提供的刚度测量算法具体包括以下步骤：(1)构建绳索驱动三自由度柔性关节刚度模型绳索驱动三自由度柔性关节的动平台相对于定平台做旋转运动，旋转运动可以用旋转矩阵R∈SO(3)表示。因此，绳索驱动三自由度柔性关节运动轨迹是微分流形SO(3)中的一条曲线，R(t)∈SO(3)，t>0。根据旋转矩阵的矩阵指数公式，曲线R(t)可以表示为：其中那么曲线R(t)的切向量可以用来描述绳索驱动柔性关节的速度，并满足以下表达式：其中表示关节的角速度。由于关节的外力矩与关节角速度具有对偶关系，可以构造曲线R(t)的余切向量来描述关节在各个位姿下的外载荷，定义如下：在微分流形SO(3)中定义内积、联络和协变导数以后，关节外载荷相对于瞬时位移的协变导数可以表示成如下形式：其中Li(i＝1,2,3)是曲线R(t)切空间的坐标基。那么矩阵可以用来描述关节的刚度，它的元素可以表示为根据内积、联络和协变导数的相关性质，可以得到刚度的一般形式：其中根据刚度的一般形式，可以得到刚度测量的近似表达式(2)刚度测量通过测量N(N>3)组外力矩和位姿变化{Δτ，Δζ}，可以根据最小二乘法计算关节刚度矩阵K。测得的N组数据分别为Ψ＝{Δτ1，Δτ2，…，ΔτN}Ω＝{Δζ1，Δζ2，…，ΔζN}那么可以计算得到关节的刚度其中表示矩阵Ω的伪逆矩阵。在本专利技术的该实施例中，关节的外力矩可以用力/力矩传感器测量，关节的位姿本文档来自技高网...

【技术保护点】
1.一种绳索驱动三自由度柔性关节刚度测量方法，所述绳索驱动三自由度柔性关节包括动平台、定平台和绳索，所述动平台和定平台通过球关节连接，所述绳索与驱动单元传动连接，并且所述绳索用于驱使动平台相对于定平台作旋转运动；其特征在于，所述测量方法包括：/n将所述动平台相对于定平台进行旋转运动的轨迹以旋转矩阵R(t)∈SO(3)表示，其中SO(3)为微分流形，t>0；/n依据旋转矩阵的矩阵指数公式，将曲线R(t)表示为：/n

【技术特征摘要】
1.一种绳索驱动三自由度柔性关节刚度测量方法，所述绳索驱动三自由度柔性关节包括动平台、定平台和绳索，所述动平台和定平台通过球关节连接，所述绳索与驱动单元传动连接，并且所述绳索用于驱使动平台相对于定平台作旋转运动；其特征在于，所述测量方法包括：
将所述动平台相对于定平台进行旋转运动的轨迹以旋转矩阵R(t)∈SO(3)表示，其中SO(3)为微分流形，t>0；
依据旋转矩阵的矩阵指数公式，将曲线R(t)表示为：



其中



以所述曲线R(t)的切向量描述所述柔性关节的速度，并满足下式：



其中，所述柔性关节的角速度表示为
以所述曲线R(t)的余切向量描述所述柔性关节在各个位姿下的外载荷，定义如下：



在所述微分流形SO(3)中定义内积、联络和协变导数，并使所述柔性关节的外载荷相对于瞬时位移的协变导数表示为下式：



其中Li是曲线R(t)切空间的坐标基，i＝1、2或3；
以矩阵描述所述柔性关节的刚度，并且所述矩阵K的元素表示为
根据所述微分流形SO(3)内积、联络和协变导数的相关性质，获得所述柔性关节刚度的一般形式，即：



其中
根据所述柔性关节刚度的一般形式，得到所述柔性关节刚度测量的近似表达式，即：



测量N组所述柔性关节的外力矩以及所述动平台的位姿变化{Δτ，Δζ}，N>3，并获得如下的N组数据：
Ψ＝{Δτ1，Δτ2，…，ΔτN}
Ω＝{Δζ1，Δζ2，…，ΔζN}
再根据最小二乘法计算所述柔性关节的刚度矩阵K，...

【专利技术属性】
技术研发人员：杨桂林，杨凯盛，王会肖，王逸，方灶军，张驰，郑天江，叶国云，沈雯钧，
申请(专利权)人：中国科学院宁波材料技术与工程研究所，
类型：发明
国别省市：浙江;33