CN107009350B - 一种3-prs串并联机构等效质量的确定方法 - Google Patents

一种3-prs串并联机构等效质量的确定方法 Download PDF

Info

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
Application number
CN201710290164.6A
Other languages
English (en)
Other versions
CN107009350A (zh
Inventor
黄俊杰
张孟营
陈国强
黄存捍
闫勇刚
邓小玲
赵俊伟
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Henan University of Technology
Original Assignee
Henan University of Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Henan University of Technology filed Critical Henan University of Technology
Priority to CN201710290164.6A priority Critical patent/CN107009350B/zh
Publication of CN107009350A publication Critical patent/CN107009350A/zh
Application granted granted Critical
Publication of CN107009350B publication Critical patent/CN107009350B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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串并联机构等效质量的确定方法
技术领域
本发明涉及一种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串并联机构等效质量的确定方法，其特征在于，具体包含以下步骤：
S1：在静、动平台上建立固定和局部坐标系，并选取三根立柱（14、24、34）上滑块（16、26、36）移动的位移
Figure 390820DEST_PATH_IMAGE001
作为广义坐标值；
S2：用齐次坐标变换和正向运动学描述固定坐标系下滑块，连杆及动平台
Figure 794491DEST_PATH_IMAGE004
的动能和势能，得到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）在不同位置时机构的等效质量。
进一步，在步骤S2中，实时计算并检测滑块（16、26、36）处于不同位置时动平台
Figure 140022DEST_PATH_IMAGE004
末端位姿在工作空间内部。
进一步，3-PRS串并联机构的广义速度、加速度由立柱（14、24、34）上的光栅测距尺（19、29、39）测得滑块（16、26、36）在单位时间内的位移对时间分别求一次和两次导数计算得到。
进一步，三个滑块（16、26、36）共要移动不少于
Figure 493643DEST_PATH_IMAGE005
段的不同位移。
进一步，三个滑块（16、26、36）每次移动的位移长度间不能成比例或相等。
更进一步，对于个未知参数的方程，若滑块（16、26、36）共移动
Figure 241467DEST_PATH_IMAGE005
段不同位移，对应方程有唯一确定的解；若移动的位移大于
Figure 441504DEST_PATH_IMAGE005
段，采用最小二乘法确定方程最优解。
再进一步，通过所建立的拉格朗日方程，求出
Figure 434868DEST_PATH_IMAGE005
个未知参数，把等效质量
Figure 251514DEST_PATH_IMAGE006
、
Figure 988526DEST_PATH_IMAGE007
、、
Figure 253340DEST_PATH_IMAGE009
、
Figure 26124DEST_PATH_IMAGE010
、
Figure 301248DEST_PATH_IMAGE011
表达出来。
本发明具有的有益效果是：
（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简化为三角形
Figure 475877DEST_PATH_IMAGE012
、固定平台5简化为三角形
Figure 92934DEST_PATH_IMAGE013
、三根立柱（14、24、34）简化为
Figure 821856DEST_PATH_IMAGE014
、三根连杆（17、27、37）简化为，三个滑块（16、26、36）及三个圆柱铰（15、25、35）都简化为
Figure 460965DEST_PATH_IMAGE016
。三角形
Figure 232612DEST_PATH_IMAGE013
和三角形
Figure 714408DEST_PATH_IMAGE012
的外接圆半径分别为
Figure 377340DEST_PATH_IMAGE017
和,
Figure 203530DEST_PATH_IMAGE019
为三个滑块（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）连接，与动平台
Figure 172623DEST_PATH_IMAGE020
通过球副与三根连杆（17、27、37）相连接，固定平台和动平台
Figure 596969DEST_PATH_IMAGE020
均为等边三角形。
分别在固定平台5和动平台4上建立固定坐标系
Figure 992309DEST_PATH_IMAGE021
和局部坐标系，其中原点
Figure 673006DEST_PATH_IMAGE023
在
Figure 265661DEST_PATH_IMAGE024
中点处，轴与
Figure 493697DEST_PATH_IMAGE026
重合并指向
Figure 302122DEST_PATH_IMAGE027
，轴与
Figure 204536DEST_PATH_IMAGE029
重合并指向
Figure 635518DEST_PATH_IMAGE030
；原点
Figure 732787DEST_PATH_IMAGE031
在
Figure 34455DEST_PATH_IMAGE012
中心，
Figure 676920DEST_PATH_IMAGE032
轴与
Figure 595197DEST_PATH_IMAGE033
重合并指向
Figure 964999DEST_PATH_IMAGE034
，
Figure 386753DEST_PATH_IMAGE035
轴平行于并指向。其中
Figure 277720DEST_PATH_IMAGE038
分别是
Figure 819560DEST_PATH_IMAGE039
的长度及其与立柱（14、24、34）的夹角。
由于3-PRS串并联机构结构对称性，故三个滑块（16、26、36）的质量
Figure 318675DEST_PATH_IMAGE040
，三根连杆（17、27、37）的质量，动平台4绕质心的转动惯量（其中
Figure 804648DEST_PATH_IMAGE043
）。
动平台4的姿态运动规律由三个所述滑块（16、26、36）的所述滑块高度
Figure 943505DEST_PATH_IMAGE044
的运动规律确定。为了在机器人动力学特性分析及优化设计方面有进一步的研究，本发明提供了一种3-PRS串并联机构等效质量的确定方法，其过程描述如下：
S1：在静、动平台上建立固定和局部坐标系，并选取三根立柱上滑块（16、26、36）移动的位移
Figure 58092DEST_PATH_IMAGE045
作为广义坐标值；
S2：用齐次坐标变换和正向运动学描述固定坐标系下滑块
Figure 838966DEST_PATH_IMAGE002
，连杆
Figure 824239DEST_PATH_IMAGE003
及动平台
Figure 665156DEST_PATH_IMAGE004
的动能和势能，得到3-PRS串并联机构总的动能和势能；
S3：设定伺服电机工作于转矩模式下，计算作用在立柱中滚珠丝杠的轴向力，进一步用虚功原理求解机构作用在滑块的***广义力；
S4：计算广义速度和广义加速度，构建3-PRS串并联机构的拉格朗日方程，求出3-PRS串并联机构中的滑块（16、26、36）质量、连杆（17、27、37）质量、动平台4转动惯量等不变的未知参量，确定移动滑块（16、26、36）在不同位置时机构的等效质量。
在步骤S2中，实时计算并检测滑块处于不同位置时的动平台
Figure 516307DEST_PATH_IMAGE046
末端位姿在工作空间内部。
3-PRS串并联机构的广义速度、加速度由立柱（14、24、34）上的光栅测距尺（19、29、39）测得滑块（16、26、36）在单位时间内的位移对时间分别求一次和两次导数计算得到。
三个滑块（16、26、36）共要移动不少于
Figure 100872DEST_PATH_IMAGE005
段的不同位移。
三个滑块（16、26、36）每次移动的位移长度间不能成比例或相等。
对于个未知参数的方程，若滑块共移动段不同位移，对应方程有唯一确定的解；若移动的位移大于段，采用最小二乘法确定方程最优解。
通过所建立的拉格朗日方程，求出个未知参数，把等效质量
Figure 609345DEST_PATH_IMAGE006
、
Figure 792064DEST_PATH_IMAGE007
、、
Figure 763748DEST_PATH_IMAGE009
、
Figure 843700DEST_PATH_IMAGE047
、
Figure 931742DEST_PATH_IMAGE011
表达出来。
确定所构建的拉格朗日方程中未知参数是求解所述等效质量的关键，下面以一个简化的实施例子来进行描述。
建立在静坐标系下3-PRS串并联机构中各个运动构件的动能和势能。
滑块
Figure 709260DEST_PATH_IMAGE049
质量为
Figure 112559DEST_PATH_IMAGE050
均质，且质心位于竖直立柱上，移动位移为
Figure 902660DEST_PATH_IMAGE051
，其速度和加速度分别为
Figure 188148DEST_PATH_IMAGE052
和
Figure 925160DEST_PATH_IMAGE053
。
构件
Figure 730436DEST_PATH_IMAGE054
质量为
Figure 691439DEST_PATH_IMAGE055
均质，且质心坐标为
Figure 667485DEST_PATH_IMAGE056
，绕质心的转动惯量为
Figure 739347DEST_PATH_IMAGE057
，有：
Figure 913976DEST_PATH_IMAGE058
Figure 41287DEST_PATH_IMAGE059
Figure 770209DEST_PATH_IMAGE060
。
动平台
Figure 380182DEST_PATH_IMAGE061
质量为
Figure 409317DEST_PATH_IMAGE062
，质心为
Figure 915385DEST_PATH_IMAGE063
，相对于静坐标系
Figure 662761DEST_PATH_IMAGE021
的速度和角速度分别为
Figure 827157DEST_PATH_IMAGE064
和
Figure 179641DEST_PATH_IMAGE065
，绕质心的惯量矩阵为，实际惯量矩阵中其他量级比主对角线上的小很多，故令
Figure 622441DEST_PATH_IMAGE067
。
动平台上点
Figure 43058DEST_PATH_IMAGE068
在动坐标系
Figure 46786DEST_PATH_IMAGE069
上的坐标为
Figure 675083DEST_PATH_IMAGE070
，质心
Figure 600313DEST_PATH_IMAGE071
在坐标系下坐标为
Figure 214014DEST_PATH_IMAGE073
，据
Figure 29523DEST_PATH_IMAGE068
点在三条支链中的机构尺寸表达和转换矩阵表达相等，可得到下列式子：
Figure 442050DEST_PATH_IMAGE074
Figure 486361DEST_PATH_IMAGE075
Figure 199102DEST_PATH_IMAGE076
。
取
Figure 654354DEST_PATH_IMAGE013
为零势能面，重力加速度为
Figure 85335DEST_PATH_IMAGE077
，各个连接部分的摩擦力不计。
则整个机构的动能
Figure 182604DEST_PATH_IMAGE078
和势能
Figure 999119DEST_PATH_IMAGE079
可表示为：
Figure 625273DEST_PATH_IMAGE080
（5）
Figure 543550DEST_PATH_IMAGE081
。
构建机构的拉格朗日方程：
Figure 178931DEST_PATH_IMAGE082
Figure 335106DEST_PATH_IMAGE083
为***的广义力，为广义坐标值，
Figure 554046DEST_PATH_IMAGE085
为相应广义坐标的速度。
展开后的拉格朗日方程可表达为：
Figure 727538DEST_PATH_IMAGE086
。
将伺服电机（11、21、31）设置在转矩模式下，由伺服电机（11、21、31）输出的转矩
Figure 269378DEST_PATH_IMAGE078
已知，通过联轴器（12、22、32）的连接，将转矩换算为滚珠丝杠（13、23、33）上的轴向力，由以下式子可求得滚珠丝杠（13、23、33）的轴向力
Figure 864624DEST_PATH_IMAGE087
其中：
Figure 841808DEST_PATH_IMAGE088
——轴向负载，
Figure 753001DEST_PATH_IMAGE089
——丝杠的轴向力，
Figure 891858DEST_PATH_IMAGE090
——导向件的综合摩擦系数，
Figure 6445DEST_PATH_IMAGE091
——丝杠导程，
Figure 787319DEST_PATH_IMAGE092
——进给丝杠的效率，
Figure 303751DEST_PATH_IMAGE093
。
进一步运用虚功原理，求得3-PRS串并联机构的***广义力。
在步骤S2中，须计算动平台
Figure 895400DEST_PATH_IMAGE046
的末端位姿，即在已知滑块位移，求解末端的位姿为运动学正解。由于3-PRS串并联机构的正解方程可化简为一元多次方程，此方程的解存在多组解，故当滑块移动不同位移时要实时计算并检测3-PRS串并联机构的末端位姿的解是否存在及合理性，要求滑块处于不同位置时动平台
Figure 497283DEST_PATH_IMAGE061
末端位姿在工作空间内部。
3-PRS串并联机构的广义速度、加速度由立柱（14、24、34）上的光栅测距尺（19、29、39）测得滑块（16、26、36）在单位时间内的位移对时间分别求一次和两次导数计算得到，以单个支链
Figure 81848DEST_PATH_IMAGE094
进行说明。
滑块16在立柱上从起始点
Figure 921628DEST_PATH_IMAGE095
滑动到所用的时间
Figure 6313DEST_PATH_IMAGE097
，距离为
Figure 394569DEST_PATH_IMAGE098
（由光栅测距尺测得），速度为；从
Figure 271576DEST_PATH_IMAGE100
滑动到
Figure 848050DEST_PATH_IMAGE101
所用的时间
Figure 525151DEST_PATH_IMAGE102
，距离为
Figure 73944DEST_PATH_IMAGE103
（由光栅测距尺测得），速度为；则
Figure 491335DEST_PATH_IMAGE105
和
Figure 424656DEST_PATH_IMAGE106
位移段有：
Figure 624694DEST_PATH_IMAGE107
；
Figure 664063DEST_PATH_IMAGE108
。
三个滑块（16、26、36）共要移动不少于段的不同位移。
构建的拉格朗日方程中有
Figure 686562DEST_PATH_IMAGE005
个未知参数，要求解这些未知参数，三个滑块至少共要移动
Figure 741106DEST_PATH_IMAGE005
段位移；要使这些方程的系数不存在线性相关，尽可能三个滑块每次移动的位移长度之间不能成比例或相等。
对于
Figure 436530DEST_PATH_IMAGE109
个未知参数的方程，若滑块共移动
Figure 678155DEST_PATH_IMAGE109
段不同位移，对应方程有唯一确定的解；若移动的位移大于
Figure 500749DEST_PATH_IMAGE109
段，采用最小二乘法确定方程最优解。
作为一种数学优化技术的最小二乘法求解过程为：
将方程写成矩阵形式：
Figure 409799DEST_PATH_IMAGE110
其中：
Figure 10544DEST_PATH_IMAGE111
为
Figure 5045DEST_PATH_IMAGE112
的矩阵，
Figure 880597DEST_PATH_IMAGE113
为
Figure 378575DEST_PATH_IMAGE114
的列向量，
Figure 665069DEST_PATH_IMAGE115
为的列向量，方程的个数大于未知数的个数即
Figure 826108DEST_PATH_IMAGE117
，正常该方程无解；在数值领域，计算
Figure 178592DEST_PATH_IMAGE118
解出最优解
Figure 386720DEST_PATH_IMAGE113
。
通过所建立的拉格朗日方程，求出
Figure 106545DEST_PATH_IMAGE109
个未知参数，把等效质量
Figure 792742DEST_PATH_IMAGE006
、
Figure 530890DEST_PATH_IMAGE007
、、、
Figure 856195DEST_PATH_IMAGE047
、
Figure 963698DEST_PATH_IMAGE011
表达出来。即
Figure 248048DEST_PATH_IMAGE119
Figure 926154DEST_PATH_IMAGE120
Figure 485312DEST_PATH_IMAGE121
Figure 666894DEST_PATH_IMAGE122
Figure 653305DEST_PATH_IMAGE123
上述给出的求解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段，采用最小二乘法确定拉格朗日方程的最优解。
7.根据权利要求4中的任一要求所述的一种3-PRS串并联机构等效质量的确定方法，其特征在于：通过所建立的拉格朗日方程，求出n个未知参数，把等效质量
Figure FDA0002255296310000023
表达出来，其中：
Figure FDA0002255296310000022
Figure FDA0002255296310000031
Figure FDA0002255296310000032
Figure FDA0002255296310000033
Figure FDA0002255296310000034
其中，
Figure FDA0002255296310000035
表示3-PRS串并联机构的等效质量；mc1，mc2，mc3分别表示三个滑块的质量；mg1，mg2，mg3分别表示三根连杆的质量；l1、l2、l3、θ1、θ2、θ3分别表示三根连杆的长度及其与三根立柱的夹角；H1、H2、H3分别表示三个滑块的移动位移；J1、J2、J3分别表示三根连杆绕质心的转动惯量；mp表示动平台P1P2P3的质量；oT表示动平台P1P2P3的质心，
Figure FDA0002255296310000036
分别表示质心oT在OXYZ坐标系下的坐标位置；Jx、Jy、Jz分别为惯量矩阵在主对角线上的值；α、β、γ分别为动平台相对静平台沿三个坐标轴旋转的欧拉角，
Figure FDA0002255296310000041
为偏微分的数学符号。
CN201710290164.6A 2017-04-28 2017-04-28 一种3-prs串并联机构等效质量的确定方法 Active CN107009350B (zh)

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 (10)

* Cited by examiner, † Cited by third party
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
US11059166B2 (en) 2018-11-14 2021-07-13 Battelle Energy Alliance, Llc Linear delta systems with additional degrees of freedom and related methods
US10906172B2 (en) 2018-11-14 2021-02-02 Battelle Energy Alliance, Llc Linear delta systems, hexapod systems, and related methods
CN110421545A (zh) * 2019-08-20 2019-11-08 四川建筑职业技术学院 一种锥形结构的并联式机械臂抓取装置
CN111096871A (zh) * 2020-02-03 2020-05-05 河南理工大学 一种踝关节康复机器人的尺寸参数确定方法
CN112677330A (zh) * 2020-12-28 2021-04-20 重庆力磊加气混凝土制品有限公司 一种混凝土加气砖加工开槽装置
CN114310844A (zh) * 2021-12-17 2022-04-12 中国计量科学研究院 一种用于精密作业的计量集成并联机器人装置
CN114654450B (zh) * 2022-04-08 2023-04-28 湖北工业大学 柔性并联微动机构尺度参数优化设计方法、***及机构

Family Cites Families (5)

* Cited by examiner, † Cited by third party
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 江西省机械科学研究所 一种五支链五自由度并联机床机构

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) 六自由度并联平台结构参数优化方法
TWI448969B (zh) Three - axis dynamic simulation platform system and its control method
CN106289708A (zh) 用于捕获轨迹风洞试验的运动机构的位姿标定方法
CN108638070A (zh) 基于动态平衡的机器人负载重力参数辨识方法
CN109634111B (zh) 一种高速重载机器人动态变形计算方法
CN113580148B (zh) 基于等效运动链的并联机器人运动学标定方法
CN110058523A (zh) 基于极大似然估计的scara机器人动力学参数辨识方法
CN104772755B (zh) 3-prs并联机构速度优化方法
CN110909438A (zh) 一种基于动力学模型的轻载关节型并联机器人控制方法
Wang et al. Interaction force measurement of parallel robots based on structure-integrated force sensors using interpretable linear neural networks
CN112925320B (zh) 一种基于质心模型的双足机器人步态能耗评估方法
Ren et al. Kinematics analysis and scale synthesis of 3UPU parallel mechanism
Zhang et al. Research on position analysis of a new partly-DOF parallel stable platform
Wang et al. Design and Analysis of Simplified Parallel Manipulator for High-span Working Condition
CN112461491B (zh) 基于匀加速运动的捕获轨迹(cts)试验速度控制方法
Chen et al. Tension Characteristics of Cable-Driven System Based on ALE Formulation
Chen Error Modeling Analysis of Parallel Robot Based on Improved Fish Swarm Algorithm
Huang et al. Kinematics Analysis and Verification of Delta Parallel Robot
Yang et al. A 6-PTRT Parallel Robot using Parallel Guide Wires
Chen et al. Dynamic Analysis on Flexible Cable-driven Parallel Mechanism
Kolláth et al. Positioning accuracy of nonconventional production machines
Su Research on modular implementation method of six-degree-of-freedom robotic arm
Li et al. Collision-free Trajectory Planning for Cable-driven Robot in Dynamic Environment

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