CN106996765A - 一种基于姿态传感器的机器人关节角度测量方法 - Google Patents
一种基于姿态传感器的机器人关节角度测量方法 Download PDFInfo
- Publication number
- CN106996765A CN106996765A CN201710170099.3A CN201710170099A CN106996765A CN 106996765 A CN106996765 A CN 106996765A CN 201710170099 A CN201710170099 A CN 201710170099A CN 106996765 A CN106996765 A CN 106996765A
- Authority
- CN
- China
- Prior art keywords
- angle
- angles
- attitude transducer
- connecting rod
- eulerian angles
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
- G01B21/22—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring angles or tapers; for testing the alignment of axes
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Manipulator (AREA)
Abstract
本发明提供了一种基于姿态传感器的机器人关节角度测量方法,机器人关节由第一连杆和第二连杆活动连接组成,在第一连杆上固定安装第一姿态传感器,在第二连杆上固定安装第二姿态传感器;第一姿态传感器和第二姿态传感器分别返回第一欧拉角和第二欧拉角,根据第一欧拉角和第二欧拉角测算机器人关节角度。本发明的有益效果:(1)制造成本低;(2)安装简单,对安装精度、安装位置没有特殊要求;(3)可以集成到电路板上,体积、重量可以忽略不计;(4)不受粉尘、油渍以及地磁场等外界因素干扰;(5)无需动力学正解计算,可以直接得到机器人某个连杆的姿态。
Description
技术领域
本发明涉及一种角度测量方法,特别涉及一种基于姿态传感器的机器人关节角度测量方法,属于机器人技术领域。
背景技术
近年来,机器人技术不论在工业还是在民用领域的应用都有飞速的发展,而机器人各个关节角是机器人控制的基础。因此,具有高度通用性的机器人关节角的测量方法显得十分必要。
现有的机器人关节角通常使用安装在关节上的角度传感器直接测量,其中主要包括霍尔磁性角度传感器,光学编码盘等。这些角度传感器虽然精度高,但是价格昂贵,对安装方式有极高的要求,所占空间较大,且易受环境因素干扰。
发明内容
本发明要解决现有技术中测量机器人关节角度存在的以下几个技术问题:(1)传感器制造成本高的问题;(2)安装困难的问题;(3)体积大,重量大的问题;(4)易受环境因素干扰。
为了实现上述目的,本发明提供了一种基于姿态传感器的机器人关节角度测量方法,机器人关节包括相连的第一连杆和第二连杆,在第一连杆和/或第二连杆上安装姿态传感器,由姿态传感器返回的欧拉角或四元数测算机器人关节角度;欧拉角包括俯仰角、横滚角及航向角。
优选地,第一连杆和第二连杆活动连接,在第一连杆上固定安装第一姿态传感器,在第二连杆上固定安装第二姿态传感器;第一姿态传感器和第二姿态传感器分别返回第一欧拉角和第二欧拉角,根据第一欧拉角和第二欧拉角测算机器人关节角度。
优选地,上述测量方法包括如下步骤:
步骤一、定义惯性坐标系,定义固连于第一姿态传感器的第一坐标系,定义固连于第二姿态传感器的第二坐标系;
步骤二、将机器人关节复位至第一位置,第一姿态传感器返回第一欧拉角,第二姿态传感器返回第二欧拉角;
步骤三、根据第一欧拉角计算第一旋转矩阵,根据第二欧拉角计算第二旋转矩阵;再根据第一旋转矩阵和第二旋转矩阵计算第一连杆与第二连杆的第一位置相对旋转矩阵;
步骤四、将机器人关节调节至第二位置,第一姿态传感器返回第三欧拉角,第二姿态传感器返回第四欧拉角;
步骤五、根据第三欧拉角计算第三旋转矩阵,根据第四欧拉角计算第四旋转矩阵;再根据第三旋转矩阵和第四旋转矩阵计算第一连杆与第二连杆的第二位置相对旋转矩阵;
步骤六、根据第一位置相对旋转矩阵和第二位置相对旋转矩阵计算旋转矩阵变化量,再根据旋转矩阵变化量计算机器人关节角度。
优选地,第一欧拉角包括第一横滚角、第一俯仰角、第一航向角,第二欧拉角包括第二横滚角、第二俯仰角、第二航向角,第三欧拉角包括第三横滚角、第三俯仰角、第三航向角,第四欧拉角包括第四横滚角、第四俯仰角、第四航向角。
优选地,第一欧拉角是第一姿态传感器与惯性坐标系之间的夹角,第二欧拉角是第二姿态传感器与惯性坐标系之间的夹角。
优选地,惯性坐标系是固定于地球的大地坐标系。
优选地,测量方法包括如下具体步骤:
步骤一、定义坐标系:定义惯性坐标系为xyz,定义第一坐标系为x’y’z’,惯性坐标系和第一坐标系原点重合为O,惯性坐标系和第一坐标系之间的转换用欧拉角来描述,其中N为地磁北极方向;按同样的方式定义第二坐标系为x”y”z”;
步骤二、初始化:将机器人关节复位至第一位置,记为α0;此时第一姿态传感器返回第一横滚角记为φ1|0,第一俯仰角记为θ1|0,第一航向角记为ψ1|0;第二姿态传感器返回第二横滚角记为φ2|0,第二俯仰角记为θ2|0,第二航向角记为ψ2|0;
步骤三、标定:计算第一旋转矩阵并记为1R0,计算第二旋转矩阵记为2R0,第一位置相对旋转矩阵表示为通过以下公式计算:
步骤四、数据采集:机器人运动至第二位置,第三横滚角、第三俯仰角、第三航向角、第四横滚角、第四俯仰角、第四航向角分别记为φ1|1,θ1|1,ψ1|1,φ2|1,θ2|1,ψ2|1;
步骤五、标定:计算第三旋转矩阵记为1R1,计算第四旋转矩阵记为2R1,通过以下公式计算第二位置相对旋转矩阵:
步骤六、关节角解算:计算旋转矩阵变化量,公式如下:
将旋转矩阵变化量用等效轴坐标系方法表示,即绕轴旋转角度β:
其中,rij表示矩阵的第i行第j列元素;
此时机器人关节对应的旋转角度为:
α1=α0+β
优选地,以Z-Y-X欧拉角表示法计算1R0和2R0、1R1和2R1,公式如下:
将φ1|0,θ1|0,ψ1|0和φ2|0,θ2|0,ψ2|0、φ1|1,θ1|1,ψ1|1和φ2|1,θ2|1,ψ2|1分别代入上式计算1R0和2R0、1R1和2R1。
本发明的有益效果:(1)制造成本低;(2)安装简单,对安装精度、安装位置没有特殊要求;(3)可以集成到电路板上,体积、重量可以忽略不计;(4)不受粉尘、油渍以及地磁场等外界因素干扰;(5)无需动力学正解计算,可以直接得到机器人某个连杆的姿态。
附图说明
图1是本发明一个较佳实施例中的机器人关节的结构示意图;
图2是本发明一个较佳实施例中的欧拉角示意图。
具体实施方式
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图对本发明的具体实施方式做详细的说明。需说明的是,本发明附图均采用简化的形式且均使用非精准的比例,仅用以方便、明晰地辅助说明本发明实施例的目的。
如图1所示,本发明提供了一种基于姿态传感器的机器人关节角度测量方法,机器人关节包括相连的连杆1和连杆2,连杆1和连杆2通过关节3活动连接,在连杆1上固定安装姿态传感器5,在连杆2上固定安装姿态传感器6;姿态传感器5和姿态传感器6分别返回欧拉角,根据欧拉角测算机器人关节角度4。传感器与连杆应固定连接,对安装精度、安装位置没有特殊要求。姿态传感器需返回欧拉角(俯仰角、横滚角及航向角)或四元数。
以欧拉角为例,测量方法如下:
(1)定义:如图2所示,定义惯性坐标系(固定于地球的大地坐标系)xyz,定义固连于姿态传感器的坐标系x’y’z’,其中,x’轴指向姿态传感器正前方,z’轴垂直于x’轴指向姿态传感器上方,y’轴垂直于x’轴和z’轴指向传感器左侧,坐标系原点为O。两个坐标系之间的转换可以用欧拉角来描述,其中N为地磁北极方向。本发明所使用的欧拉角即姿态传感器与惯性坐标系之间的夹角。
(2)初始化(复位):机器人系统上电或者需要标定时,将关节角复位至某一固定角度(记为α0)。此时相邻连杆上的姿态传感器返回的分别角度记为φ1|0(横滚角),θ1|0(俯仰角),ψ1|0(航向角)和φ2|0,θ2|0,ψ2|0(以φ1|0为例,其中,φ表示横滚角,下标1为连杆编号,下标0为t0时刻的状态编号)。
(3)标定:分别计算每个欧拉角相应的旋转矩阵,1R0,2R0。(欧拉角旋转矩阵共有24种表示方法,且都被称作角坐标系表示法,采用任意一种即可。)以Z-Y-X欧拉角表示法为例:
将0时刻从连杆1到连杆2的旋转矩阵表示为
(4)数据采集:机器人运动至某一时刻t1,此时连杆上的姿态传感器返回的分别角度记为φ1|1,θ1|1),ψ1|1和φ2|1,θ2|1,ψ2|1。对应旋转矩阵为1R1,2R1。将t1时刻从连杆1到连杆2的旋转矩阵表示为
(5)关节角解算:将连杆1与连杆2旋转矩阵的变化记为
将该旋转矩阵用等效轴坐标系方法表示,即绕轴旋转角度β:
其中,rij表示矩阵的第i行第j列元素。
此时关节对应的旋转角度为:
α1=α0+β
以上详细描述了本发明的较佳具体实施例。应当理解,本领域的普通技术人员无需创造性劳动就可以根据本发明的构思作出诸多修改和变化。因此,凡本技术领域中技术人员依本发明的构思在现有技术的基础上通过逻辑分析、推理或者有限的实验可以得到的技术方案,皆应在由权利要求书所确定的保护范围内。
Claims (8)
1.一种机器人关节角度测量方法,其特征在于,所述机器人关节包括相连的第一连杆和第二连杆,在所述第一连杆和/或所述第二连杆上安装姿态传感器,由所述姿态传感器返回的欧拉角或四元数测算所述机器人关节角度;所述欧拉角包括俯仰角、横滚角及航向角。
2.根据权利要求1所述的一种机器人关节角度测量方法,其特征在于,所述第一连杆和所述第二连杆活动连接,在所述第一连杆上固定安装第一姿态传感器,在所述第二连杆上固定安装第二姿态传感器;所述第一姿态传感器和所述第二姿态传感器分别返回第一欧拉角和第二欧拉角,根据所述第一欧拉角和所述第二欧拉角测算所述机器人关节角度。
3.根据权利要求2所述的一种机器人关节角度测量方法,其特征在于,包括如下步骤:
步骤一、定义惯性坐标系,定义固连于所述第一姿态传感器的第一坐标系,定义固连于所述第二姿态传感器的第二坐标系;
步骤二、将所述机器人关节复位至第一位置,所述第一姿态传感器返回第一欧拉角,所述第二姿态传感器返回第二欧拉角;
步骤三、根据所述第一欧拉角计算第一旋转矩阵,根据所述第二欧拉角计算第二旋转矩阵;再根据所述第一旋转矩阵和所述第二旋转矩阵计算所述第一连杆与所述第二连杆的第一位置相对旋转矩阵;
步骤四、将所述机器人关节调节至第二位置,所述第一姿态传感器返回第三欧拉角,所述第二姿态传感器返回第四欧拉角;
步骤五、根据所述第三欧拉角计算第三旋转矩阵,根据所述第四欧拉角计算第四旋转矩阵;再根据所述第三旋转矩阵和所述第四旋转矩阵计算所述第一连杆与所述第二连杆的第二位置相对旋转矩阵;
步骤六、根据所述第一位置相对旋转矩阵和所述第二位置相对旋转矩阵计算旋转矩阵变化量,再根据所述旋转矩阵变化量计算所述机器人关节角度。
4.根据权利要求3所述的一种机器人关节角度测量方法,其特征在于,所述第一欧拉角包括第一横滚角、第一俯仰角、第一航向角,所述第二欧拉角包括第二横滚角、第二俯仰角、第二航向角,所述第三欧拉角包括第三横滚角、第三俯仰角、第三航向角,所述第四欧拉角包括第四横滚角、第四俯仰角、第四航向角。
5.根据权利要求3所述的一种机器人关节角度测量方法,其特征在于,所述第一欧拉角是所述第一姿态传感器与所述惯性坐标系之间的夹角,所述第二欧拉角是所述第二姿态传感器与所述惯性坐标系之间的夹角。
6.根据权利要求3所述的一种机器人关节角度测量方法,其特征在于,所述惯性坐标系是固定于地球的大地坐标系。
7.根据权利要求4所述的一种机器人关节角度测量方法,其特征在于,包括如下步骤:
步骤一、定义坐标系:定义所述惯性坐标系为xyz,定义所述第一坐标系为x’y’z’,所述惯性坐标系和所述第一坐标系原点重合为O,所述惯性坐标系和所述第一坐标系之间的转换用欧拉角来描述,其中N为地磁北极方向;按同样的方式定义所述第二坐标系为x”y”z”;
步骤二、初始化:将所述机器人关节复位至第一位置,记为α0;此时所述第一姿态传感器返回第一横滚角记为φ1|0,第一俯仰角记为θ1|0,第一航向角记为ψ1|0;所述第二姿态传感器返回第二横滚角记为φ2|0,第二俯仰角记为θ2|0,第二航向角记为ψ2|0;
步骤三、标定:计算所述第一旋转矩阵记为1R0,计算所述第二旋转矩阵记为2R0,所述第一位置相对旋转矩阵表示为通过以下公式计算:
步骤四、数据采集:机器人运动至第二位置,所述第三横滚角、所述第三俯仰角、所述第三航向角、所述第四横滚角、所述第四俯仰角、所述第四航向角分别记为φ1|1,θ1|1,ψ1|1,φ2|1,θ2|1,ψ2|1;
步骤五、标定:计算所述第三旋转矩阵记为1R1,计算所述第四旋转矩阵记为2R1,通过以下公式计算所述第二位置相对旋转矩阵:
步骤六、关节角解算:计算所述旋转矩阵变化量,公式如下:
将所述旋转矩阵变化量用等效轴坐标系方法表示,即绕轴旋转角度β:
其中,rij表示矩阵的第i行第j列元素;
此时所述机器人关节对应的旋转角度为:
α1=α0+β
8.根据权利要求7所述的一种机器人关节角度测量方法,其特征在于,以Z-Y-X欧拉角表示法计算1R0和2R0、1R1和2R1,公式如下:
将φ1|0,θ1|0,ψ1|0和φ2|0,θ2|0,ψ2|0、φ1|1,θ1|1,ψ1|1和φ2|1,θ2|1,ψ2|1分别代入上式计算1R0和2R0、1R1和2R1。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710170099.3A CN106996765A (zh) | 2017-03-21 | 2017-03-21 | 一种基于姿态传感器的机器人关节角度测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710170099.3A CN106996765A (zh) | 2017-03-21 | 2017-03-21 | 一种基于姿态传感器的机器人关节角度测量方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106996765A true CN106996765A (zh) | 2017-08-01 |
Family
ID=59431002
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710170099.3A Pending CN106996765A (zh) | 2017-03-21 | 2017-03-21 | 一种基于姿态传感器的机器人关节角度测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106996765A (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108209931A (zh) * | 2017-11-06 | 2018-06-29 | 苏州脉吉医疗技术有限公司 | 关节夹角的测量系统及方法 |
CN109945889A (zh) * | 2019-04-17 | 2019-06-28 | 合肥工业大学 | 一种基于双姿态传感器的关节角度测量方法 |
CN110398256A (zh) * | 2019-06-19 | 2019-11-01 | 北京摩高科技有限公司 | 一种人体单一姿态的初始校正方法 |
CN111267130A (zh) * | 2020-03-02 | 2020-06-12 | 拉玛机器人(上海)有限公司 | 一种可穿戴式口型捕捉设备及其使用方法 |
CN111421551A (zh) * | 2020-05-08 | 2020-07-17 | 哈尔滨理工大学 | 一种机器人关节信息获取方法 |
CN113375626A (zh) * | 2021-05-11 | 2021-09-10 | 北京自动化控制设备研究所 | 一种基于惯性装置的空间矢量相对平行度测量方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102566466A (zh) * | 2012-03-12 | 2012-07-11 | 上海大学 | 三自由度球面并联机构姿态闭环控制方法 |
CN103170979A (zh) * | 2013-02-06 | 2013-06-26 | 华南理工大学 | 基于惯性测量仪的在线机器人参数辨识方法 |
CN103942427A (zh) * | 2014-04-11 | 2014-07-23 | 哈尔滨工程大学 | 一类六自由度机械臂运动学逆解的快速简便求法 |
CN105415396A (zh) * | 2015-12-18 | 2016-03-23 | 青岛海蓝康复器械有限公司 | 一种关节级联系统的运动参数检测方法及关节级联系统 |
CN105643619A (zh) * | 2014-11-13 | 2016-06-08 | 中国科学院沈阳计算技术研究所有限公司 | 一种采用框架描述的工业机器人工具位姿控制方法 |
CN106003055A (zh) * | 2016-08-10 | 2016-10-12 | 广东工业大学 | 一种基于折弯机机械手的运动关节角求解方法 |
-
2017
- 2017-03-21 CN CN201710170099.3A patent/CN106996765A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102566466A (zh) * | 2012-03-12 | 2012-07-11 | 上海大学 | 三自由度球面并联机构姿态闭环控制方法 |
CN103170979A (zh) * | 2013-02-06 | 2013-06-26 | 华南理工大学 | 基于惯性测量仪的在线机器人参数辨识方法 |
CN103942427A (zh) * | 2014-04-11 | 2014-07-23 | 哈尔滨工程大学 | 一类六自由度机械臂运动学逆解的快速简便求法 |
CN105643619A (zh) * | 2014-11-13 | 2016-06-08 | 中国科学院沈阳计算技术研究所有限公司 | 一种采用框架描述的工业机器人工具位姿控制方法 |
CN105415396A (zh) * | 2015-12-18 | 2016-03-23 | 青岛海蓝康复器械有限公司 | 一种关节级联系统的运动参数检测方法及关节级联系统 |
CN106003055A (zh) * | 2016-08-10 | 2016-10-12 | 广东工业大学 | 一种基于折弯机机械手的运动关节角求解方法 |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108209931A (zh) * | 2017-11-06 | 2018-06-29 | 苏州脉吉医疗技术有限公司 | 关节夹角的测量系统及方法 |
CN109945889A (zh) * | 2019-04-17 | 2019-06-28 | 合肥工业大学 | 一种基于双姿态传感器的关节角度测量方法 |
CN109945889B (zh) * | 2019-04-17 | 2023-07-25 | 合肥工业大学 | 一种基于双姿态传感器的关节角度测量方法 |
CN110398256A (zh) * | 2019-06-19 | 2019-11-01 | 北京摩高科技有限公司 | 一种人体单一姿态的初始校正方法 |
CN110398256B (zh) * | 2019-06-19 | 2021-12-03 | 北京摩高科技有限公司 | 一种人体单一姿态的初始校正方法 |
CN111267130A (zh) * | 2020-03-02 | 2020-06-12 | 拉玛机器人(上海)有限公司 | 一种可穿戴式口型捕捉设备及其使用方法 |
CN111421551A (zh) * | 2020-05-08 | 2020-07-17 | 哈尔滨理工大学 | 一种机器人关节信息获取方法 |
CN113375626A (zh) * | 2021-05-11 | 2021-09-10 | 北京自动化控制设备研究所 | 一种基于惯性装置的空间矢量相对平行度测量方法 |
CN113375626B (zh) * | 2021-05-11 | 2024-05-03 | 北京自动化控制设备研究所 | 一种基于惯性装置的空间矢量相对平行度测量方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106996765A (zh) | 一种基于姿态传感器的机器人关节角度测量方法 | |
CN103226398B (zh) | 基于微惯性传感器网络技术的数据手套 | |
CN102289306B (zh) | 姿态感知设备及其定位、鼠标指针的控制方法和装置 | |
CN103337066B (zh) | 3d获取系统的校准方法 | |
CN102980577B (zh) | 一种微型捷联航姿系统及其工作方法 | |
CN104792340B (zh) | 一种星敏感器安装误差矩阵与导航系统星地联合标定与校正的方法 | |
CN100585602C (zh) | 惯性测量系统误差模型验证试验方法 | |
CN103900571B (zh) | 一种基于惯性坐标系旋转型捷联惯导系统的载体姿态测量方法 | |
CN100356139C (zh) | 用于微小卫星的微型组合姿态测量系统 | |
CN108801166A (zh) | 基于悬臂梁理论的光纤光栅机翼形变测量建模及标定方法 | |
CN102116628A (zh) | 一种着陆或附着深空天体探测器的高精度导航方法 | |
CN103175502A (zh) | 一种基于数据手套低速运动的姿态角检测方法 | |
CN106441301A (zh) | 一种飞行器发射初始参数获取方法及系统 | |
CN104713555A (zh) | 应用全天域中性点辅助定向的车辆自主导航方法 | |
CN102520728B (zh) | 一种采用双天线gps实现可控翼伞精确定点回收的方法 | |
CN104075699A (zh) | 三维固态电子罗盘及其传感器的零点和比例系数核正方法 | |
CN103900566B (zh) | 一种消除地球自转角速度对旋转调制型捷联惯导系统精度影响的方法 | |
CN106896819A (zh) | 基于三星敏感器的卫星姿态确定方法和系统 | |
CN103196445A (zh) | 基于匹配技术的地磁辅助惯性的载体姿态测量方法 | |
CN106767925A (zh) | 带双轴转位机构的惯导系统三位置参数辨识对准方法 | |
CN105841698A (zh) | 一种无需调零的auv舵角精确实时测量系统 | |
CN107830861A (zh) | 基于自适应增益互补滤波运动物体姿态测量方法及装置 | |
CN102087117A (zh) | 飞船交会对接用测距敏感器精度的地面测量方法 | |
CN102042833B (zh) | 运动追踪方法与系统 | |
CN103389808A (zh) | 一种空间鼠标及获取空间鼠标位移的方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20170801 |
|
WD01 | Invention patent application deemed withdrawn after publication |