CN113110027A - 一种轨道式斗轮取料机位置切换抗干扰控制方法 - Google Patents
一种轨道式斗轮取料机位置切换抗干扰控制方法 Download PDFInfo
- Publication number
- CN113110027A CN113110027A CN202110384195.4A CN202110384195A CN113110027A CN 113110027 A CN113110027 A CN 113110027A CN 202110384195 A CN202110384195 A CN 202110384195A CN 113110027 A CN113110027 A CN 113110027A
- Authority
- CN
- China
- Prior art keywords
- interference
- theta
- wheel
- bucket
- reclaimer
- 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 23
- 239000000463 material Substances 0.000 claims abstract description 26
- 238000006073 displacement reaction Methods 0.000 claims description 12
- 230000008859 change Effects 0.000 claims description 4
- 239000011159 matrix material Substances 0.000 claims description 4
- 230000007246 mechanism Effects 0.000 claims description 4
- 239000013077 target material Substances 0.000 claims description 3
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 3
- 238000005259 measurement Methods 0.000 claims description 2
- 230000000694 effects Effects 0.000 abstract description 8
- 230000004044 response Effects 0.000 abstract description 6
- 239000000428 dust Substances 0.000 abstract description 2
- 239000002689 soil Substances 0.000 abstract description 2
- 239000002893 slag Substances 0.000 abstract 1
- 238000004422 calculation algorithm Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 239000000725 suspension Substances 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 230000009022 nonlinear effect Effects 0.000 description 2
- 238000006467 substitution reaction Methods 0.000 description 2
- 229910000831 Steel Inorganic materials 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 239000003245 coal Substances 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 239000012770 industrial material Substances 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
- 239000002994 raw material Substances 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 239000010959 steel Substances 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
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
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种轨道式斗轮取料机位置切换抗干扰控制方法。该方法针对轨道式斗轮取料机切换取料点位置任务中,对斗轮取料机的取料斗轮位置精度和响应速度的控制问题,设计线性扩张状态观测器以估计高粉尘多渣土带来的不确定摩擦、以及取料机所带物料质量不同导致的参数不确定性等干扰。所获得的总干扰估计值在主控制回路中补偿后,由PID控制器输出的控制量决定轨道式斗轮取料机的步进、俯仰和回转速度。通过设计观测器和合理选取反馈控制器增益,该方法在控制精度和响应速度方面取得良好的控制效果,同时有效提升了***的抗干扰性能。
Description
技术领域
本发明涉及一种轨道式斗轮取料机位置切换抗干扰控制方法,属于斗轮取料机位置控制技术领域。
背景技术
料场作为大型储存转运基地,一般存在于港口、钢厂、矿场等场所,用于存放煤矿石、金属矿石等工业原料。工业物料一般以长条型料堆的形式堆放在料场中,轨道式斗轮取料机工作时,轨道式取料机需要沿平行于料条的轨道前进,并同时回转、旋转吊臂使得吊臂末端的斗轮到达给定取料点。取料开始后,斗轮所取出的物料会沿吊臂上的皮带运输到轨道边的固定皮带上,抵达下游生产线。
由于同一料条会被分为不同的料段,用以存放不同产地、不同批次、不同成分的物料。当轨道式斗轮取料机需要调整斗轮到新的取料点时,由于轨道式斗轮取料机运动学方程中存在非线性项;且前一次取料工作未运送到下游皮带上的物料会累积在料机皮带上,导致料机模型参数发生变化;此外由于料机的工作环境高粉尘、多砂土,料机运动期间易受到不确定性摩擦的干扰;故传统的PID控制无法有效克服非线性环节,很难达到所需的位置精度和响应速度。
为了解决该问题,本发明设计线性扩张状态观测器以获得***内外的总干扰估计值,并在主控制回路中补偿后,由PID控制器输出的控制量决定轨道式斗轮取料机的步进、俯仰和回转速度。通过选取合适的观测器和反馈控制器增益,该方法在控制精度和响应速度方面取得良好的控制效果,同时有效提升了***的抗干扰性能。
发明内容
为了克服所带物料质量导致的参数不确定性、存在的不确定摩擦等未建模动态和非线性因素带来的干扰,本发明提出一种轨道式斗轮取料机位置切换抗干扰控制方法。在给定斗轮取料机取料位置点三维坐标后,该方法在控制精度和响应速度方面取得良好的控制效果,同时有效提升了***的抗干扰性能。
为了达到以上目的,本发明采用以下的技术方案:
一种轨道式斗轮取料机位置切换抗干扰控制方法,包括以下步骤:
步骤1:计算出目标点三维直角坐标(x,y,z)对应到斗轮取料机三自由度上的位置量θ0=(d1_0;θ2_0;θ3_0):
步骤2:在三个自由度上的位移d1、回转角度θ2和俯仰角度θ3可由传感器测得θ=(d1;θ2;θ3),将斗轮取料机目标取料位置坐标θ0=(d1_0;θ2_0;θ3_0)与采集到的斗轮中心实时坐标位置θ=(d1;θ2;θ3)作比较,差值作为PID控制器的输入信号;
步骤4:将传感器测得位移信号、角度信号以及由此得出的速度信号、角速度信号用于扩张状态观测器采用线性扩张状态观测器:计算总干扰估计值时,代表观测出的三个误差分量与真实总扰动的误差,可以得到:在条件下,误差均为有界值,其中β1、β2、β3为设计的线性扩张状态观测器增益,为选取的线性扩张状态观测器状态量,为对总干扰量的观测值,获得对的控制量;
由上述理论推导提供一种用于回转取料机位置控制的抗干扰控制***的示意图,该***主要包括:
给定运动学方程模块,PID控制器模块,斗轮取料机力矩模型模块,线性扩张状态观测器模块,状态反馈模块。运动学方程模块用于将给定待取料点的三维直角坐标转化为取料机三个自由度上位置变量;PID控制器模块用于接受给定三维直角坐标与反馈直角坐标的差值,输出控制量;线性扩张状态观测器模块用于估计***总扰动,并在主回路中补偿掉观测扰动;状态反馈模块用于反馈角度信号以及角速度信号。
相对于现有技术,本发明的优点如下:1)该技术方案将***内部与标准形式不相关的不确定性、非线性以及外部扰动视为总扰动,利用扩张状态观测器对规定的总扰动进行估计并反馈到***控制回路中进行实时补偿,从而保证参考输入与反馈量的差值作为标准型***模型的输入量;2)该技术方案使用扩张状态观测器对取料机所带物料质量导致的参数不确定性干扰等、存在的不确定性摩擦干扰等未建模动态和非线性因素进行有效估计,通过选取合适的观测器和反馈控制器增益,该方法在控制精度和响应速度方面取得良好的控制效果,同时有效提升了***的抗干扰性能。
附图说明
图1为本发明的所述斗轮取料机运动关节的三个自由度;
图2为本发明的所述斗轮机等效模型示意图;
图3为本发明的***结构框图;
图4为该型控制算法的流程框图;
图5为传统PID控制器与输出反馈作用下的控制效果仿真;
图6为本发明所应用的自抗扰控制的控制效果仿真。
具体实施方式
下面结合附图和具体实施例对本发明的技术方案作进一步说明。
实施例:参见图1-图6,一种轨道式斗轮取料机位置切换抗干扰控制方法,包括以下步骤:
步骤1:将轨道式斗轮取料机等效为具有三自由度的机器臂模型,获得目标点三维直角坐标对应到三自由度上的位置量θ0=(d1_0;θ2_0;θ3_0);
步骤2:根据实时测量的θ=(d1;θ2;θ3),计算出θ坐标与θ0坐标的差值,作为PID控制器的输入x;
步骤5:设计PID控制器。
其中,步骤1中,该模型的运动学方程为:
其中(x,y,z)为目标点三维直角坐标,d1为大车平移位移量,θ2、θ3为两个关节的旋转角度,L1为行走关节到回转关节的直线长度,L2为回转机构到连接件的直线长度,L3为连接件到俯仰机构的直线长度,L4为俯仰机构到斗轮中心的距离。
步骤1所述机器臂模型具有的三自由度分别为:沿轨道平动、大臂的水平回转运动和大臂俯仰旋转运动。
其中,步骤2中,在三个自由度上的实时位移d1、回转角度θ2和俯仰角度θ3可由传感器测得θ=(d1;θ2;θ3),将斗轮取料机目标取料位置坐标θ0=(d1_0;θ2_0;θ3_0)与采集到的斗轮中心实时坐标位置θ=(d1;θ2;θ3)作比较,差值作为PID控制器的输入信号。
其中,步骤4中,将传感器测得位移信号、角度信号以及由此得出的速度信号、角速度信号
用于扩张状态观测器采用线性扩张状态观测器:计算干扰估计值时,代表观测出的三个误差分量与真实总扰动的误差,可以得到: 在条件下,误差均为有界值;其中β1、β2、β3为设计的线性扩张状态观测器增益,为选取的线性扩张状态观测器状态量,为对总干扰量的观测值。
其中,步骤5中,设计PID控制器,控制器输出为其中Kp、Kd分别为比例系数和微分系数,θ0、是斗轮机自由度上的目标位置点、目标位置的变化率,θ、分别为实时位置的变化速率;设定Kp=ωc 2,Kd=2ωc,其中ωc为选取的控制回路带宽;选取补偿后的斗轮取料机模型为:当总扰动的估计值收敛于***真实总扰动时, 其中u为PID控制器输出,为观测器估计总扰动,τ0为补偿扰动后的模型。
设定扩张状态观测器的带宽为ωo=(3~5)ωc,β1=3ωo,β2=3ωo 2,β3=ωo 3,Kp=ωc 2,Kd=2ωc,其中ωc为选取的控制回路带宽。该技术方案将***内部与标准形式不相关的不确定性、非线性以及外部扰动视为总扰动,利用扩张状态观测器对规定的总扰动进行估计并反馈到***控制回路中进行实时补偿,从而保证参考输入与反馈量的差值作为标准型***模型的输入量。
具体实施例:参照图1,本实施例中提出的用于回转取料机位置控制的抗干扰控制方法,反馈实时检测回转取料机三个运动维度上的位移以及角度,并运行抗干扰控制方法得到控制量,控制取料机步进和回转的速度来完成取料机回转位置控制的自动化控制。
所述控制方法采用线性扩张状态观测器和传统PID构成的反馈控制器相结合,根据线性扩张状态观测器的输出和PID控制器的输出共同决定下一时刻取料机的步进和回转的速度,具体计算公式如下:
合理设置扩张状态观测器中的参数,扩张状态观测器的带宽为ωo,则一般取ωo=(3~5)ωc。扩张状态观测器中的参数分别设置为β1=3ωo,β2=3ωo 2,β3=ωo 3。
采用本发明方法的***如图3所示,在该***中,传感器可以获得实时的取料机位置信息。
PID控制器的实现,通过坐标变换后的实时三维直角坐标与设定的取料点做差得到差值,并结合整定出的比例系数和微分时间常数计算得出PID控制器的输出量。
线性扩张状态观测器的实现通过采集三个自由度上的位置变量信号获得位置量的一阶导数,根据实际被控对象的模型,经过计算后得到总扰动的估计值。
对于一个L1=6m,L2=6m,L3=5m,L4=50m的轨道式斗轮取料机,其质量矩阵:
其中:
m(2,2)=625m3;
m(2,3)=m(3,2)=-25m3sinθ3cosθ2;
m(3,3)=m1+m2+m3。
取m1=2500kg,m2=3000kg,m3=3000kg时,对主动抗干扰控制器,设定观测器带宽ωo=6,PID控制器Kp=1.44,Kd=2.4,KI=0;对传统PID控制器设定Kp=300000,Kd=0,KI=0;并同时对两被控对象角加速度提供幅值为±5×10-3的正弦干扰时,传统PID控制器对三维直角坐标为(0,1,2)的位置目标点控制效果仿真如图5所示;线性自抗扰控制器对三维直角坐标为(1,2,3)的位置目标点控制效果仿真如图6所示。由图可知,传统PID控制无法使得斗轮机模型位置收敛,难以克服其非线性性质;而自抗扰位置控制算法可以克服其非线性质并有效抵抗二阶干扰,在10秒内到达指定的位置,较好的兼顾了动态调整时间和静态误差。
需要说明的是上述实施例仅仅是本发明较佳实施例,并没有用来限定本发明的保护范围,在上述技术方案的基础上做出的等同替换或者替代均属于本发明的保护范围。
Claims (7)
3.根据权利要求2所述的一种轨道式斗轮取料机位置切换抗干扰控制方法,其特征在于,步骤1所述机器臂模型具有的三自由度分别为:沿轨道平动、大臂俯仰旋转运动和大臂的水平回转运动。
4.根据权利要求3所述的一种轨道式斗轮取料机位置切换抗干扰控制方法,其特征在于,步骤2中,在三个自由度上的位移d1、回转角度θ2和俯仰角度θ3可由传感器测得θ=(d1;θ2;θ3),将斗轮取料机目标取料位置坐标θ0=(d1_0;θ2_0;θ3_0)与采集到的斗轮中心实时坐标位置θ=(d1;θ2;θ3)作比较,差值作为PID控制器的输入信号。
7.根据权利要求1所述的一种轨道式斗轮取料机位置切换抗干扰控制方法,其特征在于,设定扩张状态观测器的带宽为ωo=(3~5)ωc,β1=3ωo,β2=3ωo 2,β3=ωo 3,Kp=ωc 2,Kd=2ωc,其中ωc为选取的控制回路带宽。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110384195.4A CN113110027B (zh) | 2021-04-09 | 2021-04-09 | 一种轨道式斗轮取料机位置切换抗干扰控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110384195.4A CN113110027B (zh) | 2021-04-09 | 2021-04-09 | 一种轨道式斗轮取料机位置切换抗干扰控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113110027A true CN113110027A (zh) | 2021-07-13 |
CN113110027B CN113110027B (zh) | 2022-11-22 |
Family
ID=76715312
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110384195.4A Active CN113110027B (zh) | 2021-04-09 | 2021-04-09 | 一种轨道式斗轮取料机位置切换抗干扰控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113110027B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113879860A (zh) * | 2021-11-05 | 2022-01-04 | 北京华能新锐控制技术有限公司 | 基于动力学的斗轮堆取料机恒流量取料方法及装置 |
CN114084585A (zh) * | 2021-11-12 | 2022-02-25 | 北京华能新锐控制技术有限公司 | 斗轮堆取料机的直行取料方法及装置 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20140292248A1 (en) * | 2011-12-14 | 2014-10-02 | Kabushiki Kaisha Yaskawa Denki | Motor controller and motor system |
CN104360635A (zh) * | 2014-10-21 | 2015-02-18 | 南京理工大学 | 一种电机位置伺服***的抗干扰控制方法 |
CN107422751A (zh) * | 2017-05-23 | 2017-12-01 | 中国神华能源股份有限公司 | 用于斗轮取料机的自动取料流量控制方法及装置 |
CN112577413A (zh) * | 2020-12-10 | 2021-03-30 | 广州港集团有限公司 | 一种斗轮式堆取料机堆场定位***及定位方法 |
-
2021
- 2021-04-09 CN CN202110384195.4A patent/CN113110027B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20140292248A1 (en) * | 2011-12-14 | 2014-10-02 | Kabushiki Kaisha Yaskawa Denki | Motor controller and motor system |
CN104360635A (zh) * | 2014-10-21 | 2015-02-18 | 南京理工大学 | 一种电机位置伺服***的抗干扰控制方法 |
CN107422751A (zh) * | 2017-05-23 | 2017-12-01 | 中国神华能源股份有限公司 | 用于斗轮取料机的自动取料流量控制方法及装置 |
CN112577413A (zh) * | 2020-12-10 | 2021-03-30 | 广州港集团有限公司 | 一种斗轮式堆取料机堆场定位***及定位方法 |
Non-Patent Citations (2)
Title |
---|
李园园: "斗轮机位置环优化***的研究", 《硕士学位论文全文库》 * |
陈芝俊: "600_750斗轮堆取料机控制***设计及应用研究", 《硕士学位论文全文库》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113879860A (zh) * | 2021-11-05 | 2022-01-04 | 北京华能新锐控制技术有限公司 | 基于动力学的斗轮堆取料机恒流量取料方法及装置 |
CN113879860B (zh) * | 2021-11-05 | 2023-09-08 | 北京华能新锐控制技术有限公司 | 基于动力学的斗轮堆取料机恒流量取料方法及装置 |
CN114084585A (zh) * | 2021-11-12 | 2022-02-25 | 北京华能新锐控制技术有限公司 | 斗轮堆取料机的直行取料方法及装置 |
CN114084585B (zh) * | 2021-11-12 | 2023-10-20 | 北京华能新锐控制技术有限公司 | 斗轮堆取料机的直行取料方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN113110027B (zh) | 2022-11-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113110027B (zh) | 一种轨道式斗轮取料机位置切换抗干扰控制方法 | |
CN110531707B (zh) | Scara机器人的摩擦模型改进以及动力学参数辨识方法 | |
CN109465825A (zh) | 机械臂柔性关节的rbf神经网络自适应动态面控制方法 | |
CN107607113B (zh) | 一种两轴姿态倾角测量方法 | |
CN105867382B (zh) | 一种基于等效干扰补偿的船舶动力定位控制*** | |
CN108875253A (zh) | 基于干扰观测器的欠驱动吊车***的终端滑模消摆控制方法及*** | |
CN113359710B (zh) | 一种基于los理论的农机路径跟踪方法 | |
Jeon et al. | Kinematic Kalman filter (KKF) for robot end-effector sensing | |
Marwan et al. | Calibration method for articulated industrial robots | |
CN107206588A (zh) | 机械手的偏移自动调整装置及机械手的偏移自动调整方法 | |
CN113175324B (zh) | 一种凿岩台车大臂耦合运动串级复合pid控制方法 | |
CN111946340A (zh) | 基于视觉导航的煤矿悬臂式掘进机截割控制方法及*** | |
CN114750167B (zh) | 一种基于扰动观测的工业机器人关节摩擦补偿方法 | |
CN106950999A (zh) | 一种采用自抗扰控制技术的移动舞台轨迹跟踪控制方法 | |
WO2023093594A1 (zh) | 一种误差矫正的地坪磨抛机器人轨迹纠偏方法及装置 | |
CN103425131A (zh) | 基于非光滑控制和扰动观测的农用拖拉机导航控制方法 | |
Zhai et al. | Observer-based adaptive fuzzy control of underactuated offshore cranes for cargo stabilization with respect to ship decks | |
JPH10128688A (ja) | ロボットの非干渉化制御方法 | |
CN208384428U (zh) | 基于反向位移补偿的稳定转台*** | |
CN108303870A (zh) | 一种多自由度位移变化补偿平台的控制方法、控制*** | |
CN107505844A (zh) | 混联式汽车电泳涂装输送机构基于综合误差的同步协调滑模控制方法 | |
CN112223276B (zh) | 基于自适应神经网络滑模控制的多关节机器人控制方法 | |
CN112394740B (zh) | 一种无人驾驶碾压机前进过程的复合抗扰轨迹跟踪控制算法 | |
CN107303626A (zh) | 激光加工装置及激光加工方法 | |
Noda et al. | Flow rate control based on differential flatness in automatic pouring robot |
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 |