CN116700150B - 精密运动平台点位运动鲁棒轨迹规划系统及其规划方法 - Google Patents
精密运动平台点位运动鲁棒轨迹规划系统及其规划方法 Download PDFInfo
- Publication number
- CN116700150B CN116700150B CN202310860402.8A CN202310860402A CN116700150B CN 116700150 B CN116700150 B CN 116700150B CN 202310860402 A CN202310860402 A CN 202310860402A CN 116700150 B CN116700150 B CN 116700150B
- Authority
- CN
- China
- Prior art keywords
- track
- motion
- curve
- planning
- point
- 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
- 230000033001 locomotion Effects 0.000 title claims abstract description 79
- 238000000034 method Methods 0.000 title claims abstract description 25
- 230000001133 acceleration Effects 0.000 claims abstract description 21
- 230000010355 oscillation Effects 0.000 claims abstract description 19
- 238000009966 trimming Methods 0.000 claims abstract description 3
- 230000036461 convulsion Effects 0.000 claims description 10
- 230000005764 inhibitory process Effects 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 5
- 230000001629 suppression Effects 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000033228 biological regulation Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000002708 enhancing effect Effects 0.000 description 1
- 230000002401 inhibitory effect Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/408—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by data handling or data format, e.g. reading, buffering or conversion of data
- G05B19/4086—Coordinate conversions; Other special calculations
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/35—Nc in input of data, input till input file format
- G05B2219/35356—Data handling
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
精密运动平台点位运动鲁棒轨迹规划系统及其规划方法,属于精密运动平台技术领域。轨迹生成器输出参考S曲线;参考S曲线经柔性系统获得系统输出,柔性系统的共振频率以及系统输出的残余振荡信息共同提供给轨迹生成器以修正参考S曲线。方法如下:设计对称S型运动轨迹,设计S型运动轨迹参数;修整轨迹增强运动轨迹对模型摄动鲁棒性;判定S型运动轨迹设计是否合理;将获得的非对称S曲线输入柔性系统,获得系统输出;按照系统需求判定残余振荡是否满足要求。本发明解决了传统精密运动平台点位运动轨迹规划方法仅关注运动轨迹的几何光顺未考虑被控对象柔性特性的问题,同时解决了传统点位运动轨迹规划方法加减速对称规划增加运动耗时的问题。
Description
技术领域
本发明涉及一种精密运动平台点位运动鲁棒轨迹规划系统及其规划方法,属于精密运动平台技术领域。
背景技术
由于特殊机械设计、机械安全保护、节约成本等原因,设备中会出现柔性环节。不合理的设计参考运动轨迹会激励柔性系统造成残余振动,令调整时间和定位精度很难得到保证。传统对称S曲线相比于梯形速度曲线等高速运动轨迹具有加速度变化更柔顺的特点,对残余振动的抑制效果也更好。
目前的方法如高阶S曲线、Twin-sin曲线、Smooth Jerk曲线、AS-curve曲线等均在考虑了前述物理条件制约的情况下,通过增强自身的光顺性来被动的减少柔性系统被激发的残余振动。但这些轨迹没有考虑被控系统的动力学特性,很难保证残余振动抑制效果和时间消耗的兼容性。另外,针对点位运动,并不关心加速段结束时的振动状态,因此传统点位运动轨迹规划方法加减速对称规划方式会造成运动耗时增加的问题。
发明内容
为解决背景技术中存在的问题,本发明提供一种精密运动平台点位运动鲁棒轨迹规划系统及其规划方法。
实现上述目的,本发明采取下述技术方案:一种精密运动平台点位运动鲁棒轨迹规划系统,包括轨迹生成器CR、柔性系统P和实际输出Y;
所述轨迹生成器CR的输出为参考S曲线;
所述参考S曲线的运动轨迹包括位置R、速度V、加速度A以及加加速度J;
参考S曲线经所述柔性系统P获得系统输出Y,且柔性系统P的共振频率fn以及系统输出Y的残余振荡的信息共同提供给轨迹生成器CR,以修正参考S曲线。
本发明的一种精密运动平台点位运动鲁棒轨迹规划系统的规划方法,所述方法包括如下步骤:
S1:设计对称S型运动轨迹,基于零极点配置原理设计S型运动轨迹参数;
S2:修整轨迹,增强运动轨迹对模型摄动鲁棒性;
S3:基于时间约束判定S型运动轨迹设计是否合理,如合理,则生成S型运动轨迹;如不合理,则重新输入非对称调节参数γ;
S4:将获得的非对称S曲线输入柔性系统P,获得系统输出Y;
S5:按照系统需求判定残余振荡是否满足要求,若满足要求,则通过系统输出Y的残余振荡的信息修正共振频率fn;若不满足要求,则提取系统输出Y的残余振荡信息进行FFT分析,并选取频率分量最大的频率点修正共振频率参数fn,而后重复S1-S4直至残余振荡抑制满足系统需求,确定运动轨迹设计标准。
与现有技术相比,本发明的有益效果是:
本发明解决了传统精密运动平台点位运动轨迹规划方法仅关注运动轨迹的几何光顺未考虑被控对象柔性特性的问题,同时解决了传统点位运动轨迹规划方法加减速对称规划增加运动耗时的问题。
附图说明
图1是本发明的柔性系统的示意图;
图2是参数初始化之后的S型运动轨迹规划示意图;
图3是本发明的规划系统的示意图;
图4是系统极点与轨迹零点分布示意图。
图5是非对称S型鲁棒轨迹规划示意图;
图6是残余振荡抑制示意图;
图7是参数修正后残余振荡抑制示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅是发明的一部分实施例,而不是全部的实施例,基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
一种精密运动平台点位运动鲁棒轨迹规划系统,包括轨迹生成器CR、柔性系统P和实际输出Y;
所述轨迹生成器CR的输出为参考S曲线;
所述参考S曲线的运动轨迹包括位置R、速度V、加速度A以及加加速度J;
参考S曲线经所述柔性系统P获得系统输出Y,且柔性系统P的共振频率fn以及系统输出Y的残余振荡的信息共同提供给轨迹生成器CR,以修正参考S曲线。
本发明的一种精密运动平台点位运动鲁棒轨迹规划系统的规划方法,所述方法包括如下步骤:
S1:获取共振频率时,利用ansys有限元应力分析,获得柔性结构的劲度系数k,根据已知的负载质量m计算共振频率依据运动行程约束、运动时间约束、被控对象出力约束以及柔性系统的共振频率fn,设计对称S型运动轨迹,基于零极点配置原理设计S型运动轨迹参数;
S101:受限于实际工况,对称S型运动轨迹规划时需要对运动行程进行严格约束,即目标位置Rmax为已知确定值,运动控制系统中不可或缺的执行器—电机,因为其反电势、磁极强度、线圈匝数等因素决定了电机的最大运行速度Vmax和固定负载及最大出力下的最大加速度Amax为已知确定值。同时,运动控制系统中必要的运动板卡也决定着相关参数,其控制周期为Ts。
选择要被抑制的被控的柔性系统的共振频率fn,可知其对应的系统振动极点Sn即近似为:
Sn=±j2πfn (1)
式(1)中:
j表示虚数单位;
S102:基于图3给出的零极点配置原理,欲使残余振动最小需要将轨迹零点与系统振动极点Sn相对应,如图2所示,以三阶S曲线为例,对运动轨迹参数进行快速设计。可得:
因此:
式(2)、(3)中:
Jmax表示最大加加速度;
Amax表示最大加速度;
α表示加速段的自定义调节参数,为正整数,为了时间最优,α取为1。
加速段是指速度V从为0开始增加到Vmax的过渡过程,对应的减速段指从速度V从Vmax开始减少到0的过渡过程。
S2:修整轨迹,增强运动轨迹对模型摄动鲁棒性;
S201:加速段保持不变;
S202:修整轨迹减速段。
S20201:在减速段添加非对称调节参数γ,γ≥1,调节曲线非对称性,增强运动轨迹对模型摄动鲁棒性,具体体现在:
式(4)中:
Jdec表示减速段的加加速度幅值;
Jacc表示加速段的加加速度幅值;
S20202:根据图4所示的轨迹规划方法,在保证减速段结束时速度为0的条件下,得到减速段的加速度幅值为:
式(5)中:
Adec表示减速段的加速度幅值;
S20203:非对称调节参数γ主要调节的是减速阶段的平滑程度,也可以叫做整条运动轨迹的非对称性,主要是为了令轨迹可以针对主振动频率提供频率摄动鲁棒性。在相同物理约束下,非对称调节参数γ与速度运动轨迹是随之变化的关系,即非对称调节参数γ的调节可以表示为:
式(6)中:
表示时间常数;
Vmax表示最大运行速度;
α1为不小于α的正整数,表示减速段的自定义调节参数,如果为了时间最优,α1和α均取为1。
S3:基于时间约束判定S型运动轨迹设计是否合理,如合理,则生成S型运动轨迹;如不合理,则重新输入非对称调节参数γ;
所述时间约束判定标准如下:
基于所规划的运动轨迹完成运动所消耗时间应小于指标约束的最长时间tmax的要求,即:
式(7)中:
Rmax表示目标位置。
S4:将获得的非对称S曲线输入柔性系统P,获得系统输出Y;
S5:按照系统需求判定残余振荡是否满足要求,若满足要求,则通过系统输出Y的残余振荡的信息修正共振频率fn;若不满足要求,则提取系统输出Y的残余振荡信息进行FFT分析,并选取频率分量最大的频率点修正共振频率参数fn,而后重复S1-S4直至残余振荡抑制满足系统需求,确定运动轨迹设计标准。
本发明还可应用于更高阶的S曲线轨迹规划当中。
对于本领域技术人员而言,显然本发明不限于上述示范性实施例的细节,而且在不背离本发明的精神或基本特征的情况下,能够以其他的形式实现本发明。因此,无论从哪一点来看,均应将实施例看作是示范性的,而且是非限制性的,本发明的范围由所附权利要求而不是上述说明限定,因此旨在将落在权利要求的等同条件的含义和范围内的所有变化囊括在本发明内。不应将权利要求中的任何附图标记视为限制所涉及的权利要求。
此外,应当理解,虽然本说明书按照实施方式加以描述,但并非每个实施方式仅包含一个独立的技术方案,说明书的这种叙述方式仅仅是为清楚起见,本领域技术人员应当将说明书作为一个整体,各实施例中的技术方案也可以经适当组合,形成本领域技术人员可以理解的其他实施方式。
Claims (1)
1.一种精密运动平台点位运动鲁棒轨迹规划系统的规划方法,所述方法是依赖规划系统完成的,所述规划系统包括轨迹生成器CR、柔性系统P和实际输出Y;
所述轨迹生成器CR的输出为参考S曲线;
所述参考S曲线的运动轨迹包括位置R、速度V、加速度A以及加加速度J;
参考S曲线经所述柔性系统P获得系统输出Y,且柔性系统P的共振频率fn以及系统输出Y的残余振荡的信息共同提供给轨迹生成器CR,以修正参考S曲线;其特征在于:所述方法包括如下步骤:
S1:设计对称S型运动轨迹,基于零极点配置原理设计S型运动轨迹参数;
S101:选择要被抑制的被控的柔性系统的共振频率fn,可知其对应的系统振动极点Sn为:
Sn=±j2πfn (1)
式(1)中:
j表示虚数单位;
S102:基于零极点配置原理,设计三阶S曲线,将轨迹零点与系统振动极点Sn相对应可得:
因此:
式(2)、(3)中:
Jmax表示最大加加速度;
Amax表示最大加速度;
α表示加速段的自定义调节参数,为正整数;
S2:修整轨迹,增强运动轨迹对模型摄动鲁棒性;
S201:加速段保持不变;
S202:修整轨迹减速段;
S20201:在减速段添加非对称调节参数γ,γ≥1:
式(4)中:
Jdec表示减速段的加加速度幅值;
Jacc表示加速段的加加速度幅值;
S20202:得到减速段的加速度幅值为:
式(5)中:
Adec表示减速段的加速度幅值;
S20203:在相同物理约束下,非对称调节参数γ与速度运动轨迹是随之变化的关系,即非对称调节参数γ的调节表示为:
式(6)中:
表示时间常数;
Vmax表示最大运行速度;
α1为不小于α的正整数,表示减速段的自定义调节参数;
S3:基于时间约束判定S型运动轨迹设计是否合理,如合理,则生成S型运动轨迹;如不合理,则重新输入非对称调节参数γ;
所述时间约束判定标准如下:
基于所规划的运动轨迹完成运动所消耗时间应小于指标约束的最长时间tmax的要求,即:
式(7)中:
Rmax表示目标位置;
S4:将获得的非对称S曲线输入柔性系统P,获得系统输出Y;
S5:按照系统需求判定残余振荡是否满足要求,若满足要求,则通过系统输出Y的残余振荡的信息修正共振频率fn;若不满足要求,则提取系统输出Y的残余振荡信息进行FFT分析,并选取频率分量最大的频率点修正共振频率参数fn,而后重复S1-S4直至残余振荡抑制满足系统需求,确定运动轨迹设计标准。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310860402.8A CN116700150B (zh) | 2023-07-13 | 2023-07-13 | 精密运动平台点位运动鲁棒轨迹规划系统及其规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310860402.8A CN116700150B (zh) | 2023-07-13 | 2023-07-13 | 精密运动平台点位运动鲁棒轨迹规划系统及其规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN116700150A CN116700150A (zh) | 2023-09-05 |
CN116700150B true CN116700150B (zh) | 2024-01-30 |
Family
ID=87824043
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310860402.8A Active CN116700150B (zh) | 2023-07-13 | 2023-07-13 | 精密运动平台点位运动鲁棒轨迹规划系统及其规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116700150B (zh) |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102298391A (zh) * | 2011-04-27 | 2011-12-28 | 哈尔滨工业大学 | 一种重载工业机器人操作空间内运动轨迹规划方法 |
KR20140139388A (ko) * | 2013-05-27 | 2014-12-05 | 한국과학기술원 | 잔류진동을 강인하게 저감하기 위한 최적 s-커브 모션 프로파일 설계 방법 |
KR20140139387A (ko) * | 2013-05-27 | 2014-12-05 | 한국과학기술원 | 이송 중 시스템의 특징이 변하는 상황에서 잔류진동을 강인하게 저감하기 위한 비대칭적인 사다리꼴 모션 프로파일 설계 방법 |
CN105182906A (zh) * | 2015-09-24 | 2015-12-23 | 哈尔滨工业大学 | 基于高阶s型运动轨迹的位置与速度控制方法 |
CN107825424A (zh) * | 2017-10-31 | 2018-03-23 | 河北工业大学 | 一种高速机械手减少残余振动的非对称s型轨迹规划方法 |
CN110103220A (zh) * | 2019-05-20 | 2019-08-09 | 华南理工大学 | 机器人高速高精度运动轨迹规划方法、装置、设备及介质 |
CN111158318A (zh) * | 2020-01-16 | 2020-05-15 | 江南大学 | 一种非对称性四次曲线柔性加减速规划方法 |
CN111708976A (zh) * | 2020-05-20 | 2020-09-25 | 中南大学 | 一种高阶连续的点对点运动轨迹规划方法 |
CN113110568A (zh) * | 2021-03-13 | 2021-07-13 | 浙江御穹电子科技有限公司 | 一种无人机运动轨迹规划系统及方法 |
CN113253678A (zh) * | 2021-04-29 | 2021-08-13 | 中国科学院微电子研究所 | 精密运动平台的运动轨迹规划方法 |
CN116107221A (zh) * | 2023-04-14 | 2023-05-12 | 河北工业大学 | 一种伺服控制系统的控制方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104008250B (zh) * | 2014-06-10 | 2016-01-20 | 广东工业大学 | 基于主频能量时域最优分布的非对称变加速度规划方法 |
CN107263484B (zh) * | 2017-08-10 | 2020-04-14 | 南京埃斯顿机器人工程有限公司 | 机器人关节空间点到点运动的轨迹规划方法 |
-
2023
- 2023-07-13 CN CN202310860402.8A patent/CN116700150B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102298391A (zh) * | 2011-04-27 | 2011-12-28 | 哈尔滨工业大学 | 一种重载工业机器人操作空间内运动轨迹规划方法 |
KR20140139388A (ko) * | 2013-05-27 | 2014-12-05 | 한국과학기술원 | 잔류진동을 강인하게 저감하기 위한 최적 s-커브 모션 프로파일 설계 방법 |
KR20140139387A (ko) * | 2013-05-27 | 2014-12-05 | 한국과학기술원 | 이송 중 시스템의 특징이 변하는 상황에서 잔류진동을 강인하게 저감하기 위한 비대칭적인 사다리꼴 모션 프로파일 설계 방법 |
CN105182906A (zh) * | 2015-09-24 | 2015-12-23 | 哈尔滨工业大学 | 基于高阶s型运动轨迹的位置与速度控制方法 |
CN107825424A (zh) * | 2017-10-31 | 2018-03-23 | 河北工业大学 | 一种高速机械手减少残余振动的非对称s型轨迹规划方法 |
CN110103220A (zh) * | 2019-05-20 | 2019-08-09 | 华南理工大学 | 机器人高速高精度运动轨迹规划方法、装置、设备及介质 |
CN111158318A (zh) * | 2020-01-16 | 2020-05-15 | 江南大学 | 一种非对称性四次曲线柔性加减速规划方法 |
CN111708976A (zh) * | 2020-05-20 | 2020-09-25 | 中南大学 | 一种高阶连续的点对点运动轨迹规划方法 |
CN113110568A (zh) * | 2021-03-13 | 2021-07-13 | 浙江御穹电子科技有限公司 | 一种无人机运动轨迹规划系统及方法 |
CN113253678A (zh) * | 2021-04-29 | 2021-08-13 | 中国科学院微电子研究所 | 精密运动平台的运动轨迹规划方法 |
CN116107221A (zh) * | 2023-04-14 | 2023-05-12 | 河北工业大学 | 一种伺服控制系统的控制方法 |
Non-Patent Citations (3)
Title |
---|
Formulating a Laplace domain approach for tuning motion profiles;Chang-Wan Ha;2011 IEEE/ASME International Conference on Advanced Intelligent Mechatronics (AIM2011);356-360 * |
基于脉冲整形滤波的轨迹涂胶残余振动抑制研究;史伟民;杨亮亮;陶维;武传宇;;中国机械工程(07);108-111 * |
消除参数不确定柔性系统的残留振荡鲁棒控制;董明晓;于复生;孙杰;张桂青;张明勤;;中国机械工程(08);5-7 * |
Also Published As
Publication number | Publication date |
---|---|
CN116700150A (zh) | 2023-09-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111158318B (zh) | 一种非对称性四次曲线柔性加减速规划方法 | |
CN114077226B (zh) | S型曲线速度规划方法、控制终端及计算机可读存储介质 | |
CN104935217A (zh) | 适用于多电机系统的改进型偏差耦合控制方法 | |
CN107765648B (zh) | 一种cnc加工的进给速度规划方法及装置 | |
JP2019530936A (ja) | 非ゼロ初期状態におけるs型の停止曲線の速度ルール及びそのオンライン求解方法 | |
CN110632846A (zh) | 基于二阶adrc算法的地铁列车速度自动控制方法 | |
CN111605553B (zh) | 一种新能源汽车扭矩分段梯度滤波控制方法及装置 | |
CN106527119A (zh) | 基于模糊控制的微分先行pid控制系统 | |
CN113110568B (zh) | 一种无人机运动轨迹规划方法 | |
CN116700150B (zh) | 精密运动平台点位运动鲁棒轨迹规划系统及其规划方法 | |
CN110134065A (zh) | 一种基于正弦平方加速度前瞻的机床加工轨迹运动规划方法 | |
CN104201967A (zh) | 一种采用自抗扰控制技术的网络化永磁同步电机时延补偿和控制方法 | |
TW201322616A (zh) | 馬達控制裝置 | |
CN103246236B (zh) | 一种考虑小直线段和连接点速度的数控系统速度控制方法 | |
CN105945249B (zh) | 连铸结晶器非正弦振动方法 | |
JPWO2010125958A1 (ja) | 指令生成装置 | |
CN113085963B (zh) | 列车控制级位的动态调控方法及其动态调控装置 | |
JP2020029211A (ja) | 運転曲線作成装置 | |
CN113253772B (zh) | 一种基于误差预估及补偿的伺服定位系统及方法 | |
CN116909210B (zh) | 基于频率选择的精密运动平台运动轨迹规划系统及方法 | |
CN114578764A (zh) | 一种正矢平方型加减速控制算法 | |
CN113703433B (zh) | 机器人运动轨迹的速度规划方法及装置 | |
KR20140139387A (ko) | 이송 중 시스템의 특징이 변하는 상황에서 잔류진동을 강인하게 저감하기 위한 비대칭적인 사다리꼴 모션 프로파일 설계 방법 | |
CN114367644A (zh) | 一种连铸结晶器振动轨迹曲线切换方法 | |
CN111384881A (zh) | 快速消抖的高精度Collimator步进电机控制方法 |
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 | ||
CB03 | Change of inventor or designer information |
Inventor after: Dong Yue Inventor after: Li Li Inventor after: Song Fazhi Inventor after: Qin Guangyi Inventor before: Dong Yue Inventor before: Wan Yu Inventor before: Song Fazhi Inventor before: Li Li |