CN108089444B - 一种基于修正参考模型的双轴转台同步控制方法 - Google Patents
一种基于修正参考模型的双轴转台同步控制方法 Download PDFInfo
- Publication number
- CN108089444B CN108089444B CN201711366514.9A CN201711366514A CN108089444B CN 108089444 B CN108089444 B CN 108089444B CN 201711366514 A CN201711366514 A CN 201711366514A CN 108089444 B CN108089444 B CN 108089444B
- Authority
- CN
- China
- Prior art keywords
- axis
- theta
- synchronous control
- control method
- shaft
- 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
Images
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
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- 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
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/048—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators using a predictor
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position Or Direction (AREA)
- Feedback Control In General (AREA)
Abstract
Description
技术领域
本发明属于双轴转台同步控制技术领域,特别是涉及一种基于修正参考模型的双轴转台同步控制方法。
背景技术
转台是惯导测试和运动仿真中的重要实验设备。转台以绕轴线的回转运动为特点,可以提供一个或多个运动自由度。双轴转台可以提供两个运动自由度。在一些特殊的工作条件需求下,需要使两轴以一定精度保持同步运动。例如一种特殊的双轴转台,双轴精密离心机,为保证被测负载相对惯性空间指向不变的特殊需求,需要回转轴完全抵消主轴的转动,即实现两轴的高精度同步运动。
同步控制是一种常用工控技术,就是通过采用适当控制方法调节两个或多个被控对象输出,使其误差保持在一定精度范围内。从控制设计角度来说,常用的同步控制方法包括并联同步控制方法、串联同步控制方法、串并联混合同步控制方法以及交叉耦合同步控制方法。并联同步控制方法是两个对象分别控制,通过输入相同指令实现同步;串联同步控制方法利用各被控对象特性的差异,将一个被控对象的输出作为另一个被控对象的指令输入;定参数的串并联混合同步控制方法通过将并联同步控制方法和串联同步控制方法相结合消除同步误差;交叉耦合同步控制方法将同步误差作为反馈量进行设计,通过调节各回路控制参数,实现同步效果。现有同步控制方法或同步误差大,或动态性能差,或设计较为复杂。
发明内容
本发明为了解决现有的同步控制方法或同步误差大,或动态性能差,或设计较为复杂的技术问题,而提出的一种基于修正参考模型的双轴转台同步控制方法。
本发明的目的通过以下技术方案实现:一种基于修正参考模型的双轴转台同步控制方法,包括以下步骤:
步骤3、根据步骤2得到的轴数学模型,在计算机中建立轴的闭环数学模型,根据该闭环数学模型对输入指令θc(t)的跟踪误差e2m(t)和轴对输入指令θc′(t)的跟踪误差e2(t),拟合修正环节函数其中,θc(t)为ψ轴输入角位置指令,θc′(t)为轴输入角位置指令;
步骤4、根据ψ轴对输入指令θc(t)的跟踪误差e1(t)和修正的跟踪误差e2′m(t),求取加权系数对输入到ψ轴的指令信号θc(t)以α(t)进行加权,求两时变信号乘积为α(t)θc(t);对ψ轴的输出信号θ1(t)以1-α(t)进行加权,求其乘积为(1-α(t))θ1(t);将两个加权过的信号进行求和,作为输入到轴上的指令信号,即
θc′(t)=α(t)θc(t)+(1-α(t))θ1(t);
进一步地,所述步骤1具体为:利用经典的频域法,基于被控对象特性分别设计两轴控制器;测试两轴包含控制器在内的开环系统频率响应特性,比较两轴低频增益和带宽,选定跟踪性能较好的作为轴,跟踪性能较差的作为ψ轴,将两系统闭环。
进一步地,所述根据该闭环数学模型对输入指令θc(t)的跟踪误差e2m(t)和轴对输入指令θc′(t)的跟踪误差e2(t),拟合修正环节函数具体为:串联一个修正环节A(t),使得修正的跟踪误差e′2m(t)与轴对输入指令θc′(t)的跟踪误差e2(t)相等,即e2′m(t)=e2(t)=A(t)e2m(t);根据修正环节A(t)与对应的轴转速采用最小二乘法进行拟合,得到A(t)关于转速的函数关系
已有的同步控制方法,或难以消除同步误差,或对速度变化的指令信号的同步控制效果较差,或结构与设计过程较为复杂。本发明利用双轴转台的实时跟踪误差修正轴的参考输入,可以自适应地调节控制环节参数,使双轴转台系统具有动态调节能力,能够有效地降低同步跟踪误差,且结构简单、易于工程实现。
附图说明
图1为基于修正参考模型的双轴转台同步控制方法流程图;
图2本发明修正模型参数计算的基本框图;
图3为本发明同步控制部分的基本框图;
图4A为转台主轴的开环频率特性测量结果;
图4B为转台俯仰轴的开环频率特性测量结果;
图6为修正函数的测定及拟合图像;
图7A为执行最大速度为45deg/s,加速段加速度为50deg/s2,减速段为-50deg/s2的加速—匀速—减速指令(共计60s)时不同方法的同步误差实验曲线图;
图7B为执行速度变化为20deg/s—80deg/s—40deg/s(各阶段均为15s),加速段加速度为40deg/s2,减速段加速度为-40deg/s2的变速指令时,不同方法的同步误差实验曲线图。
具体实施方式
下面将结合本发明实施例中的附图对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
结合图1,一种基于修正参考模型的双轴转台同步控制方法,包括以下步骤:
步骤1、基于经典的频域法,分别设计转台两轴控制器并比较其响应效果,根据比较得出的响应效果,选定跟踪性能较好的作为轴,跟踪性能较差的作为ψ轴;所述步骤1具体为:利用经典的频域法,基于被控对象特性分别设计两轴控制器;测试两轴包含控制器在内的开环系统频率响应特性,比较两轴低频增益和带宽,选定跟踪性能较好的作为轴,跟踪性能较差的作为ψ轴,将两系统闭环。
结合图2,图中符号表示加法器,t为时间变量,s为拉普拉斯算子。θc(t)为输入角位置指令。KG2(s)为轴的实际对象传递函数,KG2m(s)为建立的轴模型传递函数。e2(t)为轴对输入指令θc(t)的跟踪误差,e2m(t)为轴模型对输入指令θc(t)的跟踪误差。f1为在线计算两输入变量比值的函数,A(t)为修正环节即两输入的比值。
步骤3、根据步骤2得到的轴数学模型,在计算机中建立轴的闭环数学模型,根据该闭环数学模型对输入指令θc(t)的跟踪误差e2m(t)和轴对输入指令θc′(t)的跟踪误差e2(t),拟合修正环节函数其中,θc(t)为ψ轴输入角位置指令,θc′(t)为轴输入角位置指令;所述根据该闭环数学模型对输入指令θc(t)的跟踪误差e2m(t)和轴对输入指令θc′(t)的跟踪误差e2(t),拟合修正环节函数具体为:串联一个修正环节A(t),使得修正的跟踪误差e′2m(t)与轴对输入指令θc′(t)的跟踪误差e2(t)相等,即e2′m(t)=e2(t)=A(t)e2m(t);根据修正环节A(t)与对应的轴转速采用最小二乘法进行拟合,得到A(t)关于转速的函数关系
结合图3,图中符号表示加法器,t为时间变量,s为拉普拉斯算子。θc(t)为ψ轴输入角位置指令,θc′(t)为轴的输入角位置指令。θ1(t)和θ2(t)分别为ψ轴和轴的输出角位置。KG1(s)和KG2(s)分别为ψ轴和轴的实际对象传递函数,KG2m(s)为建立的轴模型传递函数。为模型误差的修正函数。e1(t)为ψ轴对输入指令θc(t)的跟踪误差,e2(t)为轴对输入指令θc′(t)的跟踪误差,e2m(t)为轴模型对输入指令θc(t)的跟踪误差,e2′m(t)为修正的跟踪误差。α(t)为控制方法中用到的加权系数。f1为在线计算两输入变量比值的函数,f2和f3为控制方法中的在线加权计算函数。Δθ(t)为同步误差。
步骤4、根据ψ轴对输入指令θc(t)的跟踪误差e1(t)和修正的跟踪误差e2′m(t),求取加权系数α(t),对输入到ψ轴的指令信号θc(t)以α(t)进行加权,求两时变信号乘积为α(t)θc(t);对ψ轴的输出信号θ1(t)以1-α(t)进行加权,求其乘积为(1-α(t))θ1(t);将两个加权过的信号进行求和,作为输入到轴上的指令信号,即
θc′(t)=α(t)θc(t)+(1-α(t))θ1(t);
以具备主轴和俯仰轴的双轴转台为例,实施本发明基于修正参考模型的同步控制方法。具体实施例为:
第一步、利用频域法,基于被控对象特性分别设计转台两轴控制器。测试两轴包含控制器在内的开环系统频率响应特性,如图4A和图4B所示,图中“+”点表示测定的带串联校正环节的转台对特定频率信号响应,其中横轴为输入信号的角频率(Frequency,单位:rad/s),纵轴分别为输出信号的幅值(Magnitude,单位:dB)和输出信号的相位(Phase,单位:deg)。通过比较可知,转台俯仰轴低频增益和带宽较小,即稳态误差较大、动态性能较差。因此,选定转台主轴作为轴,选定俯仰轴作为ψ轴,并将两系统闭环。
对比该拟合结果与实验结果,如图5所示,通过比较可知,拟合结果在中低频段与实验曲线符合程度很高,因此可以用作系统模型。图中“+”点表示测定的带串联校正的转台对特定频率信号响应,实线表示拟合的对象的特性。其中横轴为角频率(Frequency,单位:rad/s),纵轴分别为幅值(Magnitude,单位:dB)和相位(Phase,单位:deg)。
第三步、根据图2所示框图,采用最小二乘法拟合得到修正环节如下:
测量结果和拟合结果如图6所示,通过图6可知,拟合曲线与测量结果符合程度较高,因此可以用作模型稳态误差的修正环节。图中“+”点表示实验测定结果,实线表示拟合的函数。其中横轴为指令速度(Command Speed,单位:deg/s),纵轴表示离线计算求得的轴实际跟踪误差与模型跟踪误差的比值(Error Ratio,无单位)。
第四步、根据图2所示框图,基于修正参考模型,设计同步控制器。
第五步、进行同步控制效果检验。以该转台为例,分别采用串联同步控制方法、并联同步控制方法和本发明方法进行实验,比较三种方法所得同步误差曲线,实验过程中以速度指令0deg/s伺服2s后开始执行。图7A和图7B中横轴为时间(Time,单位:s),纵轴为同步误差(Error,单位:deg);点线为并联同步方法的同步误差,虚线为串联方法的同步误差,实线为本发明的基于修正模型的双轴转台同步控制方法实现的同步误差。从图7A和图7B可以看出,采用本发明给出的同步控制方法,可以保证转台两轴运动在稳态和动态变化过程中,其同步误差都有明显的降低,且优于当前广泛使用的并联和串联同步控制方法,这与本发明的预期目标一致。由图7A和图7B可知,本发明方法相对于串联同步控制方法和并联同步控制方法,具有同步误差小的优势;相对于并联同步控制方法,有动态响应更好的优势。
本发明首先通过实验比较转台两轴对同一参考信号的跟踪误差及响应速度;对跟踪性能较好的一个轴(轴)进行建模并修正,利用该修正模型实时估计该轴对参考信号的跟踪误差;通过实时获取另一个跟踪性能较差的轴(ψ轴)对同一信号的跟踪误差,计算加权系数;最后,利用ψ轴的输入信号、位置输出和该加权系数,计算获取最终输入到轴上的参考信号。本发明解决了双轴转台在应用中的同步控制问题。本发明相对于现有的并联和串联同步控制方法,具有同步误差小的优势;相对于传统的定参数串并联混合同步控制方法,具有调节动态误差的能力,有响应更快更好的优势;相对于交叉耦合同步控制方法,有设计简单的优势。
以上对本发明所提供的一种基于修正参考模型的双轴转台同步控制方法,进行了详细介绍,本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处,综上所述,本说明书内容不应理解为对本发明的限制。
Claims (4)
1.一种基于修正参考模型的双轴转台同步控制方法,其特征在于:包括以下步骤:
步骤3、根据步骤2得到的轴数学模型,在计算机中建立轴的闭环数学模型,根据该闭环数学模型对输入指令θc(t)的跟踪误差e2m(t)和轴对输入指令θc′(t)的跟踪误差e2(t),拟合修正环节函数其中,θc(t)为ψ轴输入角位置指令,θc′(t)为轴输入角位置指令;
步骤4、根据ψ轴对输入指令θc(t)的跟踪误差e1(t)和修正的跟踪误差e2m′(t),求取加权系数α(t),ψ轴的输入指令θc(t)以α(t)进行加权,求两时变信号乘积为α(t)θc(t);对ψ轴的输出信号θ1(t)以1-α(t)进行加权,求其乘积为(1-α(t))θ1(t);将两个加权过的信号进行求和,作为轴的输入指令,即
θc′(t)=α(t)θc(t)+(1-α(t))θ1(t);
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711366514.9A CN108089444B (zh) | 2017-12-18 | 2017-12-18 | 一种基于修正参考模型的双轴转台同步控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711366514.9A CN108089444B (zh) | 2017-12-18 | 2017-12-18 | 一种基于修正参考模型的双轴转台同步控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108089444A CN108089444A (zh) | 2018-05-29 |
CN108089444B true CN108089444B (zh) | 2020-07-14 |
Family
ID=62177094
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711366514.9A Active CN108089444B (zh) | 2017-12-18 | 2017-12-18 | 一种基于修正参考模型的双轴转台同步控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108089444B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108762090B (zh) * | 2018-06-22 | 2021-04-02 | 哈尔滨工业大学 | 基于动态误差系数的多轴系伺服系统同步控制方法 |
CN109031950B (zh) * | 2018-07-12 | 2021-06-29 | 中国人民解放军军事科学院国防科技创新研究院 | 基于俯仰角反转和角度平滑的跟踪转台程序导引过顶方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003044144A (ja) * | 2001-08-02 | 2003-02-14 | Nissan Motor Co Ltd | 多軸同期制御装置、多軸同期制御方法および多軸同期制御プログラム |
CN101261737A (zh) * | 2008-01-04 | 2008-09-10 | 中国科学院光电技术研究所 | 数字航测相机的二维标定装置及其标定方法 |
CN103776365A (zh) * | 2014-02-14 | 2014-05-07 | 哈尔滨工业大学 | 基于径向与轴向基准的航空发动机多轴转子装配方法与装置 |
CN104571142A (zh) * | 2014-12-01 | 2015-04-29 | 中国科学院合肥物质科学研究院 | 一种大气参数跟踪测量系统 |
CN104932251A (zh) * | 2015-05-28 | 2015-09-23 | 北京空间机电研究所 | 一种用于空间光学遥感器随动系统的同步控制方法 |
CN105423997A (zh) * | 2015-12-22 | 2016-03-23 | 中国科学院长春光学精密机械与物理研究所 | 垂直平面驱动经纬仪 |
CN106681150A (zh) * | 2017-01-19 | 2017-05-17 | 华侨大学 | 基于闭环参考模型的分数阶pid控制器参数优化整定方法 |
CN107093970A (zh) * | 2017-06-23 | 2017-08-25 | 华中科技大学 | 一种无位置传感器的永磁同步电机控制方法及装置 |
-
2017
- 2017-12-18 CN CN201711366514.9A patent/CN108089444B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003044144A (ja) * | 2001-08-02 | 2003-02-14 | Nissan Motor Co Ltd | 多軸同期制御装置、多軸同期制御方法および多軸同期制御プログラム |
CN101261737A (zh) * | 2008-01-04 | 2008-09-10 | 中国科学院光电技术研究所 | 数字航测相机的二维标定装置及其标定方法 |
CN103776365A (zh) * | 2014-02-14 | 2014-05-07 | 哈尔滨工业大学 | 基于径向与轴向基准的航空发动机多轴转子装配方法与装置 |
CN104571142A (zh) * | 2014-12-01 | 2015-04-29 | 中国科学院合肥物质科学研究院 | 一种大气参数跟踪测量系统 |
CN104932251A (zh) * | 2015-05-28 | 2015-09-23 | 北京空间机电研究所 | 一种用于空间光学遥感器随动系统的同步控制方法 |
CN105423997A (zh) * | 2015-12-22 | 2016-03-23 | 中国科学院长春光学精密机械与物理研究所 | 垂直平面驱动经纬仪 |
CN106681150A (zh) * | 2017-01-19 | 2017-05-17 | 华侨大学 | 基于闭环参考模型的分数阶pid控制器参数优化整定方法 |
CN107093970A (zh) * | 2017-06-23 | 2017-08-25 | 华中科技大学 | 一种无位置传感器的永磁同步电机控制方法及装置 |
Non-Patent Citations (2)
Title |
---|
Dual EKF-Based Model Parameters Identification for Flight Simulation Turntable;Jinshu Wu 等;《Proceedings of the 36th Chinese Control Conference》;20170728;第4830-4835页 * |
火箭炮两轴耦合位置伺服系统线性自抗扰控制;郑颖 等;《兵工学报》;20160630;第36卷(第6期);第987-992页 * |
Also Published As
Publication number | Publication date |
---|---|
CN108089444A (zh) | 2018-05-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106647781B (zh) | 基于重复控制补偿神经模糊pid四旋翼飞行器的控制方法 | |
CN106292287B (zh) | 一种基于自适应滑模控制的uuv路径跟踪方法 | |
CN108363301B (zh) | 基于干扰观测滑模变结构的轮廓误差交叉耦合控制方法 | |
Huang et al. | Fixed-time autonomous shipboard landing control of a helicopter with external disturbances | |
CN103777641B (zh) | 飞行器跟踪控制的复合自抗扰控制方法 | |
CN105159083B (zh) | 一种双框架磁悬浮cmg框架系统的高精度摩擦补偿控制方法 | |
CN107505841B (zh) | 一种基于干扰估计器的机械臂姿态鲁棒控制方法 | |
CN107807657B (zh) | 一种基于路径规划的挠性航天器姿态自适应控制方法 | |
CN107894708A (zh) | 一种环形耦合型多轴机器人系统的同步控制方法 | |
CN111930072B (zh) | 一种双轴运动控制系统的轨迹跟踪控制方法 | |
CN111007804A (zh) | 一种切削加工机器人的动态误差补偿与控制方法 | |
CN108089444B (zh) | 一种基于修正参考模型的双轴转台同步控制方法 | |
CN109062043A (zh) | 考虑网络传输以及执行器饱和的航天器自抗扰控制方法 | |
CN108762283B (zh) | 带有旋转载荷的卫星平台的姿态控制方法、装置及系统 | |
CN113110511B (zh) | 一种基于广义模糊双曲模型的智能船舶航向控制方法 | |
CN113625732B (zh) | 基于角加速度估计的增量反馈逆角速度控制律设计方法 | |
CN108406779A (zh) | 一种基于未知输入观测器的机械臂运动控制方法 | |
CN111427267A (zh) | 一种采用力与力矩自适应估计的高速飞行器攻角跟踪方法 | |
CN115473467A (zh) | 基于模糊观测器的柔性关节机械臂指令滤波反步控制方法 | |
CN107908101A (zh) | 一种基于模糊神经网络pid控制的模拟转台控制系统 | |
CN117055582A (zh) | 一种具有预设性能的船舶助航风帆终端滑模控制方法 | |
CN115793449B (zh) | 直升机飞行姿态控制器设计方法及装置、设备、存储介质 | |
CN115755590A (zh) | 一种高超声速飞行器抗扰制导控制系统及方法 | |
Jiang et al. | Desired compensation adaptive robust control of mobile satellite communication system with disturbance and model uncertainties | |
CN107703754A (zh) | 一种基于神经网络pid控制的模拟转台控制系统 |
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 |