一种基于双姿态传感器的关节角度测量方法技术

本发明专利技术公开了一种基于双姿态传感器的关节角度测量方法，在体段一上固定安装第一姿态传感器，在体段二上固定安装第二姿态传感器，测量时，所述第一姿态传感器返回第一欧拉角，所述第二姿态传感器返回第二欧拉角，然后根据所述第一欧拉角和所述第二欧拉角解算关节角度。本发明专利技术能够直接输出某一位置的关节绝对角度，不需要标定，测量精度高，而且姿态传感器的安装不受限制，可以在体段的任意周向、轴向位置固定，安装简单，便于实施，体积重量可以忽略不计，而且本发明专利技术实现还可以应用于机器人关节角度测量中，具有非常好的应用前景。

【技术实现步骤摘要】
一种基于双姿态传感器的关节角度测量方法
本专利技术涉及角度测量领域，具体地说涉及一种基于双姿态传感器的关节角度测量方法。
技术介绍
人体关节角度检测在医疗康复领域非常有应用价值。对关节极限角度进行检测，可以为医生的临床诊断，病人的康复效果评估提供重要参数；获取关节运动信息，还可以为老年人、康复期患者的跌倒风险评估、步态校正等提供重要依据。人体关节角度通常使用穿戴式角度传感器测量装置直接测量，包括霍尔磁性角度传感器、光学编码盘等，在实际运用中，患者常常由于肢体障碍或者碍于受伤部位，穿戴很难实现，且价格通常比较昂贵。现有技术中也有一些测量方法可以实现对关节相对运动角度的测量，如申请号为201710170099.3的中国专利申请公开的一种基于姿态传感器的机器人关节角度测量方法，但是，该方法输出的是两个姿态的关节相对运动角度，且因为需要在某个位置标定初始态，精度很难达到要求。
技术实现思路
本专利技术所要解决的技术问题是提供一种测量精度高的、便于安装实施的关节角度测量方法。为了解决上述技术问题，本专利技术采用如下技术方案：一种基于双姿态传感器的关节角度测量方法，在体段一上固定安装第一姿态传感器，在体段二上固定安装第二姿态传感器，测量时，所述第一姿态传感器返回第一欧拉角，所述第二姿态传感器返回第二欧拉角，然后根据所述第一欧拉角和所述第二欧拉角解算关节角度。进一步地，包括以下步骤：步骤一：定义基准坐标系S；定义连杆坐标系U；定义连杆坐标系V；定义体段一长度l1，体段二长度l2；所述基准坐标系S为东北天坐标系，所述基准坐标系S以体段一自由端端点A为原点，以向东向北向上为坐标轴XYZ的正方向；所述连杆坐标系U以体段一自由端端点A为原点，所述连杆坐标系U的坐标轴指向与所述第一姿态传感器方位相同；所述连杆坐标系V以关节回转中心B为原点，所述连杆坐标系V的坐标轴指向与所述第二姿态传感器方位相同；步骤二：根据所述第一姿态传感器返回的第一欧拉角计算所述连杆坐标系U与所述基准坐标系S的第一旋转变换矩阵根据所述第二姿态传感器返回的第二欧拉角计算所述连杆坐标系V与所述基准坐标系S的第二旋转变换矩阵步骤三：根据所述第一旋转变换矩阵体段一长度l1，计算关节回转中心B在基准坐标系S下的坐标根据所述第二旋转变换矩阵体段二长度l2，计算体段二自由端端点C在基准坐标系S下的坐标步骤四：根据体段一自由端端点A、关节回转中心B、体段二自由端端点C三点的空间坐标求取关节回转中心B点与体段一自由端端点A点构成的向量关节回转中心B点与体段二自由端端点C点构成的向量最后根据计算关节角度。进一步地，旋转变换矩阵的通式如式1所示：所述第一欧拉角包括第一滚转角α1、第一俯仰角β1、第一偏航角γ1；所述第二欧拉角包括第二滚转角α2、第二俯仰角β2、第二偏航角γ2，将α1、β1、γ1和α2、β2、γ2分别代入上式计算出进一步地：关节回转中心B点在连杆坐标系U下的坐标得到关节回转中心B点在基准坐标系S下的坐标体段二自由端端点C点在连杆坐标系V下的坐标得到体段二自由端端点C点在基准坐标系S下的坐标进一步地：关节角度的计算公式如式2所示：进一步地，所述第一姿态传感器和所述第二姿态传感器分别使用柔性绑带绑定在体段一和体段二上，所述第一姿态传感器和所述第二姿态传感器的x轴或y轴或z轴沿着体段一和体段二的长度方向安装。进一步地，姿态传感器为双轴加速度传感器和单轴陀螺仪的组合，或由陀螺仪与加速度传感器组成的六轴惯性传感器，或九轴姿态传感器。本专利技术的有益效果体现在：本专利技术能够直接输出某一位置的关节绝对角度，不需要标定，测量精度高，而且姿态传感器的安装不受限制，可以在体段的任意周向、轴向位置固定，安装简单，便于实施，体积重量可以忽略不计，而且本专利技术实现还可以应用于机器人关节角度测量中，具有非常好的应用前景。附图说明图1是本专利技术一实施例中的关节角度测量示意图。图2是本专利技术一实施例中的z-y-x旋转顺序欧拉角示意图。具体实施方式下面将参考附图来详细说明本专利技术。需要说明的是，在不冲突的情况下，本申请中的实施例及实施例中的特征可以相互组合。为解决现有技术的缺陷，本专利技术提供一种基于双姿态传感器的关节角度测量方法，是通过在体段一上固定安装第一姿态传感器，在体段二上固定安装第二姿态传感器，测量时，所述第一姿态传感器返回第一欧拉角，所述第二姿态传感器返回第二欧拉角，然后根据所述第一欧拉角和所述第二欧拉角解算关节角度。优选地，所述第一姿态传感器和所述第二姿态传感器分别使用柔性绑带绑定在体段一和体段二上，所述第一姿态传感器和所述第二姿态传感器的x轴或y轴或z轴沿着体段一和体段二的长度方向安装。本专利技术使用的姿态传感器可以为双轴加速度传感器和单轴陀螺仪组合，或陀螺仪与加速度传感器组成的六轴惯性传感器，也不限于九轴姿态传感器，只要能够准确测量包括滚转角、俯仰角、偏航角的欧拉角即可。参见图1和图2，下面提供一种根据第一欧拉角和第二欧拉角解算关节角度的方法，具体包括以下步骤：步骤一：定义基准坐标系S；定义连杆坐标系U；定义连杆坐标系V；定义体段一长度l1，体段二长度l2；所述基准坐标系S为东北天坐标系，所述基准坐标系S以体段一自由端端点A为原点，以向东向北向上为坐标轴XYZ的正方向；所述连杆坐标系U以体段一自由端端点A为原点，所述连杆坐标系U的坐标轴指向与所述第一姿态传感器方位相同(即连杆坐标系的x、y、z轴指向与姿态传感器的x、y、z轴指向相同，下同)；所述连杆坐标系V以关节回转中心B为原点，所述连杆坐标系V的坐标轴指向与所述第二姿态传感器方位相同；本专利技术中，所述体段长度l1和l2仅仅为了便于对体段的方向向量进行描述和理解，实际并不需要对其长度进行测量，即使取体段一或体段二的二分之一或者三份之一作为A点和C点均可；步骤二：根据所述第一姿态传感器返回的第一欧拉角计算所述连杆坐标系U与所述基准坐标系S的第一旋转变换矩阵根据所述第二姿态传感器返回的第二欧拉角计算所述连杆坐标系V与所述基准坐标系S的第二旋转变换矩阵步骤三：根据所述第一旋转变换矩阵体段一长度l1，计算关节回转中心B在基准坐标系S下的坐标根据所述第二旋转变换矩阵体段二长度l2，计算体段二自由端端点C在基准坐标系S下的坐标步骤四：根据体段一自由端端点A、关节回转中心B、体段二自由端端点C三点的空间坐标求取关节回转中心B点与体段一自由端端点A点构成的向量关节回转中心B点与体段二自由端端点C点构成的向量最后根据计算关节角度。在一实施例中，所述第一姿态传感器和所述第二姿态传感器在用欧拉角表示姿态时的坐标系旋转顺序定义为z-y-x，若存在某坐标系N与参考系M初始方位相同，N绕zN轴转γ，然后绕yN轴转β角，最后绕xN转α角，如图2所示，N的三维坐标轴依次发生变换：xyz→x’y’z→x”y’z’→x”y”z”，则N相对于M的旋转变换矩阵的通式如式1所示：α、β、γ分别为欧拉角的滚转角、俯仰角、偏航角，所述第一欧拉角包括第一滚转角α1、第一俯仰角β1、第一偏航角γ1；所述第二欧拉角包括第二滚转角α2、第二俯仰角β2、第二偏航角γ2，将α1、β1、γ1和α2、β2、γ2分别代入上式计算出在一实施例中，关节回转中心B点在连杆坐标系U下的坐标得到关节回转中心B点在基准坐标系S本文档来自技高网...

【技术保护点】
1.一种基于双姿态传感器的关节角度测量方法，关节包括相互铰接的体段一和体段二，其特征在于：在体段一上固定安装第一姿态传感器，在体段二上固定安装第二姿态传感器，测量时，所述第一姿态传感器返回第一欧拉角，所述第二姿态传感器返回第二欧拉角，然后根据所述第一欧拉角和所述第二欧拉角解算关节角度。

【技术特征摘要】
1.一种基于双姿态传感器的关节角度测量方法，关节包括相互铰接的体段一和体段二，其特征在于：在体段一上固定安装第一姿态传感器，在体段二上固定安装第二姿态传感器，测量时，所述第一姿态传感器返回第一欧拉角，所述第二姿态传感器返回第二欧拉角，然后根据所述第一欧拉角和所述第二欧拉角解算关节角度。2.如权利要求1所述的基于双姿态传感器的关节角度测量方法，其特征在于：包括以下步骤：步骤一：定义基准坐标系S；定义连杆坐标系U；定义连杆坐标系V；定义体段一长度l1，体段二长度l2；所述基准坐标系S为东北天坐标系，所述基准坐标系S以体段一自由端端点A为原点，以向东向北向上为坐标轴XYZ的正方向；所述连杆坐标系U以体段一自由端端点A为原点，所述连杆坐标系U的坐标轴指向与所述第一姿态传感器方位相同；所述连杆坐标系V以关节回转中心B为原点，所述连杆坐标系V的坐标轴指向与所述第二姿态传感器方位相同；步骤二：根据所述第一姿态传感器返回的第一欧拉角计算所述连杆坐标系U与所述基准坐标系S的第一旋转变换矩阵根据所述第二姿态传感器返回的第二欧拉角计算所述连杆坐标系V与所述基准坐标系S的第二旋转变换矩阵步骤三：根据所述第一旋转变换矩阵体段一长度l1，计算关节回转中心B在基准坐标系S下的坐标根据所述第二旋转变换矩阵体段二长度l2，计算体段二自由端端点C在基准坐标系S下的坐标步骤四：根据体段一自由端端点A、关节回转中心B、体段二自由端...

【专利技术属性】
技术研发人员：王勇，卢涛，肖飞云，刘正士，陈恩伟，陆益民，
申请(专利权)人：合肥工业大学，
类型：发明
国别省市：安徽,34