CN113867423B - 一种伺服转台方位角度跟踪控制方法及装置 - Google Patents
一种伺服转台方位角度跟踪控制方法及装置 Download PDFInfo
- Publication number
- CN113867423B CN113867423B CN202111042441.4A CN202111042441A CN113867423B CN 113867423 B CN113867423 B CN 113867423B CN 202111042441 A CN202111042441 A CN 202111042441A CN 113867423 B CN113867423 B CN 113867423B
- Authority
- CN
- China
- Prior art keywords
- turntable
- azimuth angle
- planning
- angular velocity
- omega
- 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 36
- 238000004364 calculation method Methods 0.000 claims description 23
- 230000001133 acceleration Effects 0.000 claims description 18
- 238000013016 damping Methods 0.000 claims description 11
- 230000014509 gene expression Effects 0.000 claims description 7
- 230000009467 reduction Effects 0.000 claims description 7
- 230000008569 process Effects 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 4
- 239000003638 chemical reducing agent Substances 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000010355 oscillation Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D3/00—Control of position or direction
- G05D3/12—Control of position or direction using feedback
- G05D3/20—Control of position or direction using feedback using a digital comparing device
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Control Of Position Or Direction (AREA)
- Variable-Direction Aerials And Aerial Arrays (AREA)
Abstract
本发明提供一种伺服转台方位角度跟踪控制方法及装置。所述方法包括:读取上位控制器发送的转台目标方位角以及角度传感器测得的转台方位角,并预测目标角速度;根据曲线规划算法计算规划角速度和规划方位角;采用前馈微分先行的PD控制算法,基于ωr、θr和θ计算转台控制器输出到电机驱动器的速度值u;电机驱动器根据u对伺服电机进行速度控制。本发明通过采用目标角速度预测、动态曲线规划、前馈微分先行的PD控制算法三者结合的算法,可实现方位角度快速、高精度跟踪,还可以实现高精度复杂信号如正弦信号或三角信号的跟踪。
Description
技术领域
本发明属于伺服控制技术领域,具体涉及一种伺服转台方位角度跟踪控制方法及装置。
背景技术
伺服转台是火炮、雷达天线、光瞄等系统的重要组成部分,它是构成系统自动化体系的基本环节。伺服转台能够为系统提供360°方位角目标跟踪。转台控制系统框图如图2所示,主要由转台控制器、电机驱动器、伺服电机、减速器、转台(回转机构)和角度传感器等组成。转台控制器接收上位控制器的目标方位角度指令后,根据方位测角传感器采集的转台的角度信息,采用一定的控制算法,输出速度指令给电机驱动器;电机驱动器采用速度控制,根据速度指令驱动伺服电机转动,从而带动转台旋转,进而实现方位目标跟踪。
火炮、雷达、光瞄等系统的伺服转台进行方位控制时,先进行大角度调转,实现方位粗对准;然后再进行高精度跟踪。转台方位可实现360°转动,角度转动范围大,上装设备负载重。如果系统指标要求实现大角度快速调转及高精度跟踪,则需要高转速、大转矩、大功率的方位电机及驱动器才能驱动伺服转台实现。而受限于安装体积、质量、供电功率、成本等因素,所选方位电机及驱动器的额定转速、转矩、功率的余量较小,因此对控制算法有较高的要求。传统控制器一般使用PID控制算法,无法同时实现快速、平稳、无超调的阶跃信号跟踪和高精度的正弦信号跟踪。
发明内容
为了解决现有技术中存在的上述问题,本发明提供一种伺服转台方位角度跟踪控制方法及装置。
为了实现上述目的,本发明采用以下技术方案。
第一方面,本发明提供一种伺服转台方位角度跟踪控制方法,包括以下步骤:
读取上位控制器发送的转台目标方位角θT以及角度传感器测得的转台方位角θ,并基于θT预测目标角速度ωT;
根据曲线规划算法,基于θT、ωT计算规划角速度ωr和规划方位角θr;
采用前馈微分先行的PD控制算法,基于ωr、θr和θ计算转台控制器输出到电机驱动器的速度值u;电机驱动器根据u对伺服电机进行速度控制。
进一步地,采用差分计算与一阶低通滤波器结合的方法预测目标角速度ωT,公式为:
ωT[n]=b·ωT[n-1]+(1-b)(θT[n]-θT[n-1])/Ts
式中,n为控制周期序号,n=1,2,…,b=1/(1+Tsωc),Ts为控制周期,ωc为低通滤波器的带宽。
更进一步地,规划角速度ωr和规划方位角θr的计算公式为:
ωr[n]=ωr[n-1]+Tsar[n]
θr[n]=θr[n-1]+Tsωr[n-1]
其中,
ar[n]=sat((ω'r-ωr[n-1])/Ts,am)
ω'r=sat(fik(k)·Ts·sign(e)am+ωT[n],ωm)
e=θT[n]-θr[n-1]-ωr[n-1]Ts
式中,ωm为梯形加减速曲线规划限定的最大角速度,am为加速度绝对值的最大值,fik(·)为向下取整函数,sign(·)为符号函数。
更进一步地,转台控制器输出到电机驱动器的速度值u的计算公式为:
u[n]=Kfωr[n]+Kp(θr[n]-θ[n])-Kd(θ[n]-θ[n-1])/Ts
式中,Kf为前馈增益系数,Kp为反馈比例系数,Kd为反馈微分系数。
更进一步地,所述方法还包括按以下方法选取Kp、Kd,使转台控制闭环系统为输出无超调的临界阻尼系统:
列出转台的简化微分方程:
式中,T为惯性环节时间常数,K为伺服电机减速比;
列出转台控制器输出速度值的连续表达式:
将上式代入转台的简化微分方程,并进行化简后得到:
根据上式得到闭环传递函数的分母特征多项式A(s):
当时,A(s)=(s+ω0)2,其中,/>或/>
由此得到:
第二方面,本发明提供一种伺服转台方位角度跟踪控制装置,包括:
ωT预测模块,用于读取上位控制器发送的转台目标方位角θT以及角度传感器测得的转台方位角θ,并基于θT、θ预测目标角速度ωT;
曲线规划模块,用于根据曲线规划算法,基于θT、ωT计算规划角速度ωr和规划方位角θr;
速度计算模块,用于采用前馈微分先行的PD控制算法,基于ωr、θr和θ计算转台控制器输出到电机驱动器的速度值u;电机驱动器根据u对伺服电机进行速度控制。
进一步地,采用差分计算与一阶低通滤波器结合的方法预测目标角速度ωT,公式为:
ωT[n]=b·ωT[n-1]+(1-b)(θT[n]-θT[n-1])/Ts
式中,n为控制周期序号,n=1,2,…,b=1/(1+Tsωc),Ts为控制周期,ωc为低通滤波器的带宽。
更进一步地,规划角速度ωr和规划方位角θr的计算公式为:
ωr[n]=ωr[n-1]+Tsar[n]
θr[n]=θr[n-1]+Tsωr[n-1]
其中,
ar[n]=sat((ω'r-ωr[n-1])/Ts,am)
ω'r=sat(fik(k)·Ts·sign(e)am+ωT[n],ωm)
e=θT[n]-θr[n-1]-ωr[n-1]Ts
式中,ωm为梯形加减速曲线规划限定的最大角速度,am为加速度绝对值的最大值,fik(·)为向下取整函数,sign(·)为符号函数。
更进一步地,转台控制器输出到电机驱动器的速度值u的计算公式为:
u[n]=Kfωr[n]+Kp(θr[n]-θ[n])-Kd(θ[n]-θ[n-1])/Ts
式中,Kf为前馈增益系数,Kp为反馈比例系数,Kd为反馈微分系数。
更进一步地,所述装置还包括临界阻尼系统配置模块,用于按以下方法选取Kp、Kd,使转台控制闭环系统为输出无超调的临界阻尼系统:
列出转台的简化微分方程:
式中,T为惯性环节时间常数,K为伺服电机减速比;
列出转台控制器输出速度值的连续表达式:
将上式代入转台的简化微分方程,并进行化简后得到:
根据上式得到闭环传递函数的分母特征多项式A(s):
当时,A(s)=(s+ω0)2,其中,/>或/>
由此得到:
与现有技术相比,本发明具有以下有益效果。
本发明通过由转台控制器接收上位控制器发送的转台目标方位角度指令信息和角度传感器测量的转台方位角度测量信息,采用目标角速度预测、动态曲线规划、前馈微分先行的PD控制算法三者结合的算法,可实现方位角度快速、高精度跟踪,还可以实现快速、平稳、无超调的高精度复杂信号(如正弦信号或三角信号)跟踪。
附图说明
图1为本发明实施例一种伺服转台方位角度跟踪控制方法的流程图。
图2为转台控制系统组成框图。
图3为梯形加减速曲线示意图。
图4为一实际的转台方位跟踪曲线。
图5为本发明实施例一种伺服转台方位角度跟踪控制方法装置的方框图。
具体实施方式
为使本发明的目的、技术方案及优点更加清楚、明白,以下结合附图及具体实施方式对本发明作进一步说明。显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
图1为本发明实施例一种伺服转台方位角度跟踪控制方法的流程图,包括以下步骤:
步骤101,读取上位控制器发送的转台目标方位角θT以及角度传感器测得的转台方位角θ,并预测目标角速度ωT;
步骤102,根据曲线规划算法,基于θT、ωT计算规划角速度ωr和规划方位角θr;
步骤103,采用前馈微分先行的PD控制算法,基于ωr、θr和θ计算转台控制器输出到电机驱动器的速度值u;电机驱动器根据u对伺服电机进行速度控制。
本实施例提供一种伺服转台方位角度跟踪控制方法,应用于转台控制系统。转台控制系统的组成框图如图2所示,主要由上位控制器(图2中未画出)、转台控制器、电机驱动器、伺服电机、减速器、转台和角度传感器等组成。转台控制器接收上位控制器发送的目标方位角度指令后,根据测角度传感器输出(反馈)的转台方位角信息,采用一定的控制算法,输出速度指令给电机驱动器;电机驱动器采用速度控制,根据速度指令驱动伺服电机转动,从而带动转台旋转,进而实现方位目标跟踪。
本实施例中,步骤101主要用于预测目标角速度。所述目标角速度是指转台转到目标方位角时或刚对准目标时目标的角速度。为了提高跟踪性能,此时转台的角速度应等于目标的角速度。如果被跟踪的目标处于静止状态(如某一固定建筑物)或相对转台运动的角速度很慢,可以默认目标角速度为0,转台只需以0角速度对准目标方位角,不需要专门对目标角速度进行预测。但是当跟踪对象为角速度较大的动目标时,比如被跟踪目标的方位角按正弦波或三角波变化,再默认目标角速度为0就会使跟踪性能变差,这时就需要预测转台转到目标方位角时目标的角速度,使转台以预测的目标角速度到达目标方位角。本实施例是基于上位控制器发送的目标方位角预测目标角速度,预测方法很多,本实施例对具体的预测方法不做限制,后面将给出一种具体的预测方案。
本实施例中,步骤102主要用于计算规划角速度和规划方位角。在现代运动控制系统中,为减小速度突变,追求更高的控制精度和更好的控制性能,一般采用曲线规划算法控制转台接近目标的速度。最常用的是梯形加减速规划曲线,如图3所示,先从静止开始恒加速运动一段时间达到最高速度,然后再保持最高速度匀速运动一段时间,最后恒减速运动一段时间直至速度为0。这种规划方法没有考虑目标角速度或默认目标角速度为0,只适用静止或运动速度很慢的目标。为此,本实施例以预测的目标角速度为恒减速运动阶段的最终速度。因此,本实施例基于目标方位角θT和目标角速度ωT计算规划角速度ωr和规划方位角θr。由于目标角速度是随时间变化的,因此本实施例的曲线规划又称为动态规划。值得说明的是,本实施例并不限于采用常规的梯形加减速规划曲线,还可以采用其它规划曲线,唯一的限制是转台转至目标方位角时的角速度为预测的目标角速度ωT。值得说明的是,曲线规划一般只用于目标方位角较大需要大角度转动转台的情况(比如雷达天线的搜索状态);一旦转台达目标方位角位置(捕捉到目标)进入跟踪状态,只需根据目标的运动状态实时微调转台的运动状态即可,而不会再按梯形加减速规划曲线得到的方位角和角速度去跟踪目标,或者说规划方位角和角速度就取目标方位角和预测的目标角速度。
本实施例中,步骤103主要用于计算转台控制器输出到电机驱动器的速度值u。传统的转台控制器一般采用PID控制算法,控制性能较差。本实施例采用前馈+微分先行的PD控制算法,该算法为二自由度控制器,可任意配置系统的零点和极点。根据该算法得到的速度值u包括前馈增益、反馈比例和反馈微分三部分。前馈增益与规划角速度ωr成正比,设置前馈增益可减小复杂信号跟踪的相位滞后。后面将给出速度值u的一种具体的计算方法。转台控制器将速度值u以速度指令的形式输出到电机驱动器,电机驱动器对伺服电机进行速度驱动,从而实现快速、高精度的目标跟踪。
作为一可选实施例,采用差分计算与一阶低通滤波器结合的方法预测目标角速度ωT,公式为:
ωT[n]=b·ωT[n-1]+(1-b)(θT[n]-θT[n-1])/Ts
式中,n为控制周期序号,n=1,2,…,b=1/(1+Tsωc),Ts为控制周期,ωc为低通滤波器的带宽。
本实施例给出了目标角速度的一种预测方法。本实施例采用采用差分计算与一阶低通滤波器结合的方法计算目标角速度,具体公式如上式。由于计算机只能进行离散控制,因此上式是基于控制周期Ts给出的离散公式,也是递推公式,目标角速度的初始值ωT[0]=0。一阶低通滤波器由软件实现,可以降低硬件成本。设置低通滤波器的目的是为了防止目标方位角度有较大的快速、突变。低通滤波器的带宽ωc的一般取值为被跟踪方位角变化角频率(如正弦波角频率)的20~50倍,跟踪误差指标要求误差越小,带宽取值越大。为了提高跟踪精度,控制周期Ts一般越小越好,其最小值可根据转台控制器CPU的性能确定。
作为一可选实施例,规划角速度ωr和规划方位角θr的计算公式为:
ωr[n]=ωr[n-1]+Tsar[n]
θr[n]=θr[n-1]+Tsωr[n-1]
其中,
ar[n]=sat((ω'r-ωr[n-1])/Ts,am)
ω'r=sat(fik(k)·Ts·sign(e)am+ωT[n],ωm)
e=θT[n]-θr[n-1]-ωr[n-1]Ts
式中,ωm为梯形加减速曲线规划限定的最大角速度,am为加速度绝对值的最大值,fik(·)为向下取整函数,sign(·)为符号函数。
本实施例给出了计算规划角速度和规划方位角的一种技术方案。本实施例仍然采用图3所示的梯形加减速规划曲线,所不同的是恒减速阶段的最终角速度不是0,而是预测的目标角速度ωT[n]。上面的公式是基于运动学原理得到的,其推导过程可参考申请号为201711192155.X、名称为“一种运动曲线离散动态规划方法”的发明专利说明书,这里不再详细介绍。
作为一可选实施例,转台控制器输出到电机驱动器的速度值u的计算公式为:
u[n]=Kfωr[n]+Kp(θr[n]-θ[n])-Kd(θ[n]-θ[n-1])/Ts
式中,Kf为前馈增益系数,Kp为反馈比例系数,Kd为反馈微分系数。
本实施例给出了计算速度值u的一种技术方案。如前述,本实施例采用前馈+微分先行的PD控制算法,转台控制器的连续算法表示如下:
对其进行离散化后得到上面u[n]的离散表达式。u[n]是前馈增益、反馈比例和反馈微分三部分的和,Kf为前馈增益系数,Kp为反馈比例系数,Kd为反馈微分系数。
作为一可选实施例,所述方法还包括按以下方法选取Kp、Kd,使转台控制闭环系统为输出无超调的临界阻尼系统:
列出转台的简化微分方程:
式中,T为惯性环节时间常数,K为伺服电机减速比;
列出转台控制器输出速度值的连续表达式:
将上式代入转台的简化微分方程,并进行化简后得到:
根据上式得到闭环传递函数的分母特征多项式A(s):
当时,A(s)=(s+ω0)2,其中,/>或/>
由此得到:
本实施例给出了通过选取Kp、Kd,使转台控制闭环系统为输出无超调的临界阻尼系统的一种技术方案。本实施例通过推导转台控制闭环系统传递函数,选取合适的Kp、Kd,对其分母特征多项式(一元二次多项式)进行配方,使其成为一个完全平方式,即分母特征多项式有重根或重极点,从而将闭环控制系统配置为临界阻尼系统,输出无超调。上式中的ω0为自由振荡角频率,目标跟踪性能ω0确定,ω0越大,系统响应越快,性能越好。
为验证本发明跟踪方法的有效性,下面给出本发明的一种具体应用实例。伺服电机额定转速为4000rpm(66.7rps),减速器减速比K=1/350,速度环带宽为50rad(即惯性环节时间常数T=0.02s)。转台控制器的控制周期为Ts=3ms,角速度预测算法中低通滤波器的带宽ωc=33.3,曲线规划最大角速度ωm=70°/s、角加速度绝对值最大值am=150°/s2;PD控制器中取角频率ω0=100,计算得Kp=70000,Kd=1050,Kf=700。转台跟踪曲线如图4所示,方位90°调转时间小于1.8s,跟踪平稳无超调,正弦跟踪误差小于≤0.2°。实验表明,本发明算法可同时实现快速无超调的阶跃信号跟踪和高精度的正弦信号跟踪。
图5为本发明实施例一种伺服转台方位角度跟踪控制装置的组成示意图,所述装置包括:
ωT预测模块11,用于读取上位控制器发送的转台目标方位角θT以及角度传感器测得的转台方位角θ,并基于θT预测目标角速度ωT;
曲线规划模块12,用于根据曲线规划算法,基于θT、ωT计算规划角速度ωr和规划方位角θr;
速度计算模块13,用于采用前馈微分先行的PD控制算法,基于ωr、θr和θ计算转台控制器输出到电机驱动器的速度值u;电机驱动器根据u对伺服电机进行速度控制。
本实施例的装置,可以用于执行图1所示方法实施例的技术方案,其实现原理和技术效果类似,此处不再赘述。后面的实施例也是如此,均不再展开说明。
作为一可选实施例,采用差分计算与一阶低通滤波器结合的方法预测目标角速度ωT,公式为:
ωT[n]=b·ωT[n-1]+(1-b)(θT[n]-θT[n-1])/Ts
式中,n为控制周期序号,n=1,2,…,b=1/(1+Tsωc),Ts为控制周期,ωc为低通滤波器的带宽。
作为一可选实施例,规划角速度ωr和规划方位角θr的计算公式为:
ωr[n]=ωr[n-1]+Tsar[n]
θr[n]=θr[n-1]+Tsωr[n-1]
其中,
ar[n]=sat((ω'r-ωr[n-1])/Ts,am)
ω'r=sat(fik(k)·Ts·sign(e)am+ωT[n],ωm)
e=θT[n]-θr[n-1]-ωr[n-1]Ts
式中,ωm为梯形加减速曲线规划限定的最大角速度,am为加速度绝对值的最大值,fik(·)为向下取整函数,sign(·)为符号函数。
作为一可选实施例,转台控制器输出到电机驱动器的速度值u的计算公式为:
u[n]=Kfωr[n]+Kp(θr[n]-θ[n])-Kd(θ[n]-θ[n-1])/Ts
式中,Kf为前馈增益系数,Kp为反馈比例系数,Kd为反馈微分系数。
作为一可选实施例,所述装置还包括临界阻尼系统配置模块,用于按以下方法选取Kp、Kd,使转台控制闭环系统为输出无超调的临界阻尼系统:
列出转台的简化微分方程:
式中,T为惯性环节时间常数,K为伺服电机减速比;
列出转台控制器输出速度值的连续表达式:
将上式代入转台的简化微分方程,并进行化简后得到:
根据上式得到闭环传递函数的分母特征多项式A(s):
当时,A(s)=(s+ω0)2,其中,/>或/>
由此得到:
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应以权利要求的保护范围为准。
Claims (6)
1.一种伺服转台方位角度跟踪控制方法,其特征在于,包括以下步骤:
读取上位控制器发送的转台目标方位角θT以及角度传感器测得的转台方位角θ,并基于θT预测目标角速度ωT;
根据曲线规划算法,基于θT、ωT计算规划角速度ωr和规划方位角θr;
采用前馈微分先行的PD控制算法,基于ωr、θr和θ计算转台控制器输出到电机驱动器的速度值u;电机驱动器根据u对伺服电机进行速度控制;
采用差分计算与一阶低通滤波器结合的方法预测目标角速度ωT,公式为:
ωT[n]=b·ωT[n-1]+(1-b)(θT[n]-θT[n-1])/Ts
式中,n为控制周期序号,n=1,2,…,b=1/(1+Tsωc),Ts为控制周期,ωc为低通滤波器的带宽;
规划角速度ωr和规划方位角θr的计算公式为:
ωr[n]=ωr[n-1]+Tsar[n]
θr[n]=θr[n-1]+Tsωr[n-1]
其中,
e=θT[n]-θr[n-1]-ωr[n-1]Ts
式中,ωm为梯形加减速曲线规划限定的最大角速度,am为加速度绝对值的最大值,fik(·)为向下取整函数,sign(·)为符号函数。
2.根据权利要求1所述的伺服转台方位角度跟踪控制方法,其特征在于,转台控制器输出到电机驱动器的速度值u的计算公式为:
u[n]=Kfωr[n]+Kp(θr[n]-θ[n])-Kd(θ[n]-θ[n-1])/Ts
式中,Kf为前馈增益系数,Kp为反馈比例系数,Kd为反馈微分系数。
3.根据权利要求2所述的伺服转台方位角度跟踪控制方法,其特征在于,所述方法还包括按以下方法选取Kp、Kd,使转台控制闭环系统为输出无超调的临界阻尼系统:
列出转台的简化微分方程:
式中,T为惯性环节时间常数,K为伺服电机减速比;
列出转台控制器输出速度值的连续表达式:
将上式代入转台的简化微分方程,并进行化简后得到:
根据上式得到闭环传递函数的分母特征多项式A(s):
当时,A(s)=(s+ω0)2,其中,/>或/>
由此得到:
4.一种伺服转台方位角度跟踪控制装置,其特征在于,包括:
ωT预测模块,用于读取上位控制器发送的转台目标方位角θT以及角度传感器测得的转台方位角θ,并基于θT预测目标角速度ωT;
曲线规划模块,用于根据曲线规划算法,基于θT、ωT计算规划角速度ωr和规划方位角θr;
速度计算模块,用于采用前馈微分先行的PD控制算法,基于ωr、θr和θ计算转台控制器输出到电机驱动器的速度值u;电机驱动器根据u对伺服电机进行速度控制;
采用差分计算与一阶低通滤波器结合的方法预测目标角速度ωT,公式为:
ωT[n]=b·ωT[n-1]+(1-b)(θT[n]-θT[n-1])/Ts
式中,n为控制周期序号,n=1,2,…,b=1/(1+Tsωc),Ts为控制周期,ωc为低通滤波器的带宽;
规划角速度ωr和规划方位角θr的计算公式为:
ωr[n]=ωr[n-1]+Tsar[n]
θr[n]=θr[n-1]+Tsωr[n-1]
其中,
e=θT[n]-θr[n-1]-ωr[n-1]Ts
式中,ωm为梯形加减速曲线规划限定的最大角速度,am为加速度绝对值的最大值,fik(·)为向下取整函数,sign(·)为符号函数。
5.根据权利要求4所述的伺服转台方位角度跟踪控制装置,其特征在于,转台控制器输出到电机驱动器的速度值u的计算公式为:
u[n]=Kfωr[n]+Kp(θr[n]-θ[n])-Kd(θ[n]-θ[n-1])/Ts
式中,Kf为前馈增益系数,Kp为反馈比例系数,Kd为反馈微分系数。
6.根据权利要求5所述的伺服转台方位角度跟踪控制装置,其特征在于,所述装置还包括临界阻尼系统配置模块,用于按以下方法选取Kp、Kd,使转台控制闭环系统为输出无超调的临界阻尼系统:
列出转台的简化微分方程:
式中,T为惯性环节时间常数,K为伺服电机减速比;
列出转台控制器输出速度值的连续表达式:
将上式代入转台的简化微分方程,并进行化简后得到:
根据上式得到闭环传递函数的分母特征多项式A(s):
当时,A(s)=(s+ω0)2,其中,/>或/>
由此得到:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111042441.4A CN113867423B (zh) | 2021-09-07 | 2021-09-07 | 一种伺服转台方位角度跟踪控制方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111042441.4A CN113867423B (zh) | 2021-09-07 | 2021-09-07 | 一种伺服转台方位角度跟踪控制方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113867423A CN113867423A (zh) | 2021-12-31 |
CN113867423B true CN113867423B (zh) | 2023-12-19 |
Family
ID=78989832
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111042441.4A Active CN113867423B (zh) | 2021-09-07 | 2021-09-07 | 一种伺服转台方位角度跟踪控制方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113867423B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117074798B (zh) * | 2023-08-11 | 2024-05-17 | 河北斐然科技有限公司 | 一种应用于导航功能飞行器的卫星天线测试转台 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005181149A (ja) * | 2003-12-19 | 2005-07-07 | Mitsubishi Electric Corp | 衛星追尾用アンテナ制御装置 |
CN103728923A (zh) * | 2013-12-24 | 2014-04-16 | 嘉兴学院 | 一种高效高平稳的数控系统柔性加减速控制方法 |
CN104199465A (zh) * | 2014-07-16 | 2014-12-10 | 北京遥测技术研究所 | 一种高集成化高精度平板自跟踪天线伺服控制系统 |
CN107844058A (zh) * | 2017-11-24 | 2018-03-27 | 北京特种机械研究所 | 一种运动曲线离散动态规划方法 |
CN109901518A (zh) * | 2019-02-28 | 2019-06-18 | 清华大学 | 一种恒力约束条件下的数控机床加减速速度规划方法 |
CN110794878A (zh) * | 2019-11-19 | 2020-02-14 | 北京特种机械研究所 | 一种随动系统俯仰角度跟踪控制方法 |
CN110879568A (zh) * | 2019-12-31 | 2020-03-13 | 南京工程学院 | 多轴联动经济型数控系统的运动控制方法 |
CN112234904A (zh) * | 2020-09-30 | 2021-01-15 | 北京特种机械研究所 | 一种伺服电机速度控制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4483314B2 (ja) * | 2004-01-28 | 2010-06-16 | 株式会社安川電機 | サーボ制御装置 |
-
2021
- 2021-09-07 CN CN202111042441.4A patent/CN113867423B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005181149A (ja) * | 2003-12-19 | 2005-07-07 | Mitsubishi Electric Corp | 衛星追尾用アンテナ制御装置 |
CN103728923A (zh) * | 2013-12-24 | 2014-04-16 | 嘉兴学院 | 一种高效高平稳的数控系统柔性加减速控制方法 |
CN104199465A (zh) * | 2014-07-16 | 2014-12-10 | 北京遥测技术研究所 | 一种高集成化高精度平板自跟踪天线伺服控制系统 |
CN107844058A (zh) * | 2017-11-24 | 2018-03-27 | 北京特种机械研究所 | 一种运动曲线离散动态规划方法 |
CN109901518A (zh) * | 2019-02-28 | 2019-06-18 | 清华大学 | 一种恒力约束条件下的数控机床加减速速度规划方法 |
CN110794878A (zh) * | 2019-11-19 | 2020-02-14 | 北京特种机械研究所 | 一种随动系统俯仰角度跟踪控制方法 |
CN110879568A (zh) * | 2019-12-31 | 2020-03-13 | 南京工程学院 | 多轴联动经济型数控系统的运动控制方法 |
CN112234904A (zh) * | 2020-09-30 | 2021-01-15 | 北京特种机械研究所 | 一种伺服电机速度控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113867423A (zh) | 2021-12-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104656666B (zh) | 针对空间非合作目标的相对轨道设计及高精度姿态指向控制方法 | |
CN108536014B (zh) | 一种考虑飞轮动态特性的航天器姿态规避的模型预测控制方法 | |
CN108919841A (zh) | 一种光电跟踪系统的复合轴控制方法及系统 | |
US11838636B2 (en) | Method for compensating for visual-measurement time lag of electro-optical tracking system | |
CN113867423B (zh) | 一种伺服转台方位角度跟踪控制方法及装置 | |
US6609037B1 (en) | Gimbal pointing vector stabilization control system and method | |
CN112549030B (zh) | 一种基于抗干扰滤波的空间机械臂柔性关节位姿估计方法 | |
CN111665872B (zh) | 基于等效变换的两轴两框架稳定控制方法 | |
Wang et al. | Study on application of model reference adaptive control in fast steering mirror system | |
CN101299148A (zh) | 三轴精密角运动控制方法 | |
CN108107738A (zh) | 变采样率非线性驱动惯性稳定跟踪控制系统及方法 | |
CN110556630B (zh) | 一种异型天线罩瞄准线误差补偿方法 | |
CN109683468B (zh) | 一种基于系统辨识建立两轴云台控制系统的方法 | |
Duan et al. | Pointing control design based on the PID type-III control loop for two-axis gimbal systems | |
CN110501899A (zh) | 一种基于遗传算法参数自整定的pid随动控制方法 | |
Bansal et al. | Comparison of different controllers for line-of-sight stabilization of a gimbal system | |
Ansari et al. | Improved scheme for quick positioning of dual gimbal sight | |
Zhang et al. | Experimental validation and analysis of hybrid adaptive iterative learning sliding mode control for PMSM seeker coordinator | |
CN115421391B (zh) | 光电跟踪转台的反步滑模控制方法 | |
Kim et al. | Tracking control for electro-optical system in vibration enviroment based on self-tuning fuzzy sliding mode control | |
CN111487860B (zh) | 大惯量低速负载的高精度转速控制方法 | |
CN114325683B (zh) | 一种船载光电吊舱和雷达协同目标跟踪方法 | |
JPH10132497A (ja) | 誘導制御装置 | |
Song et al. | Adaptive robust control for mirror-stabilized platform with input saturation | |
Chen et al. | Image Servo Control using a Two-Dimensional Deflection Mirror for Sun Tracking |
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 |