CN102278963B - 并联机器人自标定方法 - Google Patents
并联机器人自标定方法 Download PDFInfo
- Publication number
- CN102278963B CN102278963B CN201110180512A CN201110180512A CN102278963B CN 102278963 B CN102278963 B CN 102278963B CN 201110180512 A CN201110180512 A CN 201110180512A CN 201110180512 A CN201110180512 A CN 201110180512A CN 102278963 B CN102278963 B CN 102278963B
- Authority
- CN
- China
- Prior art keywords
- pose
- equation
- parallel robot
- branch
- moving platform
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Manipulator (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Abstract
一种并联机器人自标定方法,该方法在并联机器人各驱动分支上安装位移传感器,在并联机器人定平台和动平台之间增设测量分支,其上安装拉绳传感器,建立驱动分支和测量分支位移相对变化量与动平台位姿及各分支机构学参数之间的函数关系,驱动并联机器人进行位姿变换,使所能建立方程数目大于等于待辨识机构学参数数目,进行数值求解,以获得任意状态动平台位姿及机构学参数误差,进而实现自标定。本发明成本低廉、操作便捷,不受距离的约束,且几乎不对机构设计增添约束,是并联机器人标定方案的很好选择。
Description
技术领域
本发明涉及一种机器人,特别是并联机器人自标定的方法。
背景技术
并联机器人为多环闭链机构且各运动链和关节运动副为空间布置,结构参数较多且检测困难,故并联机器人的标定比传统的串联机器人要复杂的多。并联机器人标定的难点在于其动平台位姿信息及各分支初始杆长的获得。无论采用何种标定方法,均需对并联机器人的运动信息进行全部或部分测量。目前对并联机器人基本是采用外部标定的方法,该外部标定需借助精密的外部测量设备进行测试,标定时在某一指定的设备所处位置应当尽可能检测到所有的测量点,否则就需要转站或增加测量设备,而这将提高测量成本、降低测量精度及工作效率。对于待标定设备,特别是高空作业设备,因其测试距离远,测量设备的布站将十分困难,并且这些仪器安装条件较为苛刻,在应用时需要进行精细调整,耗时长,对操作要求高,应用不便。
发明内容
本发明的目的在于在保证机械结构基本不变的前提下,有机结合并联机器人运动学特点,提供一种几乎不对机构设计增添约束的成本低廉、操作简便、效率高、不受距离限制、测量精度高的并联机器人自标定方法。
本发明主要是:
①在并联机器人6个驱动分支移动副上安装位移传感器,如光栅尺或磁致伸缩位移传感器;在并联机器人定平台和动平台之间增设N个测量分支(l 1, l 2, …, l N),其两端分别与定、动平台固结,每个测量分支上安装有一拉绳传感器;
②对应任一特定位姿,由并联机构学理论,可建立6个驱动分支和N个测量分支的反解方程,即可建立(6+N)个独立的显式方程,而方程中未知数包括动平台6个位姿参数以及(6+N)个分支杆长,共计(12+N)个未知参数;
③在不考虑其它机构学参数误差(如各铰点位置误差)的情况下,以任一位姿为初始状态,驱动机器人变换位姿,则对应新位姿,又可建立(6+N)个方程,此次驱动分支变化量可由安装于其上的位移传感器获得,测量分支变化量可由拉绳传感器获得,即仅新增6个位姿参数,则此时方程总数为2×(6+N),而未知量数目为(18+N);
④驱动机器人再次变换一新位姿,同理,又可建立(6+N)个方程,新增6个位姿参数;
⑤以此类推,假设变换新位姿n次,则共可建立方程(6+N)×(n+1)个,而未知参数为(12+N+6n)个,因此,当方程数大于等于未知参数数目时,即当(6+N)×(n+1)≥(12+N+6n)时,方程可解,则可以求得任意状态动平台位姿及机构学参数误差,即能实现机器人自标定。
进一步,若需考虑更多的机构学参数误差,则通过增加动平台位姿变化次数,可以建立足够的方程来求解未知参数。与此同时,方程数目的增加可能导致数值求解的难度加大,但对于同等数目的待辨识机构学参数,增加拉绳传感器的数目,将减少所需的动平台位姿变化次数,所建立的方程总数也会减少,数值求解的难度自然随之降低。
本发明与现有技术相比具有如下优点:
1、在并联机器人驱动分支安装位移传感器,在定、动平台间增设安装一定数量的拉绳传感器,仅通过简单的、有限次动平台位姿的变换,无需已知初始杆长,由传感器位移相对变化量即可求解出任意状态下动平台位姿信息及各分支杆长。拉绳传感器安装尺寸小、结构紧凑、测量行程大、测量精度高,并且安装简单,安装精度易于保证。
2、本发明的测量方法不需要复杂、昂贵的外部空间位姿测量装置,对标定环境要求较低,且基本不对机构设计增添约束,成本低廉,操作便捷可靠,不受距离限制,适用于高空、远距离作业等多种场合。
3、所述方法对于少自由度并联机器人同样适用。
附图说明
图1为本发明并联机器人自标定方法示意简图。
具体实施方式
结合附图,以其为例具体描述本发明所述的并联机器人自标定方法。
如图1所示,本发明所涉及并联机器人由定平台1、动平台2、驱动分支3(A 1 B 1、A 2 B 2、……、 A 6 B 6)以及连接各分支与定、动平台的铰链4、5(虎克铰或球铰)组成;在并联机器人定平台1和动平台2之间增设有3个测量分支6(A 7 B 7、A 8 B 8、A 9 B 9),其两端分别与定、动平台固结(可通过螺纹连接,也可焊接,位置任意),每个分支上安装有拉绳传感器7;并联机器人每个驱动分支的移动副上均安装位移传感器8。
对应某一特定位姿,可建立6个驱动分支和3个测量分支杆长与动平台6个位姿参数(3个位置变量,3个姿态变量)以及各铰点位置矢量之间的关系方程如下所示:
式中,为对应第次位姿情况下第个分支的杆长;为对应第次位姿情况下第个分支的杆长矢量;为由并联机器人动平台到定平台的姿态变化矩阵;为各分支(包括驱动分支和测量分支)与定平台相连铰点在与定平台固结的定坐标系中的位置矢量;为各分支与动平台相连铰点在与动平台固结的动坐标系中的位置矢量;为对应第次位姿情况下动坐标系原点相对于定坐标系的位置矢量;表示位姿变换次数,(与测量分支数目及待标定机构学参数有关);(M=6+N)。
以图1所示情况为例,假设增设3个测量分支,即N=3,则由上式,对应某一种位姿,可建立9个独立的方程,而方程中动平台姿态(3个角度)与位置(3个)以及9个杆长(包括驱动分支和测量分支)均为未知参数,共计有15个。此时方程数目少于未知参数数目,不可解。
驱动机器人变换位姿,则对应新位姿,依据上式,又可建立9个方程,此时方程总数为18个。位姿变化后,相应的驱动分支和测量分支杆长变化量可由安装于其上的位移传感器获得,故杆长未知量总数不变,未知参数仅增加动平台姿态与位置(6个)。此时,未知参数共计有21个(15+6),多于方程总数,仍不可解。
再次驱动机器人变换一新位姿,同理,又可建立9个方程,新增6个未知位姿参数,此时,方程总数为27个(18+9),而未知参数亦为27个(21+6),方程数与未知参数相同,方程可解,未知参数可求,则可以获得机器人各驱动分支初始杆长,同时变化过程中的位姿参数及测量分支杆长亦可获得。
更进一步,若考虑各铰链点位置误差,依据同样的思路,通过增加动平台位姿变化次数,可以建立足够的方程来求解未知参数,进而实现机器人自标定。
Claims (2)
1.一种并联机器人自标定方法,其特征在于:①在并联机器人6个驱动分支上安装位移传感器,在并联机器人定平台和动平台之间增设N个测量分支l 1, l 2, …, l N,其两端分别与定、动平台固结,每个测量分支上安装有一拉绳传感器;②对应任一特定位姿,可建立6个驱动分支和N个测量分支的反解方程,即可建立6+N个独立的显式方程,而方程中未知数包括动平台6个位姿参数以及6+N个分支杆长,共计12+N个未知参数;③以任一位姿为初始状态,驱动机器人变换位姿,则对应新位姿,又可建立6+N个方程,此次驱动分支变化量可由安装于其上的位移传感器获得,测量分支变化量可由拉绳传感器获得,即仅新增6个位姿参数,则此时方程总数为2×(6+N),而未知量数目为18+N;④驱动机器人再次变换一新位姿,同理,又可建立6+N个方程,新增6个位姿参数;⑤以此类推,假设变换新位姿n次,则共可建立方程(6+N)×(n+1)个,而未知参数为(12+N+6n)个,因此,当方程数大于等于未知参数数目时,即当(6+N)×(n+1)≥(12+N+6n)时,方程可解,则借助安装于并联机器人驱动分支上的位移传感器以及测量分支上的拉绳传感器所检测的位移变化信息,可以求得任意状态动平台位姿及机构学参数误差,即能实现机器人自标定。
2.根据权利要求1所述的并联机器人自标定方法,其特征在于:方程数目的增加可能导致数值求解的难度加大,但对于同等数目的待辨识机构学参数,增加拉绳传感器的数目,将减少所需的动平台位姿变化次数,所建立的方程总数也会减少,数值求解的难度自然随之降低。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110180512A CN102278963B (zh) | 2011-06-30 | 2011-06-30 | 并联机器人自标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110180512A CN102278963B (zh) | 2011-06-30 | 2011-06-30 | 并联机器人自标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102278963A CN102278963A (zh) | 2011-12-14 |
CN102278963B true CN102278963B (zh) | 2012-09-05 |
Family
ID=45104551
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201110180512A Expired - Fee Related CN102278963B (zh) | 2011-06-30 | 2011-06-30 | 并联机器人自标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102278963B (zh) |
Families Citing this family (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102636139B (zh) * | 2012-04-12 | 2014-11-05 | 中国工程物理研究院激光聚变研究中心 | 空间六自由度运动的六位移传感器动态测量法 |
CN102692201B (zh) * | 2012-06-19 | 2014-07-02 | 重庆大学 | 空间六自由度运动的测量装置及动态测量方法 |
CN102915031B (zh) * | 2012-10-25 | 2015-08-12 | 中国科学技术大学 | 并联机器人运动学参数的智能自标定*** |
CN103363937A (zh) * | 2013-06-28 | 2013-10-23 | 朱留存 | 三自由度空间位置检测机构 |
CN103934823B (zh) * | 2014-04-28 | 2015-09-30 | 哈尔滨工程大学 | 一种具有自标定功能的6-ptrt型并联机器人 |
CN104084943A (zh) * | 2014-06-26 | 2014-10-08 | 西南科技大学 | 一种强辐射环境液控拆除机器人 |
CN104236491B (zh) * | 2014-06-27 | 2017-03-22 | 华东交通大学 | 一种四绳牵引三自由度智能测量机器人 |
CN104390612B (zh) * | 2014-07-08 | 2017-03-08 | 西安电子科技大学 | 用于Stewart平台构型的六自由度并联机器人基准位姿标定方法 |
CN106476013A (zh) * | 2016-12-18 | 2017-03-08 | 河南机电职业学院 | 晶胞结构及算法表达六自由度运动平台结构及算法的方法 |
CN110815206B (zh) * | 2018-08-14 | 2022-11-29 | 中国科学院沈阳自动化研究所 | 一种Stewart型并联机器人运动学标定方法 |
CN110815207B (zh) * | 2018-08-14 | 2022-10-21 | 中国科学院沈阳自动化研究所 | 一种Stewart型并联柔索机器人运动学标定方法 |
CN111716331A (zh) * | 2020-06-28 | 2020-09-29 | 中国科学院长春光学精密机械与物理研究所 | 一种六自由度并联机构参数标定装置及方法 |
CN111872922B (zh) * | 2020-07-29 | 2021-09-03 | 贵州电网有限责任公司 | 基于3d视觉传感器的三自由度并联机器人手眼标定方法 |
CN112975913B (zh) * | 2021-03-10 | 2022-05-27 | 清华大学 | 一种索驱动并联机构自标定方法和*** |
CN113146627B (zh) * | 2021-04-01 | 2022-11-18 | 洛阳理工学院 | 基于实时测量数据的并联机构动力学参数求解方法 |
CN113386110A (zh) * | 2021-07-14 | 2021-09-14 | 上海交通大学医学院附属第九人民医院 | 六自由度平台 |
CN114485500B (zh) * | 2021-12-30 | 2024-06-07 | 南京理工大学 | 一种并联驱动机构动平台位姿测量***的集成结构 |
CN114571465B (zh) * | 2022-03-31 | 2023-08-22 | 伯朗特机器人股份有限公司 | 一种基于模拟退火算法的四轴并联机器人校准方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1147705C (zh) * | 2001-10-23 | 2004-04-28 | 北京邮电大学 | 一种用于空间全位置和姿态的测量方法及其装置 |
US20050038563A1 (en) * | 2003-08-16 | 2005-02-17 | Abdul Rauf | Device and method for kinematic calibration of robots |
CN102052984A (zh) * | 2010-11-04 | 2011-05-11 | 燕山大学 | 冗余容错式并联结构六维力传感器 |
-
2011
- 2011-06-30 CN CN201110180512A patent/CN102278963B/zh not_active Expired - Fee Related
Non-Patent Citations (1)
Title |
---|
常鹏等.平面三自由度冗余并联机床的分步自标定方法.《清华大学学报(自然科学版)》.2008,第48卷(第05期),809-811. * |
Also Published As
Publication number | Publication date |
---|---|
CN102278963A (zh) | 2011-12-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102278963B (zh) | 并联机器人自标定方法 | |
CN104390612B (zh) | 用于Stewart平台构型的六自由度并联机器人基准位姿标定方法 | |
CN107717994B (zh) | 基于主从空间映射的主从异构机器人通用控制方法及*** | |
CN102692201B (zh) | 空间六自由度运动的测量装置及动态测量方法 | |
CN107152911A (zh) | 基于psd反馈的点激光传感器与机器人相对位置的标定方法 | |
Zi et al. | Error modeling and sensitivity analysis of a hybrid-driven based cable parallel manipulator | |
CN102348541A (zh) | 机器人设备及其控制方法 | |
CN103720514B (zh) | 针对手术空间的医疗外科机器人的参数优化方法 | |
CN104354166A (zh) | 一种三自由度并联机器人的零点标定方法 | |
CN105043333A (zh) | 一种小型水下机械手位置角度测量方法 | |
CN105066808A (zh) | 一种工业机器人运动学参数简易标定装置及其标定方法 | |
Jiang et al. | Design and Nonlinear Control of a 2‐DOF Flexible Parallel Humanoid Arm Joint Robot | |
CN105241411A (zh) | Stewart平台支腿长度测量装置及Stewart平台位姿测试***、方法 | |
CN107121128A (zh) | 一种足式机器人地形参数的测量方法及*** | |
JP2016052699A (ja) | ロボット制御システムおよびロボット制御方法 | |
CN206416155U (zh) | 一种基于直线运动单元驱动的并联机构装置 | |
CN102910533A (zh) | 一种基于吊机的空间角度测量方法 | |
Ji et al. | Self-identification of cable-driven exoskeleton based on asynchronous iterative method | |
CN205719350U (zh) | 一种并联式五维力传感器 | |
CN109211174B (zh) | 一种空间矢量拉绳测量方法及装置 | |
CN105806312A (zh) | 基于三条及以上支撑腿的足式机器人地形参数测量方法 | |
CN101832834A (zh) | 用于失重环境下攀爬训练的抓杆测力装置 | |
Felt | Sensing methods for soft robotics | |
CN202711000U (zh) | 三维高精度全自动超高频段雷达天线近场测试闭环控制*** | |
CN205027329U (zh) | Stewart平台支腿长度测量装置及Stewart平台位姿测试*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20120905 Termination date: 20150630 |
|
EXPY | Termination of patent right or utility model |