CN106695762A - 六维气动力产生的高机动风洞试验末端位姿误差补偿法 - Google Patents
六维气动力产生的高机动风洞试验末端位姿误差补偿法 Download PDFInfo
- Publication number
- CN106695762A CN106695762A CN201611268383.6A CN201611268383A CN106695762A CN 106695762 A CN106695762 A CN 106695762A CN 201611268383 A CN201611268383 A CN 201611268383A CN 106695762 A CN106695762 A CN 106695762A
- Authority
- CN
- China
- Prior art keywords
- rod member
- wind tunnel
- aerodynamic force
- tunnel test
- test end
- 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/003—Programme-controlled manipulators having parallel kinematics
- B25J9/0033—Programme-controlled manipulators having parallel kinematics with kinematics chains having a prismatic joint at the base
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01M—TESTING STATIC OR DYNAMIC BALANCE OF MACHINES OR STRUCTURES; TESTING OF STRUCTURES OR APPARATUS, NOT OTHERWISE PROVIDED FOR
- G01M9/00—Aerodynamic testing; Arrangements in or on wind tunnels
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Fluid Mechanics (AREA)
- General Physics & Mathematics (AREA)
- Aerodynamic Tests, Hydrodynamic Tests, Wind Tunnels, And Water Tanks (AREA)
Abstract
一种六维气动力产生的高机动风洞试验末端位姿误差补偿法,其包括步骤:获得用于连接一动平台和一静平台的各个杆件在空间六维力作用下的变形量;获得该动平台在各个该杆件的变形量的影响下的位姿;根据该动平台的位姿,通过运动学逆解的方式获得位于该静平台上的各个滑块的位移量;以及根据各个该滑块的位移量,对各个该杆件引起的误差进行补偿,这样,能够有效地减少该6‑PSS并联机器人的末端执行器空间位姿的误差,以提高该6‑PSS并联机器人的运动的精确性。
Description
技术领域
本发明针对6‐PSS并联机器人位姿误差补偿,属于并联机器人领域,特别涉及六维气动力产生的高机动风洞试验末端位姿误差补偿法。
背景技术
目前并联机器人在模拟运动、飞船对接、汽车总装、数控加工、潜艇救援对接、强力挖掘机构、微动机构等不同场合都得到了广泛应用。近年来并联机器人在机器人领域已经成为了研究的热点,但并联机构相对较小的运动速度及工作空间限制了其应用范围,随着并联机器人相关研究的不断深入,各种具有较大工作空间及快速运动特性的并联机器人越来越受到青睐。并联机器人定位精度是其工作性能的重要指标,特别是自动装配、实施手术、集成电路加工等需要高定位精度的应用场合。本发明提供六维气动力产生的高机动风洞试验末端位姿误差补偿法,以减少机构末端执行器空间位姿误差。
发明内容
本发明的目的是提供一种能够减少6‐PSS并联机器人的末端执行器空间位姿误差的六维气动力产生的高机动风洞试验末端位姿误差补偿法。
为了达到上述目的,本发明提供六维气动力产生的高机动风洞试验末端位姿误差补偿法,其中该六维气动力产生的高机动风洞试验末端位姿误差补偿法包括步骤:
(a)获得用于连接一动平台和一静平台的各个杆件在空间六维力作用下的变形量;
(b)获得该动平台(在各个该杆件的变形量的影响下的位姿;
(c)根据该动平台的位姿,通过运动学逆解的方式获得位于该静平台上的各个滑块的位移量;
(d)根据各个该滑块的位移量,对各个该杆件引起的误差进行补偿。
作为对本发明的该六维气动力产生的高机动风洞试验末端位姿误差补偿法的进一步优选的实施例,用于连接该动平台和该静平台的该杆件的数量为六个。
作为对本发明的该六维气动力产生的高机动风洞试验末端位姿误差补偿法的进一步优选的实施例,各个该杆件均为二力杆。
作为对本发明的该六维气动力产生的高机动风洞试验末端位姿误差补偿法的进一步优选的实施例,各个该杆件和该动平台通过球铰进行连接,各个该杆件和该静平台通过球铰进行连接。
作为对本发明的该六维气动力产生的高机动风洞试验末端位姿误差补偿法的进一步优选的实施例,在该步骤(d)中,通过电机控制各个该滑块移动,以对各个该杆件引起的误差进行补偿。
本发明的该六维气动力产生的高机动风洞试验末端位姿误差补偿法的优势在于:
本发明的该六维气动力产生的高机动风洞试验末端位姿误差补偿法包括步骤:获得用于连接一动平台和一静平台的各个杆件在空间六维力作用下的变形量;获得该动平台在各个该杆件的变形量的影响下的位姿;根据该动平台的位姿,通过运动学逆解的方式获得位于该静平台上的各个滑块的位移量;以及根据各个该滑块的位移量,对各个该杆件引起的误差进行补偿,这样,能够有效地减少该6‐PSS并联机器人的末端执行器空间位姿的误差,以提高该6‐PSS并联机器人的运动的精确性。
通过建立杆件变形、动平台变形及滑块位移补偿量解析式,由六维力直接通过解析式求得误差补偿量,运算速度快,精度高,可实时进行误差补偿。
附图说明
为了获得本发明的上述和其他优点和特点,以下将参照附图中所示的本发明的具体实施例对以上概述的本发明进行更具体的说明。应理解的是,这些附图仅示出了本发明的典型实施例,因此不应被视为对本发明的范围的限制,通过使用附图,将对本发明进行更具体和更详细的说明和阐述。在附图中:
图1是本发明的涉及的6‐PSS并联机器人的结构简图。
图2是本发明的该六维气动力产生的高机动风洞试验末端位姿误差补偿法的流程图。
具体实施方式
以下描述用于揭露本发明以使本领域技术人员能够实现本发明。以下描述中的优选实施例只作为举例,本领域技术人员可以想到其他显而易见的变型。在以下描述中界定的本发明的基本原理可以应用于其他实施方案、变形方案、改进方案、等同方案以及没有背离本发明的精神和范围的其他技术方案。
如图1,该发明涉及的一种6-PSS并联机器人包括一个静平台10、一个动平台20以及多个与静平台连接的滑块40和用于连接该静平台10和该滑块40的杆件30。值得一提的是,该动平台20也是一个基座,以用于将该6-PSS并联机器人固定在预设位置。该静平台10和该动平台20采用上下结构,例如该静平台10位于该动平台20的上部。优选地,该静平台10和各个该杆件30之间采用球铰连接的方式连接在一起,该动平台20上的各个滑块40和各个该杆件30之间也采用球铰连接的方式连接在一起。更优选地,该杆件30和滑块40的数量是六个,也就是说,该6-PSS并联机器人包括六个该杆件30,并且各个该杆件30相互间隔地设置在该静平台10和该动平台20之间,以通过各个滑块40在确保该静平台10上能够运动的同时,保证该静平台10的稳定性和精确度。
该6-PSS并联机器人在空间六维力作用下会发生一定的变形,变形引起的误差对该6-PSS并联机器人的运动精度有很大影响,本发明采用解析式计算该6-PSS并联机器人在空间六维力作用下产生的变形,并在补偿该动平台20的姿态误差时,可直接采用误差值补偿,即将实测得出与该动平台20相关的位姿误差结果取其负值作为补偿量,叠加到该动平台20的位姿的逆解变换计算中。
该动平台20所受六维力为F=(Fx,Fy,Fz,Mx,My,Mz),因六个该杆件30都为二力杆,该动平台20对六个该杆件30的作用力分别为Fi,i=1,2…6,对该动平台20受力分析如下:
可求得Fi,i=1,2…6
则第i个杆的形变式中li为杆件长度,E为材料弹性模量,I为抗拉压刚度由此可求得由于该杆件30的变形引起的该动平台20的位姿为X,Y,Z,α,β,γ,进而得到补偿量。
如图1所示,该静平台10的坐标O-XYZ是与机架固联的静坐标系,原点O位于该静平台10中心的垂直正下方,OZ轴铅垂向下,OY轴垂直于OXZ平面,且X轴平行于设置于该动平台20的各个滑块40的移动方向。
与该动平台20固联的坐标系O1-X1Y1Z1是以该动平台20下表面中心为原点的动坐标系,且原点O1与静坐标系O-XYZ原点O点重合。该动平台20沿着静坐标系Y轴正向移动的方向为动坐标系O1-X1Y1Z1的Y正向,该动平台20沿着静坐标系Z轴正向移动的方向为动坐标系O1-X1Y1Z1的Z轴正向,由右手螺旋定则确定O1-X1Y1Z1的X正向。动坐标系O1-X1Y1Z1中O1X1Z1平面绕动坐标系O1-X1Y1Z1的O1Y1旋转的角度为α。动坐标系O1-X1Y1Z1中O1X1Y1平面绕动坐标系O1-X1Y1Z1的O1Z1旋转的角度为β。动坐标系O1-X1Y1Z1中O1Y1Z1平面绕动坐标系O1-X1Y1Z1的O1X1旋转的角度为γ。
动坐标系中任意一向量b′与固定坐标系中的b向量之间关系为:
b=Tb′+b0
其中b0=[xm,ym,zm],即为动坐标系原点在固定坐标系中的位置矢量,变换矩阵T为
式中cα=cosα,sα=sinα,其他依此类推。
BDi=T*BD′i i=1,2…6
其中,BDi为动平台20上各球绞中心点在固定坐标系O-XYZ中坐标向量,BD′i为动平台20上各球绞中心点在动坐标系中O1-X1Y1Z1坐标向量,且分别记为:
BDi=(BDi,BDiy,BDiy,1)T
BD′i=(BD′ix,BD′iy,BD′iz,1)T
根据该6-PSS并联机器人的已知机构尺寸关系,可求出该动平台20上各球绞中心点在动坐标系O1-X1Y1Z1中坐标向量,再由式求出该动平台20上各球绞中心点在固定坐标系O-XYZ中坐标向量BD′i。
各个该杆件30靠近该静平台10端的球绞中心在固定坐标系O-XYZ中坐标向量为BUi,下式中BUiy,BUiz可根据该6-PSS并联机器人的已知机构关系求出,BUi记为:
BUi=(BUix,BUiy,BUiz)
根据该6-PSS并联机器人的已知结构矢量关系,可得
式中1为该杆件30的长度,由式可计算出滑块40Ui的运动距离为:
从而在通过用电机控制滑块40的位移来对误差进行补偿。
因此,如图2,本发明提供一种6‐PSS并联机器人在空间六维力作用下的误差补偿方法,其中该6‐PSS并联机器人在空间六维力作用下的误差补偿方法包括步骤:
(a)获得用于连接一静平台10和一动平台20的各个杆件30在空间六维力作用下的变形量;
(b)获得该动平台20在各个该杆件30的变形量的影响下的位姿;
(c)根据该动平台20的位姿,通过运动学逆解的方式获得位于该静平台10上的各个滑块40的位移量;
(d)根据各个该滑块40的位移量,对各个该杆件30引起的误差进行补偿。
以上对本发明的一个实施例进行了详细说明,但该内容仅为本发明的较佳实施例,不能被认为用于限定本发明的实施范围。凡依本发明申请范围所作的均等变化与改进等,均应仍归属于本发明的专利涵盖范围之内。
Claims (6)
1.一种六维气动力产生的高机动风洞试验末端位姿误差补偿法,其特征在于,6-PSS并联机器人在空间六维力作用下的误差补偿方法包括步骤:
(a)获得用于连接一动平台和一静平台的各个杆件在空间六维力作用下的变形量;
(b)获得该动平台在各个该杆件的变形量的影响下的位姿;
(c)根据该动平台的位姿,通过运动学逆解的方式获得位于该静平台的各个滑块的位移量;以及
(d)根据各个该滑块的位移量,对各个该杆件引起的误差进行补偿。
2.如权利要求1所述的一种六维气动力产生的高机动风洞试验末端位姿误差补偿法,其特征在于,用于连接该动平台和该静平台的该杆件的数量为六个。
3.如权利要求2所述的一种六维气动力产生的高机动风洞试验末端位姿误差补偿法,其特征在于,各个该杆件均为二力杆。
4.如权利要求1至3中的任意一个所述的一种六维气动力产生的高机动风洞试验末端位姿误差补偿法,其特征在于,各个该杆件和该动平台通过球铰进行连接,各个该杆件和该静平台通过球铰进行连接。
5.如权利要求1至3中的任意一个所述的一种六维气动力产生的高机动风洞试验末端位姿误差补偿法,其特征在于,在该步骤(d)中,通过电机控制各个该滑块移动,以对各个该杆件引起的误差进行补偿。
6.如权利要求4所述的一种六维气动力产生的高机动风洞试验末端位姿误差补偿法,其特征在于,在该步骤(d)中,通过电机控制各个该滑块移动,以对各个该杆件引起的误差进行补偿。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611268383.6A CN106695762A (zh) | 2016-12-31 | 2016-12-31 | 六维气动力产生的高机动风洞试验末端位姿误差补偿法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611268383.6A CN106695762A (zh) | 2016-12-31 | 2016-12-31 | 六维气动力产生的高机动风洞试验末端位姿误差补偿法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106695762A true CN106695762A (zh) | 2017-05-24 |
Family
ID=58905804
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611268383.6A Pending CN106695762A (zh) | 2016-12-31 | 2016-12-31 | 六维气动力产生的高机动风洞试验末端位姿误差补偿法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106695762A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108225712A (zh) * | 2017-12-29 | 2018-06-29 | 重庆大学 | 连续式跨声速风洞喷管段的半柔壁喉块与柔板协调控制方法 |
CN109732596A (zh) * | 2018-12-29 | 2019-05-10 | 南京工程学院 | 基于六维虚拟关节模型的工业机器人刚度辨识系统及其辨识方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20060254364A1 (en) * | 2005-05-16 | 2006-11-16 | Okuma Corporation | Calibration method for a parallel kinematic mechanism machine |
CN101116968A (zh) * | 2007-09-06 | 2008-02-06 | 上海交通大学 | 六维力传感器装配机械手姿态及力的控制方法 |
US20080039973A1 (en) * | 2006-08-09 | 2008-02-14 | Okuma Corporation | Method for controlling parallel kinematic mechanism machine and control apparatus therefor |
CN103309280A (zh) * | 2013-05-29 | 2013-09-18 | 清华大学 | 一种用于重型并联机床的双前馈控制系统 |
CN104858887A (zh) * | 2015-06-11 | 2015-08-26 | 安庆市华鑫重工股份有限公司 | 一种基于并联机构的六自由度自稳箱体抓斗 |
-
2016
- 2016-12-31 CN CN201611268383.6A patent/CN106695762A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20060254364A1 (en) * | 2005-05-16 | 2006-11-16 | Okuma Corporation | Calibration method for a parallel kinematic mechanism machine |
US20080039973A1 (en) * | 2006-08-09 | 2008-02-14 | Okuma Corporation | Method for controlling parallel kinematic mechanism machine and control apparatus therefor |
CN101116968A (zh) * | 2007-09-06 | 2008-02-06 | 上海交通大学 | 六维力传感器装配机械手姿态及力的控制方法 |
CN103309280A (zh) * | 2013-05-29 | 2013-09-18 | 清华大学 | 一种用于重型并联机床的双前馈控制系统 |
CN104858887A (zh) * | 2015-06-11 | 2015-08-26 | 安庆市华鑫重工股份有限公司 | 一种基于并联机构的六自由度自稳箱体抓斗 |
Non-Patent Citations (1)
Title |
---|
宋晓飞: "《六自由度并联机构误差分析和补偿》", 《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108225712A (zh) * | 2017-12-29 | 2018-06-29 | 重庆大学 | 连续式跨声速风洞喷管段的半柔壁喉块与柔板协调控制方法 |
CN108225712B (zh) * | 2017-12-29 | 2021-07-27 | 中国空气动力研究与发展中心设备设计及测试技术研究所 | 连续式跨声速风洞喷管段的半柔壁喉块与柔板控制方法 |
CN109732596A (zh) * | 2018-12-29 | 2019-05-10 | 南京工程学院 | 基于六维虚拟关节模型的工业机器人刚度辨识系统及其辨识方法 |
CN109732596B (zh) * | 2018-12-29 | 2021-06-15 | 南京工程学院 | 基于六维虚拟关节模型的工业机器人刚度辨识系统及其辨识方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110815180B (zh) | 六自由度并联机器人运动分析建模及快速求解方法 | |
Mazare et al. | Kinematic analysis and design of a 3-DOF translational parallel robot | |
CN111660307B (zh) | 一种机器人操作高辅精度的虚拟夹具控制方法及系统 | |
Yoon et al. | Stiffness analysis and design of a compact modified delta parallel mechanism | |
CN108621160B (zh) | 八索并联重力补偿系统的去冗余控制方法 | |
CN110253574B (zh) | 一种多任务机械臂位姿检测和误差补偿方法 | |
CN110152211A (zh) | 一种患者承载医用机械臂误差补偿系统及方法 | |
KR102312368B1 (ko) | 여자유도 로봇 제어 시스템, 방법, 및 상기 방법을 실행시키기 위한 컴퓨터 판독 가능한 프로그램을 기록한 기록 매체 | |
CN107817682A (zh) | 一种基于手眼相机的空间机械臂在轨标定方法及系统 | |
CN112936273B (zh) | 一种绳驱柔性机械臂的速度级运动学建模方法 | |
CN110450143B (zh) | 基于协作机器人的工件疲劳测试方法 | |
EP2404712A1 (en) | A dual arm robot and a method for controlling a dual arm robot | |
CN113146610A (zh) | 基于零空间避障的机械臂末端轨迹跟踪算法 | |
US20240042593A1 (en) | Hybrid master-slave mapping method, robotic arm system, and computer device | |
CN106695762A (zh) | 六维气动力产生的高机动风洞试验末端位姿误差补偿法 | |
Liu et al. | Mechanism design of a simplified 6-DOF 6-RUS parallel manipulator | |
CN111687835B (zh) | 水下机械手冗余机械臂逆优先级阻抗控制系统及控制方法 | |
English et al. | Measuring and reducing the Euclidean-space effects of robotic joint failures | |
CN111687832B (zh) | 空间机械手冗余机械臂逆优先级阻抗控制系统及控制方法 | |
Chen et al. | A 2T-2R, 4-DoF parallel manipulator | |
Bhutani et al. | Practical feasibility of a high-precision 3-UPU parallel mechanism | |
Liu et al. | Design and kinematics analysis of UPR-UPU-UR parallel vector propulsion mechanism for underwater vehicles | |
Staicu | Kinematics of a translation-rotation hybrid parallel robot | |
CN110134013A (zh) | 可对抗外部干扰的并联机械臂有限时间收敛运动控制方法 | |
CN113878583B (zh) | 一种水下机械臂控制方法及系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20170524 |