CN107357325B - 用于大口径射电望远镜换源的串级避振规划方法与系统 - Google Patents
用于大口径射电望远镜换源的串级避振规划方法与系统 Download PDFInfo
- Publication number
- CN107357325B CN107357325B CN201710453911.3A CN201710453911A CN107357325B CN 107357325 B CN107357325 B CN 107357325B CN 201710453911 A CN201710453911 A CN 201710453911A CN 107357325 B CN107357325 B CN 107357325B
- Authority
- CN
- China
- Prior art keywords
- time
- acceleration
- vibration
- curve
- planning
- 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
- 238000000034 method Methods 0.000 title claims abstract description 52
- 230000001133 acceleration Effects 0.000 claims abstract description 128
- 230000008859 change Effects 0.000 claims abstract description 21
- 230000007246 mechanism Effects 0.000 claims abstract description 15
- 230000008569 process Effects 0.000 claims abstract description 8
- 238000007493 shaping process Methods 0.000 claims description 22
- 238000013016 damping Methods 0.000 claims description 15
- 238000006073 displacement reaction Methods 0.000 claims description 8
- 230000007423 decrease Effects 0.000 claims description 7
- 230000009467 reduction Effects 0.000 claims description 5
- 230000001960 triggered effect Effects 0.000 claims description 5
- 238000010276 construction Methods 0.000 claims description 4
- 238000005070 sampling Methods 0.000 claims description 3
- 241000208340 Araliaceae Species 0.000 claims 1
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 claims 1
- 235000003140 Panax quinquefolius Nutrition 0.000 claims 1
- 235000008434 ginseng Nutrition 0.000 claims 1
- 238000005457 optimization Methods 0.000 description 11
- 230000010355 oscillation Effects 0.000 description 6
- 230000008901 benefit Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 230000001105 regulatory effect Effects 0.000 description 3
- 230000001629 suppression Effects 0.000 description 3
- 230000002401 inhibitory effect Effects 0.000 description 2
- 238000013178 mathematical model Methods 0.000 description 2
- 230000006978 adaptation Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000012141 concentrate Substances 0.000 description 1
- 230000036461 convulsion Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D19/00—Control of mechanical oscillations, e.g. of amplitude, of frequency, of phase
- G05D19/02—Control of mechanical oscillations, e.g. of amplitude, of frequency, of phase characterised by the use of electric means
Abstract
本发明涉及大口径射电望远镜的运动控制领域,具体涉及一种用于大口径射电望远镜换源的串级避振规划方法与系统。目的是为了降低换源过程中因加减速运动引起的系统振动,同时避免因使用物理阻尼器而增加成本。本发明的规划系统中,任务参数指令下达模块将指定的换源参数发送给串级避振规划模块,该模块通过两个子处理过程:初步运动曲线规划和ZVD输入整形,输出的最终运动规划曲线通过指令分解器求解出各执行机构的控制指令,通过控制驱动机构完成大口径射电望远镜的换源任务。此外,串级避振规划模块需要用到系统参数估计器产生的系统参数。本发明显著降低了因加减速运动引起的系统振动,提高了馈源接收机定位精度,并保证了系统的快速性。
Description
技术领域
本发明涉及大口径射电望远镜的运动控制领域,具体涉及一种用于大口径射电望远镜换源的串级避振规划方法与系统。
背景技术
我国自主建成的500m口径射电望远镜FAST为实现在大尺度工作空间范围的高精度定位,采用两级调节机构的设计方案。第一级调节机构是6索并联驱动机构和AB轴转向机构,它用于实现对馈源舱位姿的粗定位;第二级调节机构是Stewart并联机器人,它用于实现对馈源舱粗定位误差的补偿,从而满足关于位姿的高精度技术指标的要求。FAST采用6索并联机构大大减少建设成本,但是由于采用柔性索,也给系统引入了非线性、大滞后等问题,尤其是在运动过程中各种因素很容易引起舱-索系统的振动。就FAST的舱-索系统而言,其具有固有频率低、阻尼小、馈源舱重达30多吨等特点,一旦产生较大的自激振荡,系统振荡衰减很慢,较大的振幅不但影响到定位精度,而且可能会对机械结构造成损耗甚至破坏。
目前关于大口径射电望远镜(如FAST)抑振的方法集中在机械方面,主要是阻尼器的设计。根据大口径射电望远镜机械结构的特点,利用各种原理设计的阻尼器实际上是通过增大系统的阻尼,从而更好地抑制振幅大小以及使振动衰减更快。增加阻尼器的做法能够抑制各种运行情况下产生的振动,但是配置物理阻尼器的缺点是:一方面增加了硬件上的成本;另一方面大口径射电望远镜是一个非常庞大的系统,多余的物理设备为系统运行增加了承重的负担,也为维护工作带来难度;第三,阻尼器运行总是处于不断的损耗状态,不可避免会改变系统某些特定参数及定位测量精度。
为避免物理阻尼器的缺点,运用软件通过数学模型生成具有避振功能的换源(“点到点”运动)参考轨迹,控制柔性索迅速、平稳、准确地将馈源舱安装到位,这是一个最理想的解决方案。但建立怎样的智能控制系统数学模型是该技术的难点。
1998年6月在美国宾夕法尼亚费城召开的“美国控制会议”上发表的《Optimizeds-curve motion profilesfor minimum residual vibration(最优化的曲线运动轨迹的最小残余振动)》公开了“优化S形速度曲线规划”的方法。能够抑制系统在较广频率范围内的振动。但无法完全消除集中于固有频率附近的残余振动,对于频率变化鲁棒性略差。
2009年10月发表在《国际精密工程与制造杂志》上的“Command shaping forflexiblesystems(柔性系统的命令整形)”公开了“ZVD输入整形规划”的方法。具有适应建模误差的敏感性,参数不确定性和非线性等优点,对于固有频率的变化具有较好的鲁棒性。但它的使用依赖于输入的曲线。
发明内容
为了解决现有技术中的上述问题,本发明提出一种用于大口径射电望远镜换源的串级避振规划方法与系统,显著降低了因加减速运动引起的系统振动,提高了馈源接收机定位精度,同时也保证了系统的快速性。
本发明一方面提出一种用于大口径射电望远镜换源的串级避振规划方法,包括:
步骤S1,依据输入的换源参数,计算初步运动规划曲线,包括换源起点到终点的位移规划曲线以及运动过程中的速度、加速度规划曲线;
步骤S2,基于ZVD(Zero vibration and derivative,零振荡与导数法,简称ZVD)整形方法对所述初步运动规划曲线进行整形,得到最终运动规划曲线。
优选地,步骤S1具体为:
步骤S11,计算参数tr和
其中:tr为加速度上升时间与匀加速时间之和;ωn为系统的振动角频率,ωn=2πfn;fn为大口径射电望远镜舱-索系统的固有频率;mtotal为馈源舱的总质量;Fmax为允许对馈源舱施加的最大合外力;vmax为最大速度;amax为最大加速度;
步骤S12,计算加速阶段的参数:加速总时间tsp、加速度上升时间或加速度下降时间ta、匀加速时间tm;若则转至步骤S13,否则转至步骤S17;其中,jmax为最大加加速度,加速度上升时间与加速度下降时间相等;
步骤S13,计算减速阶段的参数:减速总时间t′sp、加速度上升时间或加速度下降时间t′a、匀减速时间t′m;若则转至步骤S14,否则转至步骤S16;其中,加速度上升时间与加速度下降时间相等;
步骤S14,计算匀速运动阶段的时间tconstV;
步骤S15,若tconstV>0且(tconstV+tsp+t′sp)≤Tmax则执行步骤S16,否则执行步骤S17;其中,Tmax为最大时间限制;
步骤S16,求出位移、速度、加速度规划曲线,转至步骤S18;
步骤S17,采用通用S形速度曲线进行规划;
步骤S18,按预设的时间周期对规划曲线进行采样,得到离散化的轨迹点。
优选地,所述计算加速阶段的参数,方法为:
计算加速度上升时间与总加速时间的最优比值
分别计算加速总时间tsp、加速度上升时间或加速度下降时间ta、匀加速时间tm:
tm=tsp-2ta;
其中,tr为加速度上升时间ta与匀加速时间tm之和,加速度上升时间与加速度下降时间均为ta。
优选地,所述计算减速阶段的参数,方法为:
计算加速度上升时间与总减速时间的最优比值
分别计算加速总时间t′sp、加速度上升时间或加速度下降时间t′a、匀减速时间t′m:
t′m=t′sp-2t′a;
其中,tr为加速度上升时间t′a与匀加速时间t′m之和,加速度上升时间与加速度下降时间均为t′a。
优选地,所述加速度上升时间与总加速时间的最优比值通过以下方法确定:
当为整数时,
当不为整数时,
将的取值空间以step为间距进行离散化,针对每个离散值计算对应的a*,选取满足a*为极小值时的其中,step为预设值。
优选地,所述加速度上升时间与总减速时间的最优比值通过以下方法确定:
当为整数时,
当不为整数时,
将的取值空间以step为间距进行离散化,针对每个离散值计算对应的a*,选取满足a*为极小值时的其中,step为预设值。
优选地,步骤S2具体为:
步骤S21,构造包含三个脉冲的ZVD整形器:
其中,Ai为ZVD整形器的三个脉冲幅值,ti为所述三个脉冲的触发时间,i=1,2,3;ξ为大口径射电望远镜舱-索系统的阻尼比;ωn=2πfn,fn为大口径射电望远镜舱-索系统的固有频率;
步骤S22,将ZVD整形器与所述初步运动规划曲线进行卷积,得到X、Y、Z各个坐标轴方向上的运动规划曲线;
步骤S23,判断整形后的运动时间是否小于等于最大时间限制Tmax,若是,则执行步骤S24;否则,转至步骤S25;
步骤S24,输出整形后的轨迹作为最终运动规划曲线;
步骤S25,提示规划失败。
优选地,步骤S22具体为:
对ZVD整形器的时间进行离散化操作,将ZVD整形器与步骤S18所得到的离散化轨迹进行卷积操作;所述对ZVD整形器的时间进行离散化操作,按预设的时间周期,将步骤S21所得三个脉冲的触发时间分别修改为距离最近的控制采样时间点。
优选地,所述换源参数包括:换源起始点、换源目标点、速度限制、加速度限制、加加速度限制、最大换源时间限制。
优选地,所述大口径射电望远镜舱-索系统的阻尼比和所述大口径射电望远镜舱-索系统的固有频率,由系统参数估计器获得。
本发明另一方面提出一种用于大口径射电望远镜换源的串级避振规划系统,基于上面所述的串级避振规划方法,包括:任务参数指令下达模块、串级避振规划模块、指令分解器、驱动机构、大口径射电望远镜、系统参数估计器;
所述任务参数指令下达模块,将所述换源参数发送给所述串级避振规划模块;
所述串级避振规划模块,包括初步运动曲线规划器和ZVD输入整形器;根据所述换源参数计算所述初步运动规划曲线;对所述初步运动规划曲线进行ZVD整形,得到最终运动规划曲线;
所述指令分解器,根据所述串级避振规划模块输出的最终运动规划曲线,分解出各执行机构的控制指令,并下达到所述驱动机构;
所述驱动机构,根据所述指令分解器下达的控制指令,驱动大口径射电望远镜完成换源任务;
所述系统参数估计器,用于计算大口径射电望远镜舱-索系统的固有频率和阻尼比;所述固有频率和阻尼比用于下一次运动规划曲线计算。
本发明的有益效果:
本发明与常见的设计阻尼器抑振的做法相比,不但减少了使用物理阻尼器所增加的成本,而且具有不改变系统的原有结构的优点。适用于大口径射电望远镜的换源过程,也适用于其他类似柔性系统的“点到点”直线运动过程的轨迹生成。
通过由初步运动曲线规划器和ZVD输入整形器组成的串级避振规划模块,本发明的优化S形速度曲线规划方法能够抑制系统在较广频率范围内的振动,而且对大射电望远镜舱-索系统固有频率附近的振幅抑制作用较为明显;所述ZVD输入整形器串联在优化S形速度曲线规划环节之后,针对前者无法完全消除的集中于固有频率附近的残余振动有很好的抑制效果;所述ZVD输入整形器对于固有频率的变化具有较好的鲁棒性,较好的解决了优化S形速度曲线规划环节对于频率变化鲁棒性略差的问题,从而提高整个串级避振规划模块的性能。
本发明提高了馈源接收机定位精度,同时也保证了系统的快速性,尤其适用于大口径射电望远镜的舱-索系统等柔性的变结构的系统。
附图说明
图1为本实施例中,500m口径射电望远镜FAST的换源示意图;
图2为本实施例中,通用S形速度曲线加减速原理示意图;
图3为本实施例中,计算初步运动规划曲线的流程示意图;
图4为本实施例中,用ZVD整形方法对初步运动规划曲线进行整形的流程示意图;
图5为本实施例中,用于大口径射电望远镜换源的串级避振规划系统构成示意图。
具体实施方式
下面参照附图来描述本发明的优选实施方式。本领域技术人员应当理解的是,这些实施方式仅仅用于解释本发明的技术原理,并非旨在限制本发明的保护范围。
下面以我国建造的500m口径射电望远镜FAST为例,介绍本发明的具体实施方式。
如图1所示,1-索支撑塔,2-驱动索,3-主动反射面,4-馈源接收机,5-馈源焦面,6-反射面支撑,7-换源轨迹。FAST的馈源接收机4在驱动索2的牵引下,沿换源轨迹7由起始点直线运动到目标点,串级避振规划的目的就是生成具有避振功能的换源参考轨迹。
本发明结合了优化S形速度曲线规划与ZVD整形方法,针对大口径射电望远镜的舱-索系统的特性和参数设计了串级避振规划模块,并通过该模块对换源进行运动规划。所述优化S形速度曲线规划能够抑制系统在较广频率范围内的振动,而且对大射电望远镜舱-索系统固有频率附近的振幅抑制作用较为明显;所述ZVD输入整形环节串联在优化S形速度曲线规划环节之后,针对前者无法完全消除的集中于固有频率附近的残余振动有很好的抑制效果;所述ZVD输入整形环节对于固有频率的变化具有较好的鲁棒性,较好的解决了优化S形速度曲线规划环节对于频率变化鲁棒性略差的问题,从而提高整个串级避振规划模块的性能。大口径射电望远镜舱-索系统的阻尼比和固有频率,由系统参数估计器获得。
通用S形速度曲线加减速原理,如图2所示:
从位移起始点到结束点,S形速度曲线分为加速运动阶段、匀速运动阶段、减速运动阶段;配合加速度曲线可以看出,其中,加速运动阶段又分为加速度上升阶段、匀加速(即加速度恒定)阶段、加速度下降阶段;减速运动阶段中,加速度的方向与速度方向相反,又分为加速度上升阶段、匀减速(即加速度恒定)阶段、加速度下降阶段;因此一共有7个阶段。本实施例中,加速阶段和减速阶段的速度曲线、加加速度曲线都是左右对称的,加速度曲线是左右对称而且反向的。
本发明提出的优化S形速度曲线,就是针对加速和减速过程中,对加速度上升阶段的时间和加速度下降阶段的时间取了一个优化的值(也就是下文中即将提到的和),两者的位移、速度、加速度等形状都是类似的。优化的S形速度曲线优点在于能够根据大口径射电望远镜舱-索系统的固有频率来优化加速度的上升时间,从而尽可能减少加减速过程中造成较大的振动幅度。
本实施例的一种用于大口径射电望远镜换源的串级避振规划方法,包括:
步骤S1,依据输入的换源参数,计算初步运动规划曲线,包括换源起点到终点的位移规划曲线以及运动过程中的速度、加速度规划曲线;所述换源参数包括:换源起始点、换源目标点、速度限制、加速度限制、加加速度限制、最大换源时间限制;
步骤S2,基于ZVD整形方法对所述初步运动规划曲线进行整形,得到最终运动规划曲线。
假设给定换源起始点与终点相对于世界坐标系的三维坐标P1(x1,y1,z1)和P2(x2,y2,z2),最大时间限制Tmax,FAST舱-索系统的参数为:固有频率fn=0.18Hz,运动最大速度vmax、最大加速度amax、最大加加速度jmax,如图3所示,步骤S1具体为:
步骤S11,如公式(1)和公式(2)所示,计算参数tr和
其中:tr为加速度上升时间与匀加速时间之和;ωn为系统的振动角频率,ωn=2πfn;fn为大口径射电望远镜舱-索系统的固有频率;mtotal为馈源舱的总质量;Fmax为允许对馈源舱施加的最大合外力;vmax为最大速度;amax为最大加速度;
步骤S12,计算加速阶段的参数:加速总时间tsp、加速度上升时间或加速度下降时间ta、匀加速时间tm;若则转至步骤S13,否则转至步骤S17;其中,jmax为最大加加速度;加速度上升时间与加速度下降时间相等,均为ta;
步骤S13,计算减速阶段的参数:减速总时间t′sp、加速度上升时间或加速度下降时间t′a、匀减速时间t′m;若则转至步骤S14,否则转至步骤S16;其中,加速度上升时间与加速度下降时间相等,均为t′a;
步骤S14,计算匀速运动阶段的时间tconstV;
步骤S15,若tconstV>0且(tconstV+tsp+t′sp)≤Tmax则执行步骤S16,否则执行步骤S17;其中,Tmax为最大时间限制;
步骤S16,求出位移、速度、加速度规划曲线,转至步骤S18;
步骤S17,采用通用S形速度曲线进行规划;
步骤S18,按预设的时间周期对规划曲线进行采样,得到离散化的轨迹点;预设的时间周期与FAST系统的控制周期一致。
本实施例中,所述计算加速阶段的参数,方法为:
计算加速度上升时间与总加速时间的最优比值(加速度上升时间与总加速时间之比,取值范围为0~0.5),通过以下方法确定:
当为整数时,
当不为整数时,如公式(3)所示:
将的取值空间以step为间距进行离散化,针对每个离散值计算对应的a*,选取满足a*为极小值时的其中,step为预设值(可根据实际的精度要求调整step的大小)。
如公式(4)、(5)、(6)所示,分别计算加速总时间tsp、加速度上升时间或加速度下降时间ta、匀加速时间tm:
tm=tsp-2ta (6)
其中,tr为加速度上升时间ta与匀加速时间tm之和,加速度上升时间与加速度下降时间均为ta。
本实施例中,所述计算减速阶段的参数,方法为:
计算加速度上升时间与总减速时间的最优比值
当为整数时,
当不为整数时,如公式(7)所示:
将的取值空间以step为间距进行离散化,针对每个离散值计算对应的a*,选取满足a*取得极小值的其中,step为预设值。
如公式(8)、(9)、(10)所示,分别计算加速总时间t′sp、加速度上升时间或加速度下降时间t′a、匀减速时间t′m:
t′m=t′sp-2t′a (10)
其中,tr为加速度上升时间t′a与匀加速时间t′m之和,加速度上升时间与加速度下降时间均为t′a。
因为减速阶段的曲线与加速阶段是对称反向的,所以有:t′sp=tsp、t′a=ta、t′m=tm。
本实施例中,求匀速运动对应的时间tconstV,方法为:
先求出实际加加速度jre与初始速度ve0(给定为0),如公式(11)、(12)所示:
jre=amax/ta (11)
ve0=0 (12)
计算完整的7段运动过程结束时相应的速度,分别如公式(13)-(19)所示:
ve2=ve1+amax*tm (14)
ve4=ve3 (16)
ve6=ve5-amax*tm (18)
计算完整的7段运动过程结束时相应的位移,分别如公式(20)-(26)所示:
s4=s3+ve4*tconstV (23)
由于匀速运动时间tconstV未知,公式(27)、(28)计算求解。
本实施例中,假设给定FAST舱-索系统的参数:固有频率fn=0.18Hz,阻尼比ξ=0.2%,以这两个系统参数为依据,如图4所示,步骤S2中ZVD输入整形过程具体为:
步骤S21,构造包含三个脉冲的ZVD整形器,如公式(29)所示:
其中,Ai为ZVD整形器的三个脉冲幅值,ti为所述三个脉冲的触发时间,i=1,2,3;ξ为大口径射电望远镜舱-索系统的阻尼比;fn为大口径射电望远镜舱-索系统的固有频率;ξ=0.002,ωn=2πfn=2π×0.18rad/s=1.13rad/s,代入公式(29)得到ZVD整形器三个脉冲参数的具体值,如公式(30)所示:
步骤S22,由于FAST系统的控制周期是200ms,因此对于以上得到的三脉冲ZVD整形器的触发时间,需要将其修改为离它最近的控制采样时间点(即将时间离散化),得到ZVD整形器三个脉冲的参数,如公式(31)所示:
分别将X、Y、Z三个方向的离散位移参考轨迹与ZVD整形器进行卷积,求得整形后的位移、速度、加速度曲线;
步骤S23,判断整形后的运动时间是否小于等于最大时间限制Tmax,若是,则执行步骤S24;否则,转至步骤S25;
步骤S24,输出整形后的轨迹作为最终运动规划曲线;
步骤S25,提示规划失败。
本实施例的一种用于大口径射电望远镜换源的串级避振规划系统,基于上面所述的串级避振规划方法。所述系统主要做了算法、软件层面的改进,其避振思路异于已有硬件阻尼器方案,在降低实施成本等方面具有优势。
本实施例中,如图5所示,串级避振规划系统包括:任务参数指令下达模块、串级避振规划模块、指令分解器、驱动机构、大口径射电望远镜、系统参数估计器。
所述任务参数指令下达模块,将所述换源参数发送给所述串级避振规划模块。
所述串级避振规划模块,包括初步运动曲线规划器和ZVD输入整形器;根据所述换源参数计算所述初步运动规划曲线;对所述初步运动规划曲线进行ZVD整形,得到最终运动规划曲线。
所述指令分解器,根据所述串级避振规划模块输出的最终运动规划曲线,分解出各执行机构的控制指令,并下达到所述驱动机构。
所述驱动机构,根据所述指令分解器下达的控制指令,驱动大口径射电望远镜完成换源任务。
所述系统参数估计器,用于计算大口径射电望远镜舱-索系统的固有频率和阻尼比;所述固有频率和阻尼比用于下一次运动规划曲线计算。
至此,已经结合附图所示的优选实施方式描述了本发明的技术方案,但是,本领域技术人员容易理解的是,本发明的保护范围显然不局限于这些具体实施方式。在不偏离本发明的原理的前提下,本领域技术人员可以对相关技术特征作出等同的更改或替换,这些更改或替换之后的技术方案都将落入本发明的保护范围之内。
Claims (10)
1.一种用于大口径射电望远镜换源的串级避振规划方法,其特征在于,包括:
步骤S1,依据输入的换源参数,计算初步运动规划曲线,包括换源起点到终点的位移规划曲线以及运动过程中的速度、加速度规划曲线;
步骤S2,基于ZVD整形方法对所述初步运动规划曲线进行整形,得到最终运动规划曲线;
其中,
所述换源是指将所述大口径射电望远镜的馈源舱从所述起点移动到所述终点;
步骤S1具体为:
步骤S11,计算参数tr和
其中:tr为加速度上升时间与匀加速时间之和;ωn为系统的振动角频率,ωn=2πfn;fn为大口径射电望远镜舱-索系统的固有频率;mtotal为馈源舱的总质量;Fmax为允许对馈源舱施加的最大合外力;vmax为最大速度;amax为最大加速度;
步骤S12,计算加速阶段的参数:加速总时间tsp、加速度上升时间或加速度下降时间ta、匀加速时间tm;若则转至步骤S13,否则转至步骤S17;其中,jmax为最大加加速度,加速度上升时间与加速度下降时间相等;
步骤S13,计算减速阶段的参数:减速总时间t′sp、加速度上升时间或加速度下降时间t′a、匀减速时间t′m;若则转至步骤S14,否则转至步骤S17;其中,加速度上升时间与加速度下降时间相等;
步骤S14,计算匀速运动阶段的时间TconstV;
步骤S15,若TconstV>0且(TconstV+tsp+t′sp)≤Tmax则执行步骤S16,否则执行步骤S17;其中,Tmax为最大时间限制;
步骤S16,求出位移、速度、加速度规划曲线,转至步骤S18;
步骤S17,采用通用S形速度曲线进行规划;
步骤S18,按预设的时间周期对规划曲线进行采样,得到离散化的轨迹点。
2.根据权利要求1所述的方法,其特征在于,所述计算加速阶段的参数,方法为:
计算加速度上升时间与总加速时间的最优比值
分别计算加速总时间tsp、加速度上升时间或加速度下降时间ta、匀加速时间tm:
tm=tsp-2ta;
其中,tr为加速度上升时间ta与匀加速时间tm之和,加速度上升时间与加速度下降时间均为ta。
3.根据权利要求1所述的方法,其特征在于,所述计算减速阶段的参数,方法为:
计算加速度上升时间与总减速时间的最优比值
分别计算加速总时间t′sp、加速度上升时间或加速度下降时间t′a、匀减速时间t′m:
t′m=t′sp-2t′a;
其中,tr为加速度上升时间t′a与匀加速时间t′m之和,加速度上升时间与加速度下降时间均为t′a。
4.根据权利要求2所述的方法,其特征在于,所述加速度上升时间与总加速时间的最优比值通过以下方法确定:
当为整数时,
当不为整数时,
将的取值空间以step为间距进行离散化,针对每个离散值计算对应的a*,选取满足a*为极小值时的其中,step为预设值。
5.根据权利要求3所述的方法,其特征在于,所述加速度上升时间与总减速时间的最优比值通过以下方法确定:
当为整数时,
当不为整数时,
将的取值空间以step为间距进行离散化,针对每个离散值计算对应的a*,选取满足a*为极小值时的其中,step为预设值。
6.根据权利要求1的方法,其特征在于,步骤S2具体为:
步骤S21,构造包含三个脉冲的ZVD整形器:
其中,Ai为ZVD整形器的三个脉冲幅值,ti为所述三个脉冲的触发时间,i=1,2,3;ξ为大口径射电望远镜舱-索系统的阻尼比;ωn=2πfn,fn为大口径射电望远镜舱-索系统的固有频率;
步骤S22,将ZVD整形器与所述初步运动规划曲线进行卷积,得到X、Y、Z各个坐标轴方向上的运动规划曲线;
步骤S23,判断整形后的运动时间是否小于等于最大时间限制Tmax,若是,则执行步骤S24;否则,转至步骤S25;
步骤S24,输出整形后的轨迹作为最终运动规划曲线;
步骤S25,提示规划失败。
7.根据权利要求6所述的方法,其特征在于,步骤S22具体为:
对ZVD整形器的时间进行离散化操作,将ZVD整形器与步骤S18所得到的离散化轨迹进行卷积操作;所述对ZVD整形器的时间进行离散化操作,按预设的时间周期,将步骤S21所得三个脉冲的触发时间分别修改为距离最近的控制采样时间点。
8.根据权利要求1-7中任一项所述的方法,其特征在于,所述换源参数包括:换源起始点、换源目标点、速度限制、加速度限制、加加速度限制、最大换源时间限制。
9.根据权利要求6所述的方法,其特征在于,所述大口径射电望远镜舱-索系统的阻尼比和所述大口径射电望远镜舱-索系统的固有频率,由系统参数估计器获得。
10.一种用于大口径射电望远镜换源的串级避振规划系统,其特征在于,基于权利要求1-9中任一项所述的串级避振规划方法,包括:任务参数指令下达模块、串级避振规划模块、指令分解器、驱动机构、大口径射电望远镜、系统参数估计器;
所述任务参数指令下达模块,将所述换源参数发送给所述串级避振规划模块;
所述串级避振规划模块,包括初步运动曲线规划器和ZVD输入整形器;根据所述换源参数计算所述初步运动规划曲线;对所述初步运动规划曲线进行ZVD整形,得到最终运动规划曲线;
所述指令分解器,根据所述串级避振规划模块输出的最终运动规划曲线,分解出各执行机构的控制指令,并下达到所述驱动机构;
所述驱动机构,根据所述指令分解器下达的控制指令,驱动大口径射电望远镜完成换源任务;
所述系统参数估计器,用于计算大口径射电望远镜舱-索系统的固有频率和阻尼比;所述固有频率和阻尼比用于下一次运动规划曲线计算。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710453911.3A CN107357325B (zh) | 2017-06-15 | 2017-06-15 | 用于大口径射电望远镜换源的串级避振规划方法与系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710453911.3A CN107357325B (zh) | 2017-06-15 | 2017-06-15 | 用于大口径射电望远镜换源的串级避振规划方法与系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107357325A CN107357325A (zh) | 2017-11-17 |
CN107357325B true CN107357325B (zh) | 2019-09-24 |
Family
ID=60273935
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710453911.3A Active CN107357325B (zh) | 2017-06-15 | 2017-06-15 | 用于大口径射电望远镜换源的串级避振规划方法与系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107357325B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108919652B (zh) * | 2018-10-10 | 2021-07-27 | 北京工商大学 | 一种自适应抗扰整形控制方法与系统 |
CN109669476B (zh) * | 2019-01-25 | 2021-11-09 | 中国科学院国家天文台 | 一种射电望远镜馈源支撑系统的运动规划方法 |
CN109857152B (zh) * | 2019-01-25 | 2022-03-22 | 中国科学院国家天文台 | 一种射电望远镜馈源支撑系统的换源规划方法 |
CN111123974B (zh) * | 2019-12-06 | 2020-12-08 | 中国科学院自动化研究所 | 用于大口径射电望远镜天文跟踪模式的轨迹规划方法 |
CN112597429B (zh) * | 2021-03-04 | 2021-05-25 | 中国科学院自动化研究所 | 大口径射电望远镜运动中扫描模式轨迹规划方法及系统 |
CN113945210A (zh) * | 2021-10-15 | 2022-01-18 | 中国科学院长春光学精密机械与物理研究所 | 地基大口径光学望远镜的快速定位方法、装置及望远镜 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101609341A (zh) * | 2008-06-18 | 2009-12-23 | 中国科学院自动化研究所 | 一种主动隔振控制平台 |
CN103235597A (zh) * | 2013-04-09 | 2013-08-07 | 北京理工大学 | 一种航天器的快速姿态机动快速稳定联合控制方法 |
CN105182742A (zh) * | 2015-07-23 | 2015-12-23 | 北京航空航天大学 | 一种弹性体飞行器自适应受限跟踪控制间接法 |
CN106054605A (zh) * | 2016-06-03 | 2016-10-26 | 广东工业大学 | 基于阻尼衰减的高度精密定位运动规划算法 |
-
2017
- 2017-06-15 CN CN201710453911.3A patent/CN107357325B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101609341A (zh) * | 2008-06-18 | 2009-12-23 | 中国科学院自动化研究所 | 一种主动隔振控制平台 |
CN103235597A (zh) * | 2013-04-09 | 2013-08-07 | 北京理工大学 | 一种航天器的快速姿态机动快速稳定联合控制方法 |
CN105182742A (zh) * | 2015-07-23 | 2015-12-23 | 北京航空航天大学 | 一种弹性体飞行器自适应受限跟踪控制间接法 |
CN106054605A (zh) * | 2016-06-03 | 2016-10-26 | 广东工业大学 | 基于阻尼衰减的高度精密定位运动规划算法 |
Non-Patent Citations (1)
Title |
---|
柔性并联机器人系统的运动规划;王文利等;《西安电子科技大学学报(自然科学版)》;20141231;第41卷(第6期);第126-130页 * |
Also Published As
Publication number | Publication date |
---|---|
CN107357325A (zh) | 2017-11-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107357325B (zh) | 用于大口径射电望远镜换源的串级避振规划方法与系统 | |
US9221175B2 (en) | Method of generating path of multiaxial robot and control apparatus for the multiaxial robot | |
US9242376B2 (en) | Method of generating path of multiaxial robot and control apparatus for the multiaxial robot | |
CN110450156B (zh) | 多自由度机械臂系统自适应模糊控制器的优化设计方法 | |
CN102799146B (zh) | 用于数控设备控制系统的s形加减速控制的速度规划方法 | |
CN103472724B (zh) | 一种用于多自由度并联机构的实时控制动力学建模方法 | |
CN104008250A (zh) | 基于主频能量时域最优分布的非对称变加速度规划方法 | |
Lee | A new approach for the anti-swing control of overhead cranes with high-speed load hoisting | |
Wang et al. | A look-ahead and adaptive speed control algorithm for high-speed CNC equipment | |
CN106325072B (zh) | 一种直线伺服系统机械残余振动控制方法 | |
CN107160394A (zh) | 一种直线运动模组精确控制方法 | |
CN104228887B (zh) | 一种列车自动运行等级实时调整的方法及系统 | |
CN110308699A (zh) | 一种轨迹规划方法 | |
CN110196590A (zh) | 一种用于机器人路径跟踪的时间最优轨迹规划系统及方法 | |
CN110228754B (zh) | 一种自适应速度规划的工业吊车控制方法及系统 | |
CN111158376B (zh) | 松软崎岖地形中摇杆摇臂式星球车轨迹跟踪协调控制方法 | |
CN104281099A (zh) | 一种考虑加工特性的nurbs直接插补方法及装置 | |
CN103279039A (zh) | 一种机器人神经网络式计算力矩控制器训练平台及训练方法 | |
CN101477354A (zh) | 位置s型指令产生方法 | |
CN109683615A (zh) | 机器人连续运动的路径的速度前瞻方法及机器人控制器 | |
Zhong et al. | Design of dual-drive vertical lift servo system and synchronous control performance analysis | |
CN104772755A (zh) | 3-prs并联机构速度优化方法 | |
Yi et al. | Cascade sliding-mode controller for large-scale underactuated systems | |
CN112256028B (zh) | 一种双足机器人柔顺步态控制方法、系统、设备及介质 | |
Ye et al. | Design and simulation of closed loop control system for large precision machining |
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 |