CN205333008U - 一种连杆机构的结构参数辨识系统 - Google Patents
一种连杆机构的结构参数辨识系统 Download PDFInfo
- Publication number
- CN205333008U CN205333008U CN201521038543.9U CN201521038543U CN205333008U CN 205333008 U CN205333008 U CN 205333008U CN 201521038543 U CN201521038543 U CN 201521038543U CN 205333008 U CN205333008 U CN 205333008U
- Authority
- CN
- China
- Prior art keywords
- structural parameters
- identification
- linkage
- foot rest
- rail
- 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
- 239000012636 effector Substances 0.000 claims abstract description 24
- 238000004891 communication Methods 0.000 claims abstract description 12
- 238000009434 installation Methods 0.000 claims description 27
- 238000012545 processing Methods 0.000 abstract description 2
- 238000000034 method Methods 0.000 description 7
- 239000013598 vector Substances 0.000 description 6
- TVEXGJYMHHTVKP-UHFFFAOYSA-N 6-oxabicyclo[3.2.1]oct-3-en-7-one Chemical compound C1C2C(=O)OC1C=CC2 TVEXGJYMHHTVKP-UHFFFAOYSA-N 0.000 description 3
- 238000009825 accumulation Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000003754 machining Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
Landscapes
- Manipulator (AREA)
Abstract
本实用新型涉及一种连杆机构的结构参数辨识系统，属于结构参数辨识领域。本实用新型包括结构参数辨识装置、连杆机构、计算机、结构参数辨识装置电缆、连杆机构电缆；所述结构参数辨识装置通过结构参数辨识装置电缆与计算机连接通讯，连杆机构通过连杆机构电缆与计算机连接通讯；通过计算机采集连杆机构的转角及光栅读数头读取的结构参数辨识装置的滑动轨端点至支撑轨端点的长度，并根据采集到的长度计算结构参数辨识所需要的长度；所述结构参数辨识所需要的长度为结构参数辨识装置固定在一点时，连杆机构的末端执行器随结构参数辨识装置的滑动轨在支撑轨上移动的距离。本实用新型提高了结构参数解算的可靠性和精度；适用范围更广、加工更容易。
Description
技术领域
本实用新型涉及一种连杆机构的结构参数辨识系统，属于结构参数辨识领域。
背景技术
连杆机构是一种多自由度设备，目前在工业现场测量、产品逆向设计等多个领域都有涉及。连杆机构通常采用空间开链式结构，这种结构形式存在误差累积放大的缺点，各级关节的结构参数误差会被逐级放大，从而造成连杆机构的精度降低。
结构参数辨识是消除连杆机构结构参数误差的有效方法，由于结构的差异，传统的结构参数辨识方法无法直接应用于连杆机构上，而目前机器人领域的结构参数辨识方法一般都要借助激光跟踪仪、激光干涉仪等昂贵的精密测量仪器，且结构参数辨识操作步骤繁琐、结构参数辨识时间长，因此应用成本也很高。此外，目前的结构参数辨识装置需要其它精密仪器的辅助测量，增加了结构参数辨识的难度。
发明内容
本实用新型提供了一种连杆机构的结构参数辨识系统及方法，以用于解决现有采用的结构参数辨识装置需要其它精密仪器的辅助测量等问题。
本实用新型的技术方案是：一种连杆机构的结构参数辨识系统，包括结构参数辨识装置、连杆机构15、计算机16、结构参数辨识装置电缆17、连杆机构电缆18；
所述结构参数辨识装置通过结构参数辨识装置电缆17与计算机16连接通讯，连杆机构15通过连杆机构电缆18与计算机16连接通讯；通过计算机16采集连杆机构15的转角及光栅读数头9读取的结构参数辨识装置的滑动轨端点20至支撑轨端点21的长度，并根据采集到的长度计算结构参数辨识所需要的长度；所述结构参数辨识所需要的长度为结构参数辨识装置固定在一点时，连杆机构15的末端执行器随结构参数辨识装置的滑动轨4在支撑轨3上移动的距离。
所述结构参数辨识装置包括磁性表座1、连接杆2、支撑轨3、滑动轨4、连接板5、连接板安装螺栓6、万向节7、安装脚架8、光栅读数头9、安装脚架螺栓10、脚架11、光栅尺12、脚架螺栓13、读数头安装螺栓14；
所述磁性表座1通过磁力安装在固定平台19上，磁性表座1与导向副的支撑轨3通过连接杆2连接在一起，导向副由支撑轨3、滑动轨4组成，支撑轨3上贴有有光栅尺12，滑动轨4上通过连接板安装螺栓6安装有连接板5，连接板5上通过脚架螺栓13安装有脚架11，脚架11上通过安装脚架螺栓10安装有安装脚架8，安装脚架8上通过读数头安装螺栓14安装有光栅读数头9，由光栅读数头9将当前结构参数辨识装置滑动轨端点20至支撑轨端点21的长度读取出来，移动滑动轨4并将移动后滑动轨端点20至支撑轨端点21的长度读取出来，根据两次读数可计算出连杆机构15的末端执行器在空间两点的距离，用于结构参数辨识计算，万向节7一端通过螺纹连接在连接板5上，万向节7另一端通过螺纹7安装在连杆机构15末端执行器上。
所述磁性表座1表面有螺纹孔，所述连接杆2两端有螺纹，所述支撑轨3一端有螺纹孔。
本实用新型的工作原理是：利用万向节7将连杆机构15的末端执行器与结构参数辨识装置的连接板5连接，连杆机构15的末端执行器随光栅读数头9一起移动，连杆机构15的末端执行器随结构参数辨识装置的滑动轨4在支撑轨3上移动的距离即为结构参数辨识所需要的长度，此长度可根据光栅读数头9两次读数计算得出。根据计算出的长度并利用采集到的连杆机构15的关节转角数据，通过运动学方程得到以连杆机构15结构参数为未知量的方程式，移动结构参数辨识装置并变换关节转角就可以得到一系列方程式，联立所得到的方程式即可得到结构参数辨识方程组，求解结构参数辨识方程组即可得到连杆机构的结构参数、实现连杆机构的结构参数辨识。
具体步骤如下：
Step1、利用万向节7将连杆机构15与结构参数辨识装置连接；
Step2、移动结构参数辨识装置使连杆机构15移动至初始位姿；
Step3、固定结构参数辨识装置于一点并记录结构参数辨识装置的初始位置i=1；
Step4、采集结构参数辨识装置位于位置i时光栅读数头9的读数以及对应的连杆机构15的关节转角，方法如下：
首先通过计算机16采集滑动轨端点20至支撑轨端点21的长度l i,k 和连杆机构15的转角数据，然后移动滑动轨4，同时变换连杆机构15的位姿，通过计算机采集滑动轨端点20至支撑轨端点21的长度l i,p 和连杆机构15的转角数据，其中k,p为连杆机构15末端执行器随滑动轨4移动的连续两点；结构参数辨识装置位于位置i时，采集t个滑动轨端点20至支撑轨端点21的长度及t组连杆机构15的转角数据；其中连杆机构15各个关节运动方式如下：按照关节从小到大的原则依次运动，关节一从0°变换到20°，下一次再从20°变换到40°，以此类推，每次变换关节的角度增加20°，一直增加到340°，即完成此关节的位姿变换，其余关节也按照这种方法运动，使连杆机构各个关节充分运动；
Step5、计算结构参数辨识所需要的长度：两次采集到的长度之差为连杆机构15末端执行器随结构参数辨识装置的滑动轨4在支撑轨3上移动的距离，从而可得到连杆机构15末端执行器空间两点的距离，该距离为结构参数辨识所需要的长度即为：l i,p －l i,k ；
Step6、判断是否完成数据采集操作，若尚未完成则移动结构参数辨识装置并且位置变量自增1：i＝i+1，并转至步骤Step4；若已完成结构参数辨识数据采集操作则转至步骤Step7；
Step7、完成结构参数辨识数据采集后，令n=i；
Step8、求解待辨识的连杆机构的结构参数向量m：
由于固定结构参数辨识装置于固定平台（19）位置i时，连杆机构（15）末端执行器随滑动轨（4）由点k移动到点p的距离是角度向量θ i,k 、θ i,p 与待辨识的连杆机构的结构参数向量m的函数，有：
F(θ 1,1,θ 1,2,m)=|l 1,2－l 1,1|
F(θ 1,3,θ 1,4,m)=|l 1,4－l 1,3|
F(θ 1,t-1,θ 1,t ,m)=|l 1,t －l 1,t-1|
F(θ 2,t+1,θ 2,t+2,m)=|l 2,t+2－l 2,t+1|
F(θ 2,2t-1,θ 2,2t ,m)=|l 2,2t －l 2,2t-1|
F(θ n,nt-1,θ n,nt ,m)=|l n,nt －l n,nt-1|
在上面的方程组中，只有待辨识的连杆机构的结构参数向量m是不确定的，对其进行求解，得到结构参数向量m的精确值；
Step9、将结构参数向量m代入连杆机构15的运动学方程中，验证结构参数辨识结果的有效性，完成连杆机构的结构参数辨识。
本实用新型的有益效果是：
1、结构参数辨识装置可以固定在固定平台多个位置，从而在采集数据时连杆机构的运动空间变大，连杆机构各关节的运动更加充分，为结构参数解算提供了鲁棒性更强的数据支持。
2、连杆机构的末端执行器随光栅读数头一起移动，结构参数辨识所需的长度可以由光栅尺系统精确计算得到，计算出的长度误差很小，提高了结构参数解算的可靠性和精度。
3、由于结构参数辨识装置的有效长度为两次光栅读数头读数之差，其它零件的加工精度对读数的精度几乎无影响，并且结构参数辨识装置不存在长度校准，从而适用范围更广、加工更容易。
附图说明
图1是本实用新型中结构参数辨识装置的结构示意图；
图2是本实用新型中结构参数辨识装置的外形图；
图3是本实用新型中结构参数辨识装置的俯视图；
图4是本实用新型中结构参数辨识装置的左视图；
图5是本实用新型中结构参数辨识装置的滑动轨外形图；
图6是本实用新型中结构参数辨识装置的脚架外形图；
图7是本实用新型装置固定于位置1，连杆机构末端执行器位于位置点1时，在结构参数辨识过程中采集数据时的位姿图；
图8是本实用新型装置固定于位置1，连杆机构末端执行器位于位置点2时，在结构参数辨识过程中采集数据时的位姿图；
图中：1-磁性表座、2-连接杆、3-支撑轨、4-滑动轨、5-连接板、6-连接板安装螺栓、7-万向节、8-安装脚架、9-光栅读数头、10-安装脚架螺栓、11-脚架、12-光栅尺、13-脚架螺栓、14-读数头安装螺栓、15-连杆机构、16-计算机、17-结构参数辨识装置电缆、18-连杆机构电缆、19-固定平台、20-滑动轨端点、21-支撑轨端点。
具体实施方式
实施例1：如图1-8所示，一种连杆机构的结构参数辨识系统，包括结构参数辨识装置、连杆机构15、计算机16、结构参数辨识装置电缆17、连杆机构电缆18；
所述结构参数辨识装置通过结构参数辨识装置电缆17与计算机16连接通讯，连杆机构15通过连杆机构电缆18与计算机16连接通讯；通过计算机16采集连杆机构15的转角及光栅读数头9读取的结构参数辨识装置的滑动轨端点20至支撑轨端点21的长度，并根据采集到的长度计算结构参数辨识所需要的长度；所述结构参数辨识所需要的长度为结构参数辨识装置固定在一点时，连杆机构15的末端执行器随结构参数辨识装置的滑动轨4在支撑轨3上移动的距离。
所述结构参数辨识装置包括磁性表座1、连接杆2、支撑轨3、滑动轨4、连接板5、连接板安装螺栓6、万向节7、安装脚架8、光栅读数头9、安装脚架螺栓10、脚架11、光栅尺12、脚架螺栓13、读数头安装螺栓14；
所述磁性表座1通过磁力安装在固定平台19上，磁性表座1与导向副的支撑轨3通过连接杆2连接在一起，导向副由支撑轨3、滑动轨4组成，支撑轨3上贴有有光栅尺12，滑动轨4上通过连接板安装螺栓6安装有连接板5，连接板5上通过脚架螺栓13安装有脚架11，脚架11上通过安装脚架螺栓10安装有安装脚架8，安装脚架8上通过读数头安装螺栓14安装有光栅读数头9，由光栅读数头9将当前结构参数辨识装置滑动轨端点20至支撑轨端点21的长度读取出来，移动滑动轨4并将移动后滑动轨端点20至支撑轨端点21的长度读取出来，根据两次读数可计算出连杆机构15的末端执行器在空间两点的距离，用于结构参数辨识计算，万向节7一端通过螺纹连接在连接板5上，万向节7另一端通过螺纹7安装在连杆机构15末端执行器上。
所述磁性表座1表面有螺纹孔，所述连接杆2两端有螺纹，所述支撑轨3一端有螺纹孔。
实施例2：如图1-8所示，一种连杆机构的结构参数辨识系统，包括结构参数辨识装置、连杆机构15、计算机16、结构参数辨识装置电缆17、连杆机构电缆18；
所述结构参数辨识装置通过结构参数辨识装置电缆17与计算机16连接通讯，连杆机构15通过连杆机构电缆18与计算机16连接通讯；通过计算机16采集连杆机构15的转角及光栅读数头9读取的结构参数辨识装置的滑动轨端点20至支撑轨端点21的长度，并根据采集到的长度计算结构参数辨识所需要的长度；所述结构参数辨识所需要的长度为结构参数辨识装置固定在一点时，连杆机构15的末端执行器随结构参数辨识装置的滑动轨4在支撑轨3上移动的距离。
所述结构参数辨识装置包括磁性表座1、连接杆2、支撑轨3、滑动轨4、连接板5、连接板安装螺栓6、万向节7、安装脚架8、光栅读数头9、安装脚架螺栓10、脚架11、光栅尺12、脚架螺栓13、读数头安装螺栓14；
所述磁性表座1通过磁力安装在固定平台19上，磁性表座1与导向副的支撑轨3通过连接杆2连接在一起，导向副由支撑轨3、滑动轨4组成，支撑轨3上贴有有光栅尺12，滑动轨4上通过连接板安装螺栓6安装有连接板5，连接板5上通过脚架螺栓13安装有脚架11，脚架11上通过安装脚架螺栓10安装有安装脚架8，安装脚架8上通过读数头安装螺栓14安装有光栅读数头9，由光栅读数头9将当前结构参数辨识装置滑动轨端点20至支撑轨端点21的长度读取出来，移动滑动轨4并将移动后滑动轨端点20至支撑轨端点21的长度读取出来，根据两次读数可计算出连杆机构15的末端执行器在空间两点的距离，用于结构参数辨识计算，万向节7一端通过螺纹连接在连接板5上，万向节7另一端通过螺纹7安装在连杆机构15末端执行器上。
实施例3：如图1-8所示，一种连杆机构的结构参数辨识系统，包括结构参数辨识装置、连杆机构15、计算机16、结构参数辨识装置电缆17、连杆机构电缆18；
所述结构参数辨识装置通过结构参数辨识装置电缆17与计算机16连接通讯，连杆机构15通过连杆机构电缆18与计算机16连接通讯；通过计算机16采集连杆机构15的转角及光栅读数头9读取的结构参数辨识装置的滑动轨端点20至支撑轨端点21的长度，并根据采集到的长度计算结构参数辨识所需要的长度；所述结构参数辨识所需要的长度为结构参数辨识装置固定在一点时，连杆机构15的末端执行器随结构参数辨识装置的滑动轨4在支撑轨3上移动的距离。
上面结合附图对本实用新型的具体实施方式作了详细说明，但是本实用新型并不限于上述实施方式，在本领域普通技术人员所具备的知识范围内，还可以在不脱离本实用新型宗旨的前提下作出各种变化。
Claims (3)
1.一种连杆机构的结构参数辨识系统，其特征在于：包括结构参数辨识装置、连杆机构（15）、计算机（16）、结构参数辨识装置电缆（17）、连杆机构电缆（18）；
所述结构参数辨识装置通过结构参数辨识装置电缆（17）与计算机（16）连接通讯，连杆机构（15）通过连杆机构电缆（18）与计算机（16）连接通讯；通过计算机（16）采集连杆机构（15）的转角及光栅读数头（9）读取的结构参数辨识装置的滑动轨端点（20）至支撑轨端点（21）的长度，并根据采集到的长度计算结构参数辨识所需要的长度；所述结构参数辨识所需要的长度为结构参数辨识装置固定在一点时，连杆机构（15）的末端执行器随结构参数辨识装置的滑动轨（4）在支撑轨（3）上移动的距离。
2.根据权利要求1所述的连杆机构的结构参数辨识系统，其特征在于：所述结构参数辨识装置包括磁性表座（1）、连接杆（2）、支撑轨（3）、滑动轨（4）、连接板（5）、连接板安装螺栓（6）、万向节（7）、安装脚架（8）、光栅读数头（9）、安装脚架螺栓（10）、脚架（11）、光栅尺（12）、脚架螺栓（13）、读数头安装螺栓（14）；
所述磁性表座（1）通过磁力安装在固定平台（19）上，磁性表座（1）与导向副的支撑轨（3）通过连接杆（2）连接在一起，导向副由支撑轨（3）、滑动轨（4）组成，支撑轨（3）上贴有有光栅尺（12），滑动轨（4）上通过连接板安装螺栓（6）安装有连接板（5），连接板（5）上通过脚架螺栓（13）安装有脚架（11），脚架（11）上通过安装脚架螺栓（10）安装有安装脚架（8），安装脚架（8）上通过读数头安装螺栓（14）安装有光栅读数头（9），由光栅读数头（9）将当前结构参数辨识装置滑动轨端点（20）至支撑轨端点（21）的长度读取出来，移动滑动轨（4）并将移动后滑动轨端点（20）至支撑轨端点（21）的长度读取出来，根据两次读数可计算出连杆机构（15）的末端执行器在空间两点的距离，用于结构参数辨识计算，万向节（7）一端通过螺纹连接在连接板（5）上，万向节（7）另一端通过螺纹（7）安装在连杆机构（15）末端执行器上。
3.根据权利要求2所述的连杆机构的结构参数辨识系统，其特征在于：所述磁性表座（1）表面有螺纹孔，所述连接杆（2）两端有螺纹，所述支撑轨（3）一端有螺纹孔。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201521038543.9U CN205333008U (zh) | 2015-12-15 | 2015-12-15 | 一种连杆机构的结构参数辨识系统 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201521038543.9U CN205333008U (zh) | 2015-12-15 | 2015-12-15 | 一种连杆机构的结构参数辨识系统 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN205333008U true CN205333008U (zh) | 2016-06-22 |
Family
ID=56211737
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201521038543.9U Expired - Fee Related CN205333008U (zh) | 2015-12-15 | 2015-12-15 | 一种连杆机构的结构参数辨识系统 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN205333008U (zh) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN105423918A (zh) * | 2015-12-15 | 2016-03-23 | 昆明理工大学 | 一种连杆机构的结构参数辨识系统及方法 |
-
2015
- 2015-12-15 CN CN201521038543.9U patent/CN205333008U/zh not_active Expired - Fee Related
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN105423918A (zh) * | 2015-12-15 | 2016-03-23 | 昆明理工大学 | 一种连杆机构的结构参数辨识系统及方法 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN105538341B (zh) | 一种基于末端非完整坐标信息的机器人标定系统及方法 | |
| CN104390615B (zh) | 一种关节臂式坐标测量机的自标定系统及方法 | |
| CN105666490B (zh) | 一种机器人的标定系统及方法 | |
| CN108297101B (zh) | 多关节臂串联机器人末端位姿误差检测和动态补偿方法 | |
| CN104596418B (zh) | 一种多机械臂系统坐标系标定及精度补偿方法 | |
| CN103899338B (zh) | 一种基于空间坐标变换的液压支架工作姿态确定方法 | |
| CN101377418B (zh) | 基于旋转-直线运动的接触式大型异型玻璃外廓检测装置和方法 | |
| CN105277129A (zh) | 一种动态非接触轨道轨距测量系统及其方法 | |
| CN107243897B (zh) | 一种工业机器人的标定系统及方法 | |
| CN105009012A (zh) | 用于无损检测的独立完整追踪方法及设备 | |
| CN201110756Y (zh) | 测量连续竖直挠度/位移的装置 | |
| CN113510708B (zh) | 一种基于双目视觉的接触式工业机器人自动标定系统 | |
| CN104236543A (zh) | 用于工业机器人空间位姿精度和轨迹测量的拉线式测量系统和测量方法 | |
| CN104236629A (zh) | 用于工业机器人空间定位精度和轨迹测量的拉线式测量系统和测量方法 | |
| CN110370271B (zh) | 工业串联机器人的关节传动比误差校准方法 | |
| CN104493808A (zh) | 运动部件空间位姿精度和轨迹拉线式测量系统和方法 | |
| CN206339207U (zh) | 一种轨迹准确度重复性测量仪 | |
| CN103822588A (zh) | 基于非接触式仿形法舱体截面周长测量装置及测量方法 | |
| CN205333008U (zh) | 一种连杆机构的结构参数辨识系统 | |
| CN205466311U (zh) | 一种基于末端非完整坐标信息的机器人标定系统 | |
| CN205497483U (zh) | 一种机器人的标定系统 | |
| CN206113861U (zh) | 一种测量自由曲面任意点处法向矢量的装置 | |
| CN204286388U (zh) | 一种关节臂式坐标测量机的自标定系统 | |
| Wu et al. | Research on vision-based robot planar motion measurement method | |
| CN102506741A (zh) | 高低温箱内被测件的三维变形测量装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| 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: 20160622 Termination date: 20171215 |
|
| CF01 | Termination of patent right due to non-payment of annual fee |