CN107009350B - 一种3-prs串并联机构等效质量的确定方法 - Google Patents
一种3-prs串并联机构等效质量的确定方法 Download PDFInfo
- Publication number
- CN107009350B CN107009350B CN201710290164.6A CN201710290164A CN107009350B CN 107009350 B CN107009350 B CN 107009350B CN 201710290164 A CN201710290164 A CN 201710290164A CN 107009350 B CN107009350 B CN 107009350B
- Authority
- CN
- China
- Prior art keywords
- parallel mechanism
- mass
- equivalent mass
- prs series
- prs
- 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.)
- Active
Links
- 230000007246 mechanism Effects 0.000 title claims abstract description 66
- 238000000034 method Methods 0.000 title claims abstract description 37
- 230000001133 acceleration Effects 0.000 claims abstract description 16
- 238000005381 potential energy Methods 0.000 claims abstract description 8
- 238000013461 design Methods 0.000 claims abstract description 7
- 230000003068 static effect Effects 0.000 claims abstract description 7
- 238000006073 displacement reaction Methods 0.000 claims description 31
- 238000004364 calculation method Methods 0.000 claims description 6
- 239000011159 matrix material Substances 0.000 claims description 6
- 230000009466 transformation Effects 0.000 claims description 4
- 230000004069 differentiation Effects 0.000 claims 1
- 238000005457 optimization Methods 0.000 abstract description 7
- 230000008878 coupling Effects 0.000 description 5
- 238000010168 coupling process Methods 0.000 description 5
- 238000005859 coupling reaction Methods 0.000 description 5
- 238000005259 measurement Methods 0.000 description 5
- 230000008901 benefit Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 230000008569 process Effects 0.000 description 4
- 230000009286 beneficial effect Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000009826 distribution Methods 0.000 description 1
- 239000012636 effector Substances 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000009776 industrial production Methods 0.000 description 1
- 230000008520 organization Effects 0.000 description 1
- 238000005182 potential energy surface Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
Images
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
-
- 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/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种3‑PRS串并联机构等效质量的确定方法,其核心为设定伺服电机工作在转矩模式下,将已知的伺服电机转矩换算为滚珠丝杠的轴向力及立柱上滑块的作用力,采用几何法求解得到整个3‑PRS串并联机构的系统广义力;随后分别在静平台和动平台上建立固定坐标系和局部坐标系,计算系统各个构件的动能、势能从而建立整个机构的拉格朗日方程;通过机构的测距光栅尺计算出方程中广义速度、加速度等若干参数,进而求出3‑PRS串并联机构的等效质量。本发明对机器人结构设计和优化、路径规划和控制系统优化提供了技术指导。
Description
技术领域
本发明涉及一种3-PRS串并联机构等效质量的确定方法,属于机器人动力学领域。
背景技术
并联机器人作为一类机器人,具有精度高、刚度大、速度快和承载能力强等优点。六自由度Stewart 型并联机器人已经得到相当充分的研究,已在工程中广泛应用。少自由度并联机器人如图1所示的3-PRS(3—自由度数目,P—移动副,R—转动副,S—球面副)串并联机构具有结构简单、控制容易、成本相对较低等并能满足特殊场合的要求,因此具有广阔的应用前景。
等效质量是并联机器人动态性能的一个重要指标,是研究串并联机器人动力学特性的基础和主要手段。串并联机构的分支间相互耦合,每个分支的等效质量/等效转动惯量都随着运动平台的末端位姿、驱动力、不同位置的速度和加速度变化而变化。而3-PRS串并联机构的等效质量随运动状态变化非常显著,末端位姿对等效质量和驱动力的影响很大,等效质量对驱动力的变化非常敏感,在3-PRS串并联机构运动的过程中,末端位姿不断发生变化,等效质量也随着变化,确定不同位姿时的等效质量也变得尤为困难。
发明内容
本发明针对在分析串并联机构动力学特性时等效质量难以确定的问题,提供了一种3-PRS串并联机构等效质量的确定方法。通过工作在转矩模式下的电机和立柱上的光栅尺计算出广义力和广义坐标下的速度和加速度,对所构建的拉格朗日方程求解,进而表述出不同位姿处的等效质量。本发明直观地反映了3-PRS串并联机构的驱动力、广义速度和加速度等参量间的相互关系,这对合理规划路径、优化结构和控制系统及有效节约能源提供技术指导,促进其在工业生产中的应用,具有重要的学术意义和实用价值。
通过对系统广义力的求解和调节三个滑块(16,26,36)的滑动,运用测距光栅尺(19,29,39)测得三个滑块((16,26,36))的位移,得到广义速度与广义加速度,有效的解决上述问题。
本发明采取的技术方案是这样实现的:
一种3-PRS串并联机构等效质量的确定方法,其特征在于,具体包含以下步骤:
S3:设定伺服电机(11、21、31)工作于转矩模式下,计算作用在立柱(14、24、34)中滚珠丝杠(13、23、33)的轴向力,进一步用虚功原理求解机构作用在滑块的系统广义力;
S4:计算广义速度和广义加速度,构建3-PRS串并联机构的拉格朗日方程,求出3-PRS串并联机构中的滑块(16、26、36)质量、连杆(17、27、37)质量、动平台4转动惯量等不变的未知参量,确定移动滑块(16、26、36)在不同位置时机构的等效质量。
进一步,3-PRS串并联机构的广义速度、加速度由立柱(14、24、34)上的光栅测距尺(19、29、39)测得滑块(16、26、36)在单位时间内的位移对时间分别求一次和两次导数计算得到。
进一步,三个滑块(16、26、36)每次移动的位移长度间不能成比例或相等。
本发明具有的有益效果是:
(1)本发明提供的等效质量确定方法直观反映了3-PRS串并联机构的动态特性,为路径规划、优化设计及控制提供技术指导。
(2)本发明技术方案的步骤S2中,计算动平台的动能和势能时,运用了正向运动学,而目前并联机器人的正向运动学已有成熟的计算方法,便于计算和应用。
(3)本发明技术方案中步骤S3中,广义力的确定方法容易操作,便于实现。
(4)本发明技术方案中步骤S4中,拉格朗日方程中的广义速度和广义加速度的求解方法通过测距光栅尺容易实现,适用性广。
(5)本发明的方法能用于其它类型串并联机构等效质量/等效转动惯量的确定,具有很强的通用性。
附图说明
图1是本发明3-PRS串并联机构结构示意图。
图2是本发明3-PRS串并联机构运动示意图。
图中:1、第一支链 2、第二支链 3、第三支链
4、动平台 5、固定平台
11、第一伺服电机 21、第二伺服电机 31、第三伺服电机
12、第一联轴器 22、第二联轴器 32、第三联轴器
13、第一滚珠丝杠 23、第二滚珠丝杠 33、第三滚珠丝杠
14、第一立柱 24、第二立柱 34、第三立柱
15、第一圆柱铰 25、第二圆柱铰 35、第三圆柱铰
16、第一滑块 26、第二滑块 36、第三滑块
17、第一连杆 27、第二连杆 37、第三连杆
18、第一球铰 28、第二球铰 38、第三球铰
19、第一测距光栅尺 29、第二测距光栅尺 39、第三测距光栅尺
具体实施方式
为使本发明的目的、技术方案和有益效果更加清楚,下面将通过实施方式对本发明作进一步的详细描述。
3-PRS串并联机构结构示意图如图1所示。系统由动平台4、固定平台5、三个伺服电机(11、21、31)、三个联轴器(12、22、32)、三个滚珠丝杠(13、23、33)、三根立柱(14、24、34)、三个圆柱铰(15、25、35)、三个滑块(16、26、36)、三根连杆(17、27、37)、三个球铰(18、28、38)、三条测距光栅尺(19、29、39)组成。其中滑块(16、26、36)在立柱(14、24、34)的竖直导轨上滑动,滑块(16、26、36)与连杆(17、27、37)通过圆柱铰(15、25、35)连接,连杆(17、27、37)与动平台4通过球铰(18、28、38)连接。
如图2,动平台4简化为三角形、固定平台5简化为三角形、三根立柱(14、24、34)简化为、三根连杆(17、27、37)简化为,三个滑块(16、26、36)及三个圆柱铰(15、25、35)都简化为。三角形和三角形的外接圆半径分别为和,为三个滑块(16、26、36)高度。
在3-PRS串并联机构运动示意图中,伺服电机(11、21、31)通过联轴器(12、22、32)与滚珠丝杠(13、23、33)连接,从而带动滑块(16、26、36)在三个立柱(14、24、34)的导轨上滑动,通过转动副使滑块(16、26、36)与连杆(17、27、37)连接,与动平台通过球副与三根连杆(17、27、37)相连接,固定平台和动平台均为等边三角形。
分别在固定平台5和动平台4上建立固定坐标系和局部坐标系,其中原点在中点处,轴与重合并指向,轴与重合并指向;原点在中心,轴与重合并指向,轴平行于并指向。其中分别是的长度及其与立柱(14、24、34)的夹角。
动平台4的姿态运动规律由三个所述滑块(16、26、36)的所述滑块高度的运动规律确定。为了在机器人动力学特性分析及优化设计方面有进一步的研究,本发明提供了一种3-PRS串并联机构等效质量的确定方法,其过程描述如下:
S3:设定伺服电机工作于转矩模式下,计算作用在立柱中滚珠丝杠的轴向力,进一步用虚功原理求解机构作用在滑块的系统广义力;
S4:计算广义速度和广义加速度,构建3-PRS串并联机构的拉格朗日方程,求出3-PRS串并联机构中的滑块(16、26、36)质量、连杆(17、27、37)质量、动平台4转动惯量等不变的未知参量,确定移动滑块(16、26、36)在不同位置时机构的等效质量。
3-PRS串并联机构的广义速度、加速度由立柱(14、24、34)上的光栅测距尺(19、29、39)测得滑块(16、26、36)在单位时间内的位移对时间分别求一次和两次导数计算得到。
三个滑块(16、26、36)每次移动的位移长度间不能成比例或相等。
对于个未知参数的方程,若滑块共移动段不同位移,对应方程有唯一确定的解;若移动的位移大于段,采用最小二乘法确定方程最优解。
确定所构建的拉格朗日方程中未知参数是求解所述等效质量的关键,下面以一个简化的实施例子来进行描述。
建立在静坐标系下3-PRS串并联机构中各个运动构件的动能和势能。
构建机构的拉格朗日方程:
展开后的拉格朗日方程可表达为:
将伺服电机(11、21、31)设置在转矩模式下,由伺服电机(11、21、31)输出的转矩已知,通过联轴器(12、22、32)的连接,将转矩换算为滚珠丝杠(13、23、33)上的轴向力,由以下式子可求得滚珠丝杠(13、23、33)的轴向力
进一步运用虚功原理,求得3-PRS串并联机构的系统广义力。
在步骤S2中,须计算动平台的末端位姿,即在已知滑块位移,求解末端的位姿为运动学正解。由于3-PRS串并联机构的正解方程可化简为一元多次方程,此方程的解存在多组解,故当滑块移动不同位移时要实时计算并检测3-PRS串并联机构的末端位姿的解是否存在及合理性,要求滑块处于不同位置时动平台末端位姿在工作空间内部。
3-PRS串并联机构的广义速度、加速度由立柱(14、24、34)上的光栅测距尺(19、29、39)测得滑块(16、26、36)在单位时间内的位移对时间分别求一次和两次导数计算得到,以单个支链进行说明。
三个滑块(16、26、36)共要移动不少于段的不同位移。
作为一种数学优化技术的最小二乘法求解过程为:
上述给出的求解3-PRS串并联机构等效质量的例子中,是在保证通用性的基础上做了简化处理。3-PRS并联机构有很多的变种,在应用的过程中,需要根据串并联机构的具体结构形式,改写公式(1)—(9),增加或删除相应的构建模型,如增加末端执行器(刀具)、增加电机、立柱和连杆数目等。
本发明的方法的特点是:
(1)本发明提供的等效质量计算方法得到了3-PRS串并联机构滑块移动过程中不同位置下的等效质量,直观反映了3-PRS串并联机构的动态性能,为路径规划及优化设计提供技术指导。
(2)本发明技术方案的步骤S2中,计算动平台的动能和势能时,运用了正向运动学,而目前并联机器人的正向运动学已有成熟的计算方法,便于计算和应用。
(3)本发明技术方案中步骤S3中,广义速度和广义加速度的求解方法通过测距光栅尺容易实现,适用性广。
(4)本发明技术方案中步骤S3中,广义力是通过设定伺服电机在转矩模式下计算得到,此方法容易操作,便于实现。
(5)本发明的方法可用于其它类型串并联机构等效质量/等效转动惯量的计算,具有很强的通用性。
本发明的应用,解决了3-PRS串并联机构路径规划和优化中驱动力的分配问题,有效地节约能源。特别有助于从串并联机构设计开始阶段做到路径规划和优化,降低成本,促进3-PRS串并联机构在工业、农业和服务业领域的广泛应用。而且本发明提供的方法也为其它类型并联机器人的等效质量/等效转动惯量研究提供了借鉴,具有良好的社会和经济效益。
以上所述的详细说明,只是针对本发明的较佳应用实例而已,仅仅是为方便技术人员能清楚理解,并非对本发明做任何形式上的限制,本领域的技术人员对本发明的技术内容做局部修改,等同变化或修饰,都落在本发明的保护范围之内。
Claims (7)
1.一种3-PRS串并联机构等效质量的确定方法,其特征在于,具体包含以下步骤:
S1:在静、动平台上建立固定和局部坐标系,并选取三根立柱上滑块移动的位移Hi(i=1,2,3)作为广义坐标值;
S2:用齐次坐标变换和正向运动学描述固定坐标系下滑块Ci(i=1,2,3),连杆CiPi(i=1,2,3)及动平台P1P2P3的动能和势能,得到3-PRS串并联机构总的动能和势能;
S3:设定伺服电机工作于转矩模式下,计算作用在立柱中滚珠丝杠的轴向力,进一步用虚功原理求解机构作用在滑块的系统广义力;
S4:计算广义速度和广义加速度,构建3-PRS串并联机构的拉格朗日方程,求出3-PRS串并联机构中不变的未知参量,3-PRS串并联机构中不变的未知参量包括滑块质量、连杆质量和动平台转动惯量,确定移动滑块在不同位置时机构的等效质量。
2.根据权利要求1所述的一种3-PRS串并联机构等效质量的确定方法,其特征在于:在步骤S2中,实时计算滑块处于不同位置时的动平台P1P2P3末端位姿,并确保计算得到的动平台P1P2P3的末端位姿处于工作空间内部。
3.根据权利要求1或2所述的一种3-PRS串并联机构等效质量的确定方法,其特征在于:3-PRS串并联机构的广义速度、加速度由立柱上的光栅测距尺测得滑块在单位时间内的位移对时间分别求一次和两次导数计算得到。
4.根据权利要求3所述的一种3-PRS串并联机构等效质量的确定方法,其特征在于:三个滑块共要移动不少于n段的不同位移,n≥3。
5.根据权利要求4所述的一种3-PRS串并联机构等效质量的确定方法,其特征在于:三个滑块每次移动的位移长度不能成比例。
6.根据权利要求4或5所述的一种3-PRS串并联机构等效质量的确定方法,其特征在于:对于n个未知参数的拉格朗日方程,若滑块共移动n段不同位移,拉格朗日方程有唯一确定的解;若移动的位移大于n段,采用最小二乘法确定拉格朗日方程的最优解。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710290164.6A CN107009350B (zh) | 2017-04-28 | 2017-04-28 | 一种3-prs串并联机构等效质量的确定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710290164.6A CN107009350B (zh) | 2017-04-28 | 2017-04-28 | 一种3-prs串并联机构等效质量的确定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107009350A CN107009350A (zh) | 2017-08-04 |
CN107009350B true CN107009350B (zh) | 2020-01-17 |
Family
ID=59447633
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710290164.6A Active CN107009350B (zh) | 2017-04-28 | 2017-04-28 | 一种3-prs串并联机构等效质量的确定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107009350B (zh) |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107497706B (zh) * | 2017-08-07 | 2023-11-07 | 华中农业大学 | 一种板栗分选装置和方法 |
CN110580361B (zh) * | 2018-06-07 | 2022-09-30 | 中国科学院沈阳自动化研究所 | 一种搅拌摩擦焊机器人立柱结构的拓扑优化设计方法 |
US10821599B2 (en) * | 2018-11-14 | 2020-11-03 | Battelle Energy Alliance, Llc | Dual linear delta assemblies, linear delta systems, and related methods |
US10906172B2 (en) | 2018-11-14 | 2021-02-02 | Battelle Energy Alliance, Llc | Linear delta systems, hexapod systems, and related methods |
US11059166B2 (en) | 2018-11-14 | 2021-07-13 | Battelle Energy Alliance, Llc | Linear delta systems with additional degrees of freedom and related methods |
CN109191988A (zh) * | 2018-11-16 | 2019-01-11 | 上海赢浩机电设备有限公司 | 3-prs+3-rrr型六自由度运动模拟器执行机构 |
CN110421545A (zh) * | 2019-08-20 | 2019-11-08 | 四川建筑职业技术学院 | 一种锥形结构的并联式机械臂抓取装置 |
CN111096871A (zh) * | 2020-02-03 | 2020-05-05 | 河南理工大学 | 一种踝关节康复机器人的尺寸参数确定方法 |
CN112677330A (zh) * | 2020-12-28 | 2021-04-20 | 重庆力磊加气混凝土制品有限公司 | 一种混凝土加气砖加工开槽装置 |
CN114310844B (zh) * | 2021-12-17 | 2024-08-09 | 中国计量科学研究院 | 一种用于精密作业的计量集成并联机器人装置 |
CN114654450B (zh) * | 2022-04-08 | 2023-04-28 | 湖北工业大学 | 柔性并联微动机构尺度参数优化设计方法、系统及机构 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS59127109A (ja) * | 1983-01-07 | 1984-07-21 | Omron Tateisi Electronics Co | 産業用ロボツトの等速動作方法 |
CN102490187B (zh) * | 2011-12-13 | 2013-12-25 | 天津大学 | 新型五自由度并联机械手 |
CN102615641B (zh) * | 2012-03-27 | 2014-05-21 | 天津大学 | 一种五自由度并联动力头 |
CN102935639B (zh) * | 2012-10-17 | 2015-04-08 | 燕山大学 | 一种三手爪3spr+3rps型串并联机器人 |
CN103465252A (zh) * | 2013-09-04 | 2013-12-25 | 江西省机械科学研究所 | 一种五支链五自由度并联机床机构 |
-
2017
- 2017-04-28 CN CN201710290164.6A patent/CN107009350B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN107009350A (zh) | 2017-08-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107009350B (zh) | 一种3-prs串并联机构等效质量的确定方法 | |
CN100453279C (zh) | 无奇异完全各向同性空间移动并联机构 | |
CN107336231B (zh) | 六自由度并联平台结构参数优化方法 | |
CN108582078A (zh) | 一种面向直接示教的机械臂零力控制方法 | |
TWI448969B (zh) | Three - axis dynamic simulation platform system and its control method | |
CN106289708A (zh) | 用于捕获轨迹风洞试验的运动机构的位姿标定方法 | |
CN106596087A (zh) | 一种新型可实现全组件摩擦辨识的装置和方法 | |
CN109634111B (zh) | 一种高速重载机器人动态变形计算方法 | |
CN113580148B (zh) | 基于等效运动链的并联机器人运动学标定方法 | |
CN110058523A (zh) | 基于极大似然估计的scara机器人动力学参数辨识方法 | |
CN104772755A (zh) | 3-prs并联机构速度优化方法 | |
CN110909438A (zh) | 一种基于动力学模型的轻载关节型并联机器人控制方法 | |
CN117001671A (zh) | 一种支链驱动并联机器人概念构型的空间姿态评价方法 | |
CN114895565B (zh) | 面向铣削工况下双转台五轴机床动力学特性实时预测方法 | |
Renawi et al. | ROS validation for non-holonomic differential robot modeling and control: Case study: Kobuki robot trajectory tracking controller | |
Wang et al. | Interaction force measurement of parallel robots based on structure-integrated force sensors using interpretable linear neural networks | |
Wu et al. | Counterweight optimization of an asymmetrical hybrid machine tool based on dynamic isotropy | |
CN112925320B (zh) | 一种基于质心模型的双足机器人步态能耗评估方法 | |
Ren et al. | Kinematics analysis and scale synthesis of 3UPU parallel mechanism | |
Xu et al. | A Novel Cable-Driven Joint Module for Space Manipulators: Design, Modeling, and Characterization | |
Wang et al. | Design and Analysis of Simplified Parallel Manipulator for High-span Working Condition | |
Zhang et al. | Research on position analysis of a new partly-DOF parallel stable platform | |
CN112461491B (zh) | 基于匀加速运动的捕获轨迹(cts)试验速度控制方法 | |
CN212683956U (zh) | 一种无牵连运动的1t2r并联机构 | |
Chen et al. | Tension Characteristics of Cable-Driven System Based on ALE Formulation |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |