CN107336231A - 六自由度并联平台结构参数优化方法 - Google Patents
六自由度并联平台结构参数优化方法 Download PDFInfo
- Publication number
- CN107336231A CN107336231A CN201710383403.2A CN201710383403A CN107336231A CN 107336231 A CN107336231 A CN 107336231A CN 201710383403 A CN201710383403 A CN 201710383403A CN 107336231 A CN107336231 A CN 107336231A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- platform
- mtd
- parallel connection
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 53
- 238000005457 optimization Methods 0.000 claims abstract description 35
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 16
- 238000000342 Monte Carlo simulation Methods 0.000 claims abstract description 13
- 238000004458 analytical method Methods 0.000 claims abstract description 7
- 239000011159 matrix material Substances 0.000 claims description 35
- 238000013461 design Methods 0.000 claims description 8
- 238000004364 calculation method Methods 0.000 claims description 6
- 238000011156 evaluation Methods 0.000 claims description 4
- 230000000052 comparative effect Effects 0.000 claims description 3
- 238000005259 measurement Methods 0.000 claims description 3
- 238000010606 normalization Methods 0.000 claims description 3
- 238000004445 quantitative analysis Methods 0.000 claims description 3
- 230000017105 transposition Effects 0.000 claims description 3
- 238000005303 weighing Methods 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 3
- 241000208340 Araliaceae Species 0.000 description 2
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 description 2
- 235000003140 Panax quinquefolius Nutrition 0.000 description 2
- 235000008434 ginseng Nutrition 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 239000007787 solid Substances 0.000 description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 239000012636 effector Substances 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000001788 irregular Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
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/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
-
- 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/1615—Programme controls characterised by special kind of manipulator, e.g. planar, scara, gantry, cantilever, space, closed chain, passive/active joints and tendon driven manipulators
- B25J9/1623—Parallel manipulator, Stewart platform, links are attached to a common base and to a common platform, plate which is moved parallel to the base
-
- 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/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1661—Programme controls characterised by programming, planning systems for manipulators characterised by task planning, object-oriented languages
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Health & Medical Sciences (AREA)
- General Health & Medical Sciences (AREA)
- Orthopedic Medicine & Surgery (AREA)
- Prostheses (AREA)
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
Abstract
一种六自由度并联平台结构参数优化方法,基于多目标‑多约束算法,首先对并联平台的工作空间和灵巧度进行分析,以并联平台的工作空间大小和灵巧度指标为目标,分析平台参数优化的约束条件,最后,基于蒙特卡洛方法设计了参数优化方法的过程,并由此得到综合工作空间大小和灵巧度的六自由度并联平台最优结构参数。该方法可以简单、直观地描述六自由度并联平台工作空间的大小与灵巧度;明确了六自由度并联平台在结构参数选择与优化过程中约束条件,提出了面向六自由度并联平台参数优化的多目标‑多约束算法,可进行结构参数的优化;给出了使用蒙特卡洛方法结构参数优化过程,可使六自由度并联平台得到综合工作空间与灵巧度的最优结构参数。
Description
技术领域
本发明涉及一种六自由度并联平台结构参数优化方法,使用该方法,可使六自由度并联平台获得综合工作空间大小和灵巧度的最优结构参数,属于六自由度并联平台结构参数优化领域。
背景技术
六自由度并联平台是一种应用广泛的并联机构,由静平台、动平台以及铰接在静平台和动平台之间的变长杆件构成,能够实现动平台在空间中六自由度的运动,包括三自由度的平移和三自由度的旋转。并联平台能够应用于多个领域,如卫星定位、并联机床、运动模拟、医疗机械、制造设备等,具有广阔的前景。随着制造业水平和机器人技术的提高,对工作平台运动位姿的精度、快速响应能力等技术要求也不断提高。
并联平台的结构参数对其工作空间和灵巧度指标都有重要的影响,因而并联平台的结构参数选取的是否合理决定了其工作性能的优劣。并联平台的工作空间表示其动平台末端所能达到的位姿,工作空间越大,平台的运动范围越大。并联平台的灵巧度指标表示平台输入与输出速度的传递关系,以雅克比矩阵的条件数作为该指标,雅克比矩阵的条件数越小,平台的控制精度越高。因而,综合考虑并联平台的工作空间与灵巧度指标以进行六自由度并联平台的结构参数优化,对提高六自由度并联平台的运动性能具有重要的意义。
然而,对于并联平台的结构优化,现有的方法大多采用单目标优化方法,不能综合考虑并联平台的运动空间大小与灵巧度。例如,基于工作空间的目标优化往往导致平台的灵巧度较小,而基于灵巧度的目标优化得到的并联平台的工作空间较小。
目前,尚缺乏系统而具体的六自由度并联平台的结构参数优化方法。
发明内容
针对现有并联平台的结构优化技术存在的不能综合考虑并联平台的运动空间大小与灵巧度的不足,本发明提供一种基于多目标-多约束算法的六自由度并联平台结构参数优化方法,利用该方法可得到综合工作空间大小和灵巧度的六自由度并联平台最优结构参数。
本发明的六自由度并联平台结构参数优化方法,基于多目标-多约束算法,首先对并联平台的工作空间和灵巧度进行分析,以并联平台的工作空间大小和灵巧度指标为目标,分析平台参数优化的约束条件,最后,基于蒙特卡洛方法设计了参数优化方法的过程,并由此得到综合工作空间大小和灵巧度的六自由度并联平台最优结构参数。
具体包括以下步骤:
(1)确定六自由度并联平台动平台工作空间大小的评价函数;
(2)确定六自由度并联平台灵巧度的评价函数;
(3)构建由六自由度并联平台工作空间大小及灵巧度评价函数组成的结构参数优化目标函数,以使并联平台能够获得最大的工作空间和最优的灵巧度指标;
(4)确定六自由度并联平台结构参数优化的约束条件,包括奇异性约束、运动副铰链转角转动范围限制、变长杆件之间的干涉以及变长杆件行程的约束;
(5)建立面向结构参数优化的多目标-多约束算法;
(6)设计基于蒙特卡洛方法结构参数的优化过程,并由此得到六自由度并联平台的最优结构参数。
所述步骤(1)确定六自由度并联平台动平台工作空间大小的具体过程为:
并联平台的工作空间坐标系中,纵坐标为俯仰角α,底平面由横滚角β和偏转角γ构成;
首先,根据平台的结构初步估计工作空间中俯仰角α的运动范围,作为俯仰角α的搜索范围;然后用n个(n≥1)平行于底平面的平面将俯仰角α的运动范围平分;最后,在每个平行于底平面的平面内分别搜索满足奇异性约束、运动副铰链转角转动范围约束、变长杆件的干涉约束和变长杆件行程约束的点,所得到的点的集合的边界就是当并联平台的处于当前俯仰角时并联平台的运动范围;
假设每个位于运动范围内的点所占用区域的面积为单位1;分别计算每个平行于底面的平面上位于工作空间范围内的单位面积的个数,即为并联平台在这个俯仰角时运动范围的面积Vi,i=1,2,......n,n≥1;
将所有俯仰角平面(平行于底面(β-γ面)的平面)中包含于运动范围内的单位面积相加,即为并联平台整个工作空间的面积V:
上式即为并联平台工作空间大小的定量分析结果。
所述步骤(2)确定六自由度并联平台灵巧度的过程是;
灵巧度用来衡量并联平台处于某一位姿下的可控性,其值用雅克比矩阵的条件数来表示;矩阵的条件数等于矩阵的范数与矩阵逆的范数的乘积,采用Frobenius范数;并联平台雅克比矩阵的条件数为:
其中,tr()为矩阵的迹,C为雅克比矩阵的条件数,并作为衡量并联平台灵巧度的指标,该值越小,并联平台的灵巧度越高,控制性能越好;I为并联平台的雅克比,力雅克比JT为并联平台雅克比的转置;
并联平台的平均灵巧度是指其在工作空间内所有位姿下的灵巧度平均值,如下式所示:
其中,n为并联平台工作空间点的数目(使用并联平台工作空间的分析方法确定),Caver为平均灵巧度指标,Ci为并联平台处于工作空间内某一位姿时的灵巧度指标。
所述步骤(3)中构建结构参数优化的目标函数的过程是:
对平台工作空间指标和灵巧度指标进行归一化处理,如下式:
其中,C01和V01分别为并联平台灵巧度和工作空间的归一化指标,取值范围均为[0,1];Cavermax为所有灵巧度指标的最大值,Cavermin为所有灵巧度指标的最小值,Vmax为工作空间指标的最大值,Vmin为工作空间指标的最小值;Caver和V分别为并联平台的平均灵巧度和工作空间指标;
对已归一化的指标C01和V01建立目标函数,如下式:
ε=kcC01+kvV01,
其中,kc为灵巧度加权因子,0<kc<1,kv为工作空间加权因子,0<kv<1,且kc+kv=1;ε为结构参数选型指标,取值范围为[0,1],且该值越接近1,并联平台综合性能越好。
所述步骤(4)中的奇异性约束、运动副铰链转角转动范围限制、变长杆件的干涉以及变长杆件行程的约束分别为:
①奇异性约束:
当并联平台的雅克比矩阵J的行列式等于零(矩阵不满秩)时,并联平台处于奇异位置,无法对该平台进行有效的控制,因此必须满足雅克比矩阵J的行列式不等于零,即|J|≠0;
②运动副铰链转角转动范围限制:
在并联平台的静平台坐标系{O0}中,0n0i和0n1i分别为静平台和动平台平面的垂线向量,0li为沿杆件i方向的向量,通过下式计算出静平台和动平台杆件i的铰链转角的大小:
其中,θ0i为杆件i与动平台铰链转角大小,θ1i为杆件i与静平台铰链转角大小;θ0i和θ1i的大小满足铰链转角转动范围限制,其数学形式如下式:
θ0min<θ0i<θ0max,
θ1min<θ1i<θ1max;
③变长杆件之间的干涉:
对于任何平行于并联平台静平台的切面内,两杆件中心PL1和PL2的距离d,用下式表示:
其中PL1的坐标为(xPL1,yPL1,zPL1),PL2的坐标为(xPL2,yPL2,zPL2);
设两杆件中心点的最短距离为dmin,对于任何平行于并联平台的静平台的平面内,均满足关系d>dmin时,视为不发生干涉,参数dmin大于杆件直径;
对六个杆件分别两两比较,确定整个并联平台是否发生干涉。
④变长杆件行程的约束:
杆长行程的约束用以下数学表达式:
Lmin<Li<Lmax,i=1,2,...,6,
其中,Li为第i个杆件的杆长,Lmin为杆件的最小杆长,Lmax为杆件的最大杆长;已知平台位姿,经过逆运动学计算得到平台的杆长,杆件的最小杆长和最大杆长根据杆件驱动机构的最大行程确定。
所述步骤(5)建立的面向结构参数优化的多目标-多约束算法表达式为:
以上格式自上至下依次为:构建结构参数优化的目标函数,奇异性约束表达式,运动副铰链转角转动范围限制表达式,变长杆件之间的干涉表达式,杆长行程的约束表达式。
根据多目标-多约束算法,得到每一组结构参数下的选型指标ε,当ε为最大值时,其对应的结构参数即为选定的最优结构参数。
所述步骤(6)中基于蒙特卡洛方法设计的并联平台结构参数优化的步骤如下:
(1)确定并联平台待优化的结构参数静平台半径R0、动平台半径R1、静平台和动平台之间的高度H、两相邻铰链点的短边所对夹角alpha和两相邻铰链点的长边所对夹角beta的取值范围,如下式,并设定运行步数(步数>0):
(2)利用随机数法得到并联平台的结构参数R0,R1,H,alpha,beta,如下式:
其中,函数rand()为区间[0,1]内的随机浮点数;
(3)根据并联平台生成的结构参数,计算其正逆运动学及雅克比矩阵;
(4)基于多目标-多约束结构参数优化算法,计算选型指标ε;
(5)返回第二步并不断循环计算,直至完成设定的运行步数;
(6)比较结构参数选型指标ε,选取最大值,此时所得到的并联平台结构参数即为所求。
本发明具有以下特点:
(1)通过使用给出的六自由度并联平台工作空间体积与灵巧度的分析方法,可以简单、直观地描述六自由度并联平台工作空间的大小与灵巧度;
(2)明确了六自由度并联平台在结构参数选择与优化过程中约束条件,为六自由度并联平台最优结构参数的获取奠定了坚实的基础;
(3)提出了面向六自由度并联平台参数优化的多目标-多约束算法,借助此,可进行结构参数的优化;
(4)给出了使用蒙特卡洛方法结构参数优化过程,可使六自由度并联平台得到综合工作空间与灵巧度的最优结构参数。
附图说明
图1是六自由度并联平台模型图。
图2是六自由度并联平台简化结构示意图与坐标系。
图3是并联平台工作空间的坐标系。
图4是并联平台工作空间的一个切面示意图。
图5是并联平台工作空间体积计算中单位面积的定义示意图。
图6是运动副铰链的偏转角示意图。
图7是单驱动杆件与上下平台向量示意图
图8是并联平台干涉计算示意图。
图9是并联平台的杆件及其在某一切面上的截面示意图。
图10是基于蒙特卡洛法的并联平台结构参数优化流程图。
具体实施方式
以如图1所示的六自由度并联平台为例,对本发明六自由度并联平台结构参数优化方法作详细描述。
1.并联平台工作空间分析
图2给出了六自由度并联平台的简化结构示意图。静平台与变长杆件之间的铰链点依次用A1、A2、A3、A4、A5、A6表示,动平台与变长杆件之间的铰链点依次用B1、B2、B3、B4、B5、B6表示。在并联平台的静平台和动平台的质心原点处分别建立坐标系{O0}和坐标系{O1}。坐标系{O0}的原点O0为静平台的中心点,其x轴和y轴均位于静平台平面内,且x轴所在直线经过铰链点A1和A2连线的中点,其z轴指向重力的反方向;坐标系{O1}的原点O1为动平台的中心点,其x轴和y轴均位于动平台平面内,且x轴所在直线经过铰链点B1和B2连线的中点,其z轴方向垂直动平台平面向上。
由于并联平台的结构特点,使得其工作空间的复杂度远大于串联机构的复杂度。完整意义上并联平台的工作空间具有六个维度,包括动平台的位置和姿态,因此无法用三维立体图形直观的表示。本发明考虑并联平台的动平台在某一定点姿态控制,固定坐标系{O1}中动平台的位置坐标,使其工作空间减少至三个维度,实现三维图形直观表示工作空间。
图3中所示的坐标系为并联平台的工作空间坐标系,纵坐标为俯仰角(α),底平面由横滚角(β)和偏转角(γ)构成。
首先,根据平台的结构初步估计工作空间中俯仰角的运动范围(-δ≤α≤+δ),作为俯仰角(α)的搜索范围;然后,用n个(n≥1)平行于底面(β-γ面)的平面(如图3所示)将俯仰角的运动范围平分;最后,在每个平面内分别按照一定的步长(步长>0)搜索满足机构约束的点,所得到的点的集合的边界(如图4所示)即是当并联平台的处于当前俯仰角时并联平台的运动范围。
由于在每个平行于底面(β-γ面)的平面上,横滚角(β)和偏转角(γ)的运动范围是不规则的,因而,在搜索步长相同的情况下,为方便有效地表示工作空间的某个切面中工作范围的面积,假设每个位于运动范围内的点所占用区域的面积为单位1,如图5所示。
分别计算每个平行于底面(β-γ面)的平面上位于工作空间范围内的单位面积(点)的个数,即为并联平台在这个俯仰角时,运动范围的面积,即Vi,且(i=1,2,...,n)。
将所有俯仰角平面(平行于底面(β-γ面)的平面)中包含于运动范围内的单位面积相加,即为并联平台整个工作空间的面积V:
式(1)即为并联平台工作空间大小的定量分析结果。
2.并联平台的灵巧度分析
并联平台的雅克比矩阵表示其关节空间与末端操作空间的速度映射关系,当平台处于奇异位姿时,雅克比矩阵不满秩,且行列式等于0。处于奇异位姿的并联平台具有不可控自由度,其运动情况也将处于未知的状态;当平台处于距离奇异位姿较近的位姿时,平台驱动杆微小的位移改变会导致动平台较大的位姿变化,驱动杆运动误差被放大,平台的控制难度会增大,相应的控制精度则会降低。因此,在实际控制中,要避免并联平台处于奇异位姿或者距离奇异位姿较近位置。灵巧度可以用来衡量并联机构处于某一位姿下的可控性,其值可以用雅克比矩阵的条件数来表示。
矩阵的条件数等于矩阵的范数与矩阵逆的范数的乘积,本发明采用Frobenius范数。如式(2)所示,得到的并联平台雅克比矩阵的条件数为:
其中,tr()为矩阵的迹,C为雅克比矩阵的条件数,并作为衡量并联平台灵巧度的指标,该值越小,并联平台的灵巧度越高,控制性能越好,J为并联平台的雅克比,力雅克比JT为并联平台雅克比的转置;
并联平台的平均灵巧度是指其在工作空间内所有位姿下的灵巧度平均值,如式(3)所示。
其中,n为并联平台工作空间点的数目,Caver为平均灵巧度指标,Ci为并联平台处于工作空间内某一位姿时的灵巧度指标。
3.基于多目标-多约束的并联平台结构参数优化
在解决实际问题过程中,为了实现任务目标不仅要设计合适的机构,还要选择合适的结构参数,以使并联平台具有最优的运动性能。结构参数的选定是并联平台设计的基础,设计以最优性能为目标的结构参数优化方法,可以得到并联平台设计所需要的结构参数。现有的并联平台结构优化方法大都采用单目标优化方法,无法综合考虑其性能表现。因此,本发明以并联平台的工作空间和灵巧度为优化目标,设计了一种基于多目标-多约束的并联平台结构参数优化方法。
(1)结构参数优化的目标函数
并联平台的工作空间和灵巧度分别决定了其运动性能和控制性能。本发明给出的并联平台的结构参数优化方法实现了两个目标:并联平台尽可能获得最大工作空间,并联平台的灵巧度指标达到最优。为了实现这两个目标,本发明对并联平台的工作空间和灵巧度指标分别建立目标函数。
并联平台的工作空间和灵巧度指标量纲不同,需要对其进行归一化处理。对平台工作空间指标和灵巧度指标进行归一化处理的方法,如式(4)和式(5)所示。
其中,C01和V01分别为并联平台灵巧度和工作空间的归一化指标,取值范围均为[0,1]。Cavermax为所有灵巧度指标的最大值,Cavermin为灵巧度指标的最小值,Vmax为工作空间指标的最大值,Vmin为工作空间指标的最小值。Caver,V分别为并联平台的平均灵巧度和工作空间指标。
为了使设计的并联平台能够过获得最大的工作空间和最优的灵巧度指标,对已归一化的指标C01和V01建立目标函数,如式(6)所示。
ε=kcC01+kvV01 (6)
其中,kc为灵巧度加权因子,0<kc<1,kv为工作空间加权因子,0<kv<1,且kc+kv=1。ε为结构参数选型指标,其取值范围为[0,1],且该值越接近1,并联平台综合性能越好。
(2)结构参数优化的约束条件
并联平台受到四个因素的约束:奇异性约束、运动副铰链转角转动范围约束、变长杆件的干涉约束和变长杆件行程的约束。下面将分别介绍这四种约束条件。
A.奇异性约束
并联平台的奇异性意味着当平台处于某一特定位姿时,其自身的自由度可能会发生瞬间变化,此时并联平台暂时获得一个或多个不可控自由度。因此,在设计和应用并联平台时应当避免平台位姿处于奇异性位置,防止平台发生失控。
如式(7)所示,当并联平台的雅克比矩阵的行列式等于零(矩阵不满秩)时,平台处于奇异位置,已有的控制算法无法对该平台进行有效的控制。
|J|=0 (7)
B.运动副铰链转角转动范围限制
并联平台的六个变长杆件分别通过虎克铰链与动平台连接,球铰链与静平台连接。假设,平台运动过程中,运动副铰链会产生偏转角,如图6所示。驱动杆件同动、静平台之间无论采用哪种铰链连接,其转角的转动范围都是有限制的。
如图7,在坐标系{O0}中,0n0i和0n1i分别为静平台和动平台平面的垂线向量,0li为沿杆件i方向的向量,通过式(8)和式(9)可以计算出静平台和动平台杆件i的铰链转角的大小。
其中,θ0i为杆件i与动平台铰链转角大小,θ1i为杆件i与静平台铰链转角大小。θ0i和θ1i的大小满足铰链转角转动范围限制,其数学形式如式(10)和式(11)所示。
θ0min<θ0i<θ0max (10)
θ1min<θ1i<θ1max (11)
C.变长杆件之间的干涉
并联平台各个变长杆件之间的干涉会影响其工作空间。由于变长杆件模块经过铰链与上下两个平台相连接,因此杆件模块不会和上下平台产生干涉,只需要确定6个杆件之间的干涉情况。
本部分给出了判断两个杆件之间是否发生干涉的方法。如图9所示,在坐标系{O0}中,杆件L1与静平台和动平台的铰链点分别为AL1(xA1,yA1,zA1)和BL1(xB1,yB1,zB1),杆件L2与静平台和动平台的铰链点分别为AL2(xA2,yA2,zA2)和BL2(xB1,yB1,zB1)。
首先,计算两个杆件与动平台的铰链点z轴坐标的最小值H,如式(12)所示,杆件L1和L2的干涉只能发生在高度为(0~H)的区间中。
H=min(zB1,zB2) (12)
在0~H的范围内,以ΔH为步长,选取n(n=H/ΔH)个平行于静平台的平面,其表达式如式(13)所示。
根据两杆件与上下平台的铰链点AL1、BL1、AL2和BL2可以确定杆件L1和L2在坐标系{O0}中的直线方程,如式(14)和(15)所示。
如图9所示,在某一切面下,杆件L1和L2中心位置与该平面的交点为PL1和PL2。联立式(13)、(14)和(15),可以计算出PL1和PL2的坐标。
两杆件中心PL1和PL2的距离d,可以用式(16)表示。
其中PL1的坐标为(xPL1,yPL1,zPL1),PL2的坐标为(xPL2,yPL2,zPL2)。
设两杆件中心点的最短距离为dmin,对于选取的n个面,均满足关系d>dmin时,可以视为不发生干涉。dmin参数一般选择比杆件直径略大的值,这样可以确保两杆件之间不发生干涉。
本发明依据两个杆件判断干涉的方法,对六个杆件分别两两比较,确定整个并联平台是否发生干涉。
D.变长杆件行程的约束
并联平台位姿的变化通过控制杆件模块的长度变化来实现,每个杆件的长度都存在最大长度和最小长度的限制。因此,杆长行程的约束也是并联平台的约束条件之一,其数学表达形式如式(17)所示。
Lmin<Li<Lmax(i=1,2,...,6) (17)
其中,Li为第i个杆件的杆长,Lmin为杆件的最小杆长,Lmax为杆件的最大杆长。已知平台位姿,经过逆运动学计算得到平台的杆长,杆件的最小杆长和最大杆长根据杆件直线驱动缸的最大行程确定。
(3)多目标-多约束算法表达式
根据式(4)至(17),可以得到评价并联平台结构参数的多目标-多约束算法的表达式,如式(18)所示。
根据多目标-多约束算法,可以得到每一组结构参数下的选型指标ε,当ε为最大值时,其对应的结构参数即为选定的最优结构参数。
4.基于蒙特卡洛方法结构参数优化过程
对并联平台的结构参数寻优,是借助蒙特卡洛方法错误!未找到引用源。实现的。蒙特卡洛方法也被称为统计模拟方法,是一种采用随机抽样的方式解决数学问题的方法。在进行蒙特卡洛优化过程之前,需要确定待优化的结构参数,包括静平台半径R0,动平台半径R1,上下平台间(静平台和动平台之间)的高度H以及两相邻铰链点的短边所对夹角alpha和长边所对夹角beta。由于铰链点的两个夹角alpha和beta满足式(19)的关系,因此,需要优化的结构参数为R0,R1,H,alpha,确定了这四个参数,就可以确定并联平台的结构尺寸。
基于蒙特卡洛法设计的并联平台结构参数优化的主要步骤如下:
(1)确定并联平台待优化的结构参数R0、R1、H和alpha的取值范围,如式(20)所示,并设定程序运行步数。
(2)利用随机数法得到并联平台的结构参数R0,R1,H,alpha和beta,如式(21)所示。
其中,函数rand()为区间[0,1]内的随机浮点数。
(3)根据并联平台生成的结构参数,计算其正逆运动学及雅克比矩阵。
(4)基于提出的多目标-多约束结构参数优化算法,计算选型指标ε。
(5)返回第二步并不断循环计算,直至完成程序设定的运行步数。
(6)比较结构参数选型指标ε,选取最大值,此时所得到的并联平台结构参数即为所求。
由蒙特卡洛方法的结构参数优化的步骤可以得到其程序设计的流程图,如图10所示。
设定蒙特卡洛方法程序运行步数为5000,基于该方法得到并联平台的主要参数R0,R1,H,alpha如表1所示,当灵巧度指标Caver和工作空间V指标分别为13.8853和69003时,结构参数选型指标ε达到最优。
表1 优化后的平台结构参数
Claims (7)
1.一种六自由度并联平台结构参数优化方法,其特征是,包括以下步骤:
(1)确定六自由度并联平台动平台工作空间大小;
(2)确定六自由度并联平台灵巧度;
(3)构建由六自由度并联平台工作空间大小及灵巧度评价函数组成的结构参数优化目标函数;使并联平台能够获得最大的工作空间和最优的灵巧度指标;
(4)确定六自由度并联平台结构参数优化的约束条件,包括奇异性约束、运动副铰链转角转动范围限制、变长杆件之间的干涉以及变长杆件行程的约束;
(5)建立面向结构参数优化的多目标-多约束算法;
(6)设计基于蒙特卡洛方法结构参数的优化过程,并由此得到六自由度并联平台的结构参数优化方法。
2.根据权利要求1所述的六自由度并联平台结构参数优化方法,其特征是,所述步骤(1)确定六自由度并联平台动平台工作空间大小的具体过程为:
并联平台的工作空间坐标系中,纵坐标为俯仰角α,底平面由横滚角β和偏转角γ构成;
首先,根据平台的结构初步估计工作空间中俯仰角α的运动范围,作为俯仰角α的搜索范围;然后用n个平行于底平面的平面将俯仰角α的运动范围平分;最后,在每个平行于底平面的平面内分别搜索满足奇异性约束、运动副铰链转角转动范围约束、变长杆件的干涉约束和变长杆件行程约束的点,所得到的点的集合的边界就是当并联平台的处于当前俯仰角时并联平台的运动范围;
假设每个位于运动范围内的点所占用区域的面积为单位1;分别计算每个平行于底面的平面上位于工作空间范围内的单位面积的个数,即为并联平台在这个俯仰角时运动范围的面积Vi,i=1,2,......n,n≥1;
将所有俯仰角平面中包含于运动范围内的单位面积相加,即为并联平台整个工作空间的面积V:
<mrow>
<mi>V</mi>
<mo>=</mo>
<msubsup>
<mi>&Sigma;</mi>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mn>0</mn>
</mrow>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mi>n</mi>
</mrow>
</msubsup>
<msub>
<mi>V</mi>
<mi>i</mi>
</msub>
<mo>,</mo>
</mrow>
上式即为并联平台工作空间大小的定量分析结果。
3.根据权利要求1所述的六自由度并联平台结构参数优化方法,其特征是,所述步骤(2)确定六自由度并联平台灵巧度的过程是;
灵巧度用来衡量并联平台处于某一位姿下的可控性,其值用雅克比矩阵的条件数来表示;矩阵的条件数等于矩阵的范数与矩阵逆的范数的乘积,采用Frobenius范数;并联平台雅克比矩阵的条件数为:
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<mi>C</mi>
<mo>=</mo>
<mo>|</mo>
<mo>|</mo>
<mi>J</mi>
<mo>|</mo>
<mo>|</mo>
<mo>&CenterDot;</mo>
<mo>|</mo>
<mo>|</mo>
<msup>
<mi>J</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mo>|</mo>
<mo>|</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<msqrt>
<mrow>
<mi>t</mi>
<mi>r</mi>
<mrow>
<mo>(</mo>
<mrow>
<msup>
<mi>J</mi>
<mi>T</mi>
</msup>
<mo>&CenterDot;</mo>
<mi>J</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</msqrt>
<mo>&CenterDot;</mo>
<msqrt>
<mrow>
<mi>t</mi>
<mi>r</mi>
<mrow>
<mo>(</mo>
<mrow>
<msup>
<mi>J</mi>
<mrow>
<mo>-</mo>
<mi>T</mi>
</mrow>
</msup>
<mo>&CenterDot;</mo>
<msup>
<mi>J</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</msqrt>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>,</mo>
</mrow>
其中,tr()为矩阵的迹,C为雅克比矩阵的条件数,并作为衡量并联平台灵巧度的指标,该值越小,并联平台的灵巧度越高,控制性能越好;J为并联平台的雅克比,力雅克比JT为并联平台雅克比的转置;
并联平台的平均灵巧度是指其在工作空间内所有位姿下的灵巧度平均值,如下式所示:
<mrow>
<msub>
<mi>C</mi>
<mrow>
<mi>a</mi>
<mi>v</mi>
<mi>e</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<msubsup>
<mi>&Sigma;</mi>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mn>1</mn>
</mrow>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mi>n</mi>
</mrow>
</msubsup>
<msub>
<mi>C</mi>
<mi>i</mi>
</msub>
</mrow>
<mi>n</mi>
</mfrac>
<mo>,</mo>
</mrow>
其中,n为并联平台工作空间点的数目(使用并联平台工作空间的分析方法确定),Caver为平均灵巧度指标,Ci为并联平台处于工作空间内某一位姿时的灵巧度指标。
4.根据权利要求1所述的六自由度并联平台结构参数优化方法,其特征是,所述步骤(3)中构建结构参数优化的目标函数的过程是:
对平台工作空间指标和灵巧度指标进行归一化处理,如下式:
<mrow>
<msub>
<mi>V</mi>
<mn>01</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mi>V</mi>
<mo>-</mo>
<msub>
<mi>V</mi>
<mrow>
<mi>m</mi>
<mi>i</mi>
<mi>n</mi>
</mrow>
</msub>
</mrow>
<mrow>
<msub>
<mi>V</mi>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>V</mi>
<mrow>
<mi>m</mi>
<mi>i</mi>
<mi>n</mi>
</mrow>
</msub>
</mrow>
</mfrac>
<mo>,</mo>
</mrow>
<mrow>
<msub>
<mi>C</mi>
<mn>01</mn>
</msub>
<mo>=</mo>
<mn>1</mn>
<mo>-</mo>
<mfrac>
<mrow>
<msub>
<mi>C</mi>
<mrow>
<mi>a</mi>
<mi>v</mi>
<mi>e</mi>
<mi>r</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>C</mi>
<mrow>
<mi>a</mi>
<mi>v</mi>
<mi>e</mi>
<mi>r</mi>
<mi>m</mi>
<mi>i</mi>
<mi>n</mi>
</mrow>
</msub>
</mrow>
<mrow>
<msub>
<mi>C</mi>
<mrow>
<mi>a</mi>
<mi>v</mi>
<mi>e</mi>
<mi>r</mi>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>C</mi>
<mrow>
<mi>a</mi>
<mi>v</mi>
<mi>e</mi>
<mi>r</mi>
<mi>m</mi>
<mi>i</mi>
<mi>n</mi>
</mrow>
</msub>
</mrow>
</mfrac>
<mo>,</mo>
</mrow>
其中,C01和V01分别为并联平台灵巧度和工作空间的归一化指标,取值范围均为[0,1];Cavermax为所有灵巧度指标的最大值,Cavermin为所有灵巧度指标的最小值,Vmax为工作空间指标的最大值,Vmin为工作空间指标的最小值;Caver和V分别为并联平台的平均灵巧度和工作空间指标;
对已归一化的指标C01和V01建立目标函数,如下式:
ε=kcC01+kvV01,
其中,kc为灵巧度加权因子,0<kc<1,kv为工作空间加权因子,0<kv<1,且kc+kv=1;ε为结构参数选型指标,取值范围为[0,1],且该值越接近1,并联平台综合性能越好。
5.根据权利要求1所述的六自由度并联平台结构参数优化方法,其特征是,所述步骤(4)中的奇异性约束、运动副铰链转角转动范围限制、变长杆件的干涉以及变长杆件行程的约束分别为:
①奇异性约束:
当并联平台的雅克比矩阵J的行列式等于零时,并联平台处于奇异位置,无法对该平台进行有效的控制,因此必须满足雅克比矩阵J的行列式不等于零,即|J|≠0;
②运动副铰链转角转动范围限制:
在并联平台的静平台坐标系{O0}中,0n0i和0n1i分别为静平台和动平台平面的垂线向量,0li为沿杆件i方向的向量,通过式下式计算出静平台和动平台杆件i的铰链转角的大小:
<mrow>
<msub>
<mi>&theta;</mi>
<mrow>
<mn>0</mn>
<mi>i</mi>
</mrow>
</msub>
<mo>=</mo>
<mi>arccos</mi>
<mfrac>
<mrow>
<msub>
<mmultiscripts>
<mi>n</mi>
<mn>0</mn>
</mmultiscripts>
<mrow>
<mn>0</mn>
<mi>i</mi>
</mrow>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mmultiscripts>
<mi>l</mi>
<mn>0</mn>
</mmultiscripts>
<mi>i</mi>
</msub>
</mrow>
<mrow>
<mo>|</mo>
<msub>
<mmultiscripts>
<mi>l</mi>
<mn>0</mn>
</mmultiscripts>
<mi>i</mi>
</msub>
<mo>|</mo>
</mrow>
</mfrac>
<mo>,</mo>
</mrow>
<mrow>
<msub>
<mi>&theta;</mi>
<mrow>
<mn>1</mn>
<mi>i</mi>
</mrow>
</msub>
<mo>=</mo>
<mi>arccos</mi>
<mfrac>
<mrow>
<msub>
<mmultiscripts>
<mi>n</mi>
<mn>0</mn>
</mmultiscripts>
<mrow>
<mn>1</mn>
<mi>i</mi>
</mrow>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mmultiscripts>
<mi>l</mi>
<mn>0</mn>
</mmultiscripts>
<mi>i</mi>
</msub>
</mrow>
<mrow>
<mo>|</mo>
<msub>
<mmultiscripts>
<mi>l</mi>
<mn>0</mn>
</mmultiscripts>
<mi>i</mi>
</msub>
<mo>|</mo>
</mrow>
</mfrac>
<mo>,</mo>
</mrow>
其中,θ0i为杆件i与动平台铰链转角大小,θ1i为杆件i与静平台铰链转角大小;θ0i和θ1i的大小满足铰链转角转动范围限制,其数学形式如下式:
θ0min<θ0i<θ0max,
θ1min<θ1i<θ1max;
③变长杆件之间的干涉:
对于任何平行于并联平台静平台的切面内,两杆件中心PL1和PL2的距离d,用下式表示:
<mrow>
<mi>d</mi>
<mo>=</mo>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>P</mi>
<mi>L</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>P</mi>
<mi>L</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>P</mi>
<mi>L</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>P</mi>
<mi>L</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>z</mi>
<mrow>
<mi>P</mi>
<mi>L</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>z</mi>
<mrow>
<mi>P</mi>
<mi>L</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
<mo>,</mo>
</mrow>
2
其中PL1的坐标为(xPL1,yPL1,zPL1),PL2的坐标为(xPL2,yPL2,zPL2);
设两杆件中心点的最短距离为dmin,对于任何平行于并联平台的静平台的平面内,均满足关系d>dmin时,视为不发生干涉,参数dmin大于杆件直径;
对六个杆件分别两两比较,确定整个并联平台是否发生干涉。
④变长杆件行程的约束:
杆长行程的约束用以下数学表达式:
Lmin<Li<Lmax,i=1,2,...,6,
其中,Li为第i个杆件的杆长,Lmin为杆件的最小杆长,Lmax为杆件的最大杆长;已知平台位姿,经过逆运动学计算得到平台的杆长,杆件的最小杆长和最大杆长根据杆件驱动机构的最大行程确定。
6.根据权利要求1所述的六自由度并联平台结构参数优化方法,其特征是,所述步骤(5)建立的面向结构参数优化的多目标-多约束算法表达式为:
<mrow>
<mtable>
<mtr>
<mtd>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>M</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>&epsiv;</mi>
<mo>=</mo>
<mi>f</mi>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>C</mi>
<mn>01</mn>
</msub>
<mo>,</mo>
<msub>
<mi>V</mi>
<mn>01</mn>
</msub>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>s</mi>
<mi>u</mi>
<mi>b</mi>
<mi>j</mi>
<mi>e</mi>
<mi>c</mi>
<mi>t</mi>
<mi> </mi>
<mi>t</mi>
<mi>o</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>|</mo>
<mi>J</mi>
<mo>|</mo>
<mo>&NotEqual;</mo>
<mn>0</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow></mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>&theta;</mi>
<mrow>
<mn>0</mn>
<mi>min</mi>
</mrow>
</msub>
<mo><</mo>
<msub>
<mi>&theta;</mi>
<mrow>
<mn>0</mn>
<mi>i</mi>
</mrow>
</msub>
<mo><</mo>
<msub>
<mi>&theta;</mi>
<mrow>
<mn>0</mn>
<mi>max</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow></mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>&theta;</mi>
<mrow>
<mn>1</mn>
<mi>min</mi>
</mrow>
</msub>
<mo><</mo>
<msub>
<mi>&theta;</mi>
<mrow>
<mn>1</mn>
<mi>i</mi>
</mrow>
</msub>
<mo><</mo>
<msub>
<mi>&theta;</mi>
<mrow>
<mn>1</mn>
<mi>max</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow></mrow>
</mtd>
<mtd>
<mrow>
<mi>d</mi>
<mo>></mo>
<msub>
<mi>d</mi>
<mi>min</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow></mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>L</mi>
<mi>min</mi>
</msub>
<mo><</mo>
<msub>
<mi>L</mi>
<mi>i</mi>
</msub>
<mo><</mo>
<msub>
<mi>L</mi>
<mi>max</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>i</mi>
<mo>=</mo>
<mn>1</mn>
<mo>,</mo>
<mn>2</mn>
<mo>,</mo>
<mn>...</mn>
<mo>,</mo>
<mn>6</mn>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>,</mo>
</mrow>
以上格式自上至下依次为:构建结构参数优化的目标函数,奇异性约束表达式,运动副铰链转角转动范围限制表达式,变长杆件之间的干涉表达式,杆长行程的约束表达式。
7.根据权利要求1所述的六自由度并联平台结构参数优化方法,其特征是,所述步骤(6)中基于蒙特卡洛方法设计的并联平台结构参数优化的步骤如下:
(1)确定并联平台待优化的结构参数静平台半径R0、动平台半径R1、静平台和动平台之间的高度H、两相邻铰链点的短边所对夹角alpha和两相邻铰链点的长边所对夹角beta的取值范围,如下式,并设定运行步数:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mn>0.15</mn>
<mo>&le;</mo>
<msub>
<mi>R</mi>
<mn>0</mn>
</msub>
<mo>&le;</mo>
<mn>0.5</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mn>0.15</mn>
<mo>&le;</mo>
<msub>
<mi>R</mi>
<mn>1</mn>
</msub>
<mo>&le;</mo>
<mn>0.5</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mn>0.5</mn>
<mo>&le;</mo>
<mi>H</mi>
<mo>&le;</mo>
<mn>1.5</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mn>0</mn>
<mo>&le;</mo>
<mi>a</mi>
<mi>l</mi>
<mi>p</mi>
<mi>h</mi>
<mi>a</mi>
<mo>&le;</mo>
<mfrac>
<mi>&pi;</mi>
<mn>3</mn>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
</mrow>
<mrow>
<mi>a</mi>
<mi>l</mi>
<mi>p</mi>
<mi>h</mi>
<mi>a</mi>
<mo>+</mo>
<mi>b</mi>
<mi>e</mi>
<mi>t</mi>
<mi>a</mi>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mi>&pi;</mi>
</mrow>
<mn>3</mn>
</mfrac>
<mo>,</mo>
</mrow>
(2)利用随机数法得到并联平台的结构参数R0,R1,H,alpha,beta,如下式:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>R</mi>
<mn>0</mn>
</msub>
<mo>=</mo>
<mn>0.15</mn>
<mo>+</mo>
<mn>0.35</mn>
<mo>&times;</mo>
<mi>r</mi>
<mi>a</mi>
<mi>n</mi>
<mi>d</mi>
<mrow>
<mo>(</mo>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>R</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mn>0.15</mn>
<mo>+</mo>
<mn>0.35</mn>
<mo>&times;</mo>
<mi>r</mi>
<mi>a</mi>
<mi>n</mi>
<mi>d</mi>
<mrow>
<mo>(</mo>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>H</mi>
<mo>=</mo>
<mn>0.50</mn>
<mo>+</mo>
<mn>1.00</mn>
<mo>&times;</mo>
<mi>r</mi>
<mi>a</mi>
<mi>n</mi>
<mi>d</mi>
<mrow>
<mo>(</mo>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>a</mi>
<mi>l</mi>
<mi>p</mi>
<mi>h</mi>
<mi>a</mi>
<mo>=</mo>
<mfrac>
<mi>&pi;</mi>
<mn>3</mn>
</mfrac>
<mo>&times;</mo>
<mi>r</mi>
<mi>a</mi>
<mi>n</mi>
<mi>d</mi>
<mrow>
<mo>(</mo>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>b</mi>
<mi>e</mi>
<mi>t</mi>
<mi>a</mi>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mi>&pi;</mi>
</mrow>
<mn>3</mn>
</mfrac>
<mo>-</mo>
<mi>a</mi>
<mi>l</mi>
<mi>p</mi>
<mi>h</mi>
<mi>a</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
</mrow>
3
其中,函数rand()为区间[0,1]内的随机浮点数;
(3)根据并联平台生成的结构参数,计算其正逆运动学及雅克比矩阵;
(4)基于多目标-多约束结构参数优化算法,计算选型指标ε;
(5)返回第二步并不断循环计算,直至完成设定的运行步数;
(6)比较结构参数选型指标ε,选取最大值,此时所得到的并联平台结构参数即为所求。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710383403.2A CN107336231B (zh) | 2017-05-26 | 2017-05-26 | 六自由度并联平台结构参数优化方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710383403.2A CN107336231B (zh) | 2017-05-26 | 2017-05-26 | 六自由度并联平台结构参数优化方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107336231A true CN107336231A (zh) | 2017-11-10 |
CN107336231B CN107336231B (zh) | 2020-03-24 |
Family
ID=60220212
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710383403.2A Expired - Fee Related CN107336231B (zh) | 2017-05-26 | 2017-05-26 | 六自由度并联平台结构参数优化方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107336231B (zh) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108942942A (zh) * | 2018-08-16 | 2018-12-07 | 居鹤华 | 一种基于轴不变量的多轴机器人逆运动学建模与解算方法 |
CN109185072A (zh) * | 2018-07-05 | 2019-01-11 | 南京理工大学 | 六自由度海上浮动平台模拟器 |
CN110896170A (zh) * | 2019-11-04 | 2020-03-20 | 中国电子科技集团公司第五十四研究所 | 一种并联式六自由度副面调整机构设计工艺 |
CN111660296A (zh) * | 2020-05-28 | 2020-09-15 | 西安工程大学 | 一种基于全域空间条件数的优化机器人灵活度的方法 |
CN112497193A (zh) * | 2020-11-26 | 2021-03-16 | 南京全控航空科技有限公司 | 六自由度并联机器人电动缸推力估计方法与系统 |
CN112873175A (zh) * | 2020-12-23 | 2021-06-01 | 上海恒润数字科技集团股份有限公司 | 基于六自由度平台的工况数据确定方法和电子设备 |
CN112894802A (zh) * | 2020-12-28 | 2021-06-04 | 诺创智能医疗科技(杭州)有限公司 | 多级并联手术机械臂的控制方法及多级并联手术机械臂 |
CN113561220A (zh) * | 2020-01-23 | 2021-10-29 | 诺创智能医疗科技(杭州)有限公司 | 手术机械臂、计算机设备及计算机可读存储介质 |
CN114654450A (zh) * | 2022-04-08 | 2022-06-24 | 湖北工业大学 | 柔性并联微动机构尺度参数优化设计方法、系统及机构 |
CN114722531A (zh) * | 2022-04-08 | 2022-07-08 | 湖北工业大学 | 一种柔性并联微操作机构递进优化设计方法、系统及机构 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050038563A1 (en) * | 2003-08-16 | 2005-02-17 | Abdul Rauf | Device and method for kinematic calibration of robots |
CN101829989A (zh) * | 2010-04-29 | 2010-09-15 | 北京理工大学 | 基于区间分析的低自由度并联机器人多指标优化设计方法 |
CN103500367A (zh) * | 2013-10-08 | 2014-01-08 | 北京理工大学 | 基于区间分析的3-prs并联机器人的定位精度优化方法 |
CN103909522A (zh) * | 2014-03-19 | 2014-07-09 | 华南理工大学 | 一种六自由度工业机器人通过奇异域的方法 |
CN104325462A (zh) * | 2014-09-30 | 2015-02-04 | 同济大学 | 一种固有约束下构建机器人运动空间的方法 |
CN104999463A (zh) * | 2015-07-09 | 2015-10-28 | 哈尔滨工程大学 | 一种基于构形平面的冗余机械臂运动控制方法 |
-
2017
- 2017-05-26 CN CN201710383403.2A patent/CN107336231B/zh not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050038563A1 (en) * | 2003-08-16 | 2005-02-17 | Abdul Rauf | Device and method for kinematic calibration of robots |
CN101829989A (zh) * | 2010-04-29 | 2010-09-15 | 北京理工大学 | 基于区间分析的低自由度并联机器人多指标优化设计方法 |
CN103500367A (zh) * | 2013-10-08 | 2014-01-08 | 北京理工大学 | 基于区间分析的3-prs并联机器人的定位精度优化方法 |
CN103909522A (zh) * | 2014-03-19 | 2014-07-09 | 华南理工大学 | 一种六自由度工业机器人通过奇异域的方法 |
CN104325462A (zh) * | 2014-09-30 | 2015-02-04 | 同济大学 | 一种固有约束下构建机器人运动空间的方法 |
CN104999463A (zh) * | 2015-07-09 | 2015-10-28 | 哈尔滨工程大学 | 一种基于构形平面的冗余机械臂运动控制方法 |
Cited By (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109185072A (zh) * | 2018-07-05 | 2019-01-11 | 南京理工大学 | 六自由度海上浮动平台模拟器 |
CN108942942A (zh) * | 2018-08-16 | 2018-12-07 | 居鹤华 | 一种基于轴不变量的多轴机器人逆运动学建模与解算方法 |
CN108942942B (zh) * | 2018-08-16 | 2020-01-07 | 居鹤华 | 一种基于轴不变量的多轴机器人逆运动学建模与解算方法 |
WO2020034420A1 (zh) * | 2018-08-16 | 2020-02-20 | 居鹤华 | 一种基于轴不变量的多轴机器人逆运动学建模与解算方法 |
US11648681B2 (en) | 2018-08-16 | 2023-05-16 | Hehua Ju | Axis-invariant based multi-axis robot system inverse kinematics modeling and solving methods |
CN110896170A (zh) * | 2019-11-04 | 2020-03-20 | 中国电子科技集团公司第五十四研究所 | 一种并联式六自由度副面调整机构设计工艺 |
CN113561220A (zh) * | 2020-01-23 | 2021-10-29 | 诺创智能医疗科技(杭州)有限公司 | 手术机械臂、计算机设备及计算机可读存储介质 |
CN113561220B (zh) * | 2020-01-23 | 2022-07-01 | 诺创智能医疗科技(杭州)有限公司 | 手术机械臂、计算机设备及计算机可读存储介质 |
CN111660296B (zh) * | 2020-05-28 | 2023-06-06 | 西安工程大学 | 一种基于全域空间条件数的优化机器人灵活度的方法 |
CN111660296A (zh) * | 2020-05-28 | 2020-09-15 | 西安工程大学 | 一种基于全域空间条件数的优化机器人灵活度的方法 |
CN112497193A (zh) * | 2020-11-26 | 2021-03-16 | 南京全控航空科技有限公司 | 六自由度并联机器人电动缸推力估计方法与系统 |
CN112873175A (zh) * | 2020-12-23 | 2021-06-01 | 上海恒润数字科技集团股份有限公司 | 基于六自由度平台的工况数据确定方法和电子设备 |
CN112873175B (zh) * | 2020-12-23 | 2022-08-19 | 上海恒润数字科技集团股份有限公司 | 基于六自由度平台的工况数据确定方法和电子设备 |
CN112894802A (zh) * | 2020-12-28 | 2021-06-04 | 诺创智能医疗科技(杭州)有限公司 | 多级并联手术机械臂的控制方法及多级并联手术机械臂 |
CN114654450B (zh) * | 2022-04-08 | 2023-04-28 | 湖北工业大学 | 柔性并联微动机构尺度参数优化设计方法、系统及机构 |
CN114722531A (zh) * | 2022-04-08 | 2022-07-08 | 湖北工业大学 | 一种柔性并联微操作机构递进优化设计方法、系统及机构 |
CN114654450A (zh) * | 2022-04-08 | 2022-06-24 | 湖北工业大学 | 柔性并联微动机构尺度参数优化设计方法、系统及机构 |
CN114722531B (zh) * | 2022-04-08 | 2024-06-07 | 湖北工业大学 | 一种柔性并联微操作机构递进优化设计方法、系统及机构 |
Also Published As
Publication number | Publication date |
---|---|
CN107336231B (zh) | 2020-03-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107336231A (zh) | 六自由度并联平台结构参数优化方法 | |
CN110421566B (zh) | 一种基于近似度加权平均插值法的机器人精度补偿方法 | |
Shin et al. | Antagonistic stiffness optimization of redundantly actuated parallel manipulators in a predefined workspace | |
Shen et al. | 3D printing build orientation optimization for flexible support platform | |
Ramana Babu et al. | Design optimization of 3PRS parallel manipulator using global performance indices | |
Aginaga et al. | Improving static stiffness of the 6-RUS parallel manipulator using inverse singularities | |
CN103390101A (zh) | 串联形式机器人的逆运动学通用求解方法 | |
CN107160404A (zh) | 一种带连杆的六自由度液压运动平台位姿控制方法 | |
Rosyid et al. | Genetic and hybrid algorithms for optimization of non-singular 3PRR planar parallel kinematics mechanism for machining application | |
Shi et al. | Optimization of the workspace of a MEMS hexapod nanopositioner using an adaptive genetic algorithm | |
CN110348086A (zh) | 一种球头铣刀立铣表面粗糙度快速建模方法 | |
Gao et al. | Forward kinematics modeling of spatial parallel linkage mechanisms based on constraint equations and the numerical solving method | |
Wang et al. | Analysis and multi-objective optimal design of a planar differentially driven cable parallel robot | |
Li et al. | A new approach to the architecture optimization of a general 3-PUU translational parallel manipulator | |
Chen et al. | Velocity index and wading height based design method of trajectory parameters for a coupled parallelogram legged walking robot | |
Li et al. | Dynamics and workspace analysis of a multi-robot collaborative towing system with floating base | |
Fang et al. | Optimization of a crossbar parallel machine tool based on workspace and dexterity | |
CN104462838B (zh) | 四自由度码垛机器人工作空间合理程度的量化评价方法 | |
Ginnante et al. | Kinetostatic optimization for kinematic redundancy planning of nimbl’bot robot | |
DANESHMAND et al. | Optimization of the kinematic sensitivity and the greatest continuous circle in the constant-orientation workspace of planar parallel mechanisms | |
Popov et al. | Optimal planar 3RRR robot assembly mode and actuation scheme for machining applications | |
Shaker et al. | Simulation study for robot-based single point incremental forming | |
Pu et al. | Optimal design of 6-DOF parallel manipulator with workspace maximization using a constrained differential evolution | |
Li et al. | Optimal kinematic design for a general 3-PRS spatial parallel manipulator based on dexterity and workspace | |
Dikmenli | Forward & inverse kinematics solution of 6-dof robots those have offset & spherical wrists |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20200324 |