img

QQ群聊

img

官方微信

高级检索

黄金科学技术 ›› 2021, Vol. 29 ›› Issue (1): 25-34.doi: 10.11872/j.issn.1005-2518.2021.01.167

• 智慧矿山专栏 • 上一篇    下一篇

基于LQR-QPSO的地下铲运机控制参数优化研究

刘永春1,2(),王李管1,2(),吴家希1,2   

  1. 1.中南大学资源与安全工程学院,湖南 长沙 410083
    2.中南大学数字矿山研究中心,湖南 长沙 410083
  • 收稿日期:2020-09-17 修回日期:2020-10-26 出版日期:2021-02-28 发布日期:2021-03-22
  • 通讯作者: 王李管 E-mail:liuyongchun@csu.edu.cn;liguan_wang@163.com
  • 作者简介:刘永春(1996-),男,湖南衡阳人,硕士研究生,从事智能采矿与装备方面的研究工作。liuyongchun@csu.edu.cn
  • 基金资助:
    国家重点研发计划项目“深部集约化开采生产过程智能管控技术”(2017YFC0602905);“井下人机定位和作业环境感知分析技术与系统”(2018SK2053)

Optimization of Control Parameters for Underground Load-Haul-Dump Machine Based on LQR-QPSO

Yongchun LIU1,2(),Liguan WANG1,2(),Jiaxi WU1,2   

  1. 1.School of Resources and Safety Engineering,Central South University,Changsha 410083,Hunan,China
    2.Digital Mine Research Center,Central South University,Changsha 410083,Hunan,China
  • Received:2020-09-17 Revised:2020-10-26 Online:2021-02-28 Published:2021-03-22
  • Contact: Liguan WANG E-mail:liuyongchun@csu.edu.cn;liguan_wang@163.com

摘要:

现代控制理论是实现地下铲运机路径跟踪控制的重要技术之一。目前,控制算法应用的难点在于参数的选取和整定。为解决控制参数整定问题,提出应用量子行为粒子群优化算法(QPSO)对基于线性二次型调节(LQR)的状态反馈控制器进行参数优化,实现对地下铲运机精准、稳定的路径跟踪控制。状态反馈控制器基于铲运机的误差动力学模型得出,优化后的路径跟踪控制最大横向位置偏差低于0.23 m。仿真试验结果表明:相较于标准粒子群优化算法,QPSO算法优化的路径跟踪控制器的最大横向位置偏差减小53.4%,优化效果更好、成功率更高。

关键词: 地下铲运机, 路径跟踪控制, 控制参数优化, 粒子群优化算法, 量子行为粒子群优化算法, 线性二次型调节器

Abstract:

With the increase of mining depth,the mining operation environment is worse and worse.It is of great significance to realize the underground unmanned load-haul-dump(LHD) machine to ensure the safe and efficient production of mine enterprises.In underground operation,the long,low articulated body of under-ground LHD machine has the characteristics of high mass,high inertia and high steering delay,which makes the precise tracking of the scraper path a difficult point for its realization of unmanned driving.As an important technique of path tracing control,the control algorithm based on optimization principle often has the problem of parameter selection and adjustment.In industrial applications,manual trial-and-error methods are commonly used for parameter selection.This method not only consumes a lot of human and time costs,but also makes it difficult to ensure the accuracy because of the lack of relevant experience of the operator.In this paper,the method of parameter optimization for linear quadratic regulator(LQR) state feedback controller by quantum-behaved particle swarm optimization(QPSO) algorithm was proposed.The LQR state feedback controller was cons-tructed based on error dynamics model.After parameter optimization,the maximum lateral error of path tracking is not more than 0.23 m.In a large number of repeated experiments,it is found that the standard particle swarm optimization(PSO) algorithm is difficult to find the proper parameter that can make the controller cross deviation lower than 0.5 m in 100 iterations.The QPSO algorithm has found the optimal parameter which meets the condition in the 10 repeated experiments.In 100 iterations,the fitness of the PSO algorithm tends to converge at 21 iterations,while that of the QPSO algorithm converges to a lower level than that of the PSO in the seventh iteration.The maximal lateral position deviation of the path tracking controller is reduced by 53.4%.It can be seen that the parameter optimization ability of the QPSO algorithm is obviously stronger than that of the PSO algorithm.The QPSO algorithm has faster optimization speed and higher success rate than the PSO algorithm.The control parameters of the LQR state feedback controller are automated by the QPSO algorithm.The design and parameter tuning process of the entire path tracking controller has important reference significance for realizing the unmanned driving of underground LHD machine.

Key words: underground load-haul-dump machine, path tracking control, optimization of control parameters, particle swarm optimization, quantum particle swarm optimization, linear quadratic regulator

中图分类号: 

  • TD273

图1

地下铲运机稳态转向与原地转向模型"

图2

地下铲运机运动轨迹示意图注:Pe、P为期望瞬时期望参考点和实际定位参考点;曲线A、B为期望路径和实际路径;Oe、O为期望转向中心和实际转向中心;ve、v为期望速度和实际速度;θe、θf为期望航向角和实际航向角"

图3

地下铲运机误差动力学模型示意图注:Pe、P为期望瞬时期望参考点和实际定位参考点;Pe'、P'为下一时刻期望瞬时期望参考点和实际定位参考点;?Oe、O为短时间内期望转向中心和实际转向中心;εθ、εd为航向角偏差与横向位置偏差;εθ'、εd'为下一时刻的航向角偏差与横向位置偏差;dθ、dεd为航向角变化和横向位置偏差变化"

表1

地下铲运机车身几何参数"

参数名称数值
前桥至铰接点距离Lf/m1.755
后桥至铰接点距离Lr/m1.855
车身宽度W/m2.26
轮胎直径d/m1.30
最大满载速度vmax/(m·s-1)6.92
铰接转向角范围γ/rad0.25π
最大铰接转向角速度γ˙max/(rad·s-1)0.15

图4

粒子群优化算法流程图"

图5

LQR-QPSO路径跟踪控制器"

图6

试验参考巷道三维激光点云地图"

表2

粒子群优化算法及其改进算法的初始参数设置"

参数名称数值参数名称数值
种群规模N50.0学习因子c22.0
迭代次数G100.0最大移动速度vmax1.0
初始惯性权重wini0.9粒子取值极限qmax500.0
终止惯性权重wend0.4初始收缩—扩张系数αini1.0
学习因子c12.0终止收缩—扩张系数αend0.5

表3

粒子群算法及其改进算法的参数优化结果"

算法加权矩阵Q线性反馈矩阵K适应度
q1q2q3k1k2k3
PSO0.456089.987661.34310.675310.285511.701419.5232
QPSO0.014255.816040.39360.11937.642010.83064.5278

图7

历史最优适应度"

图8

不同优化参数行驶路径对比"

图9

不同优化参数控制偏差对比"

图10

不同优化参数控制输出对比"

Fang Wei,Sun Jun,Xie Zhenping,al et,2010.Convergence analysis of quantum-behaved particle swarm optimization algorithm and study on its control parameter[J].Journal of Physics,59(6):3686-3694.

Guo Xin,Zhan Kai,Gu Hongshu,al et,2009.Navigation system research of unmanned scraper[J].Nonferrous Metals,61(4):143-147.

Gupta S,Tripathi R K,2014.Optimal LQR controller in CSC based STATCOM using GA and PSO[J].Archives of Electrical Engineering,63(3):469-487.

Kang Yan,Sun Jun,Xu Wenbo,2007.Parameter selection of quantum-behaved particle swarm optimization[J].Computer Engineering and Applications,43(23):40-42.

Kemmoé Tchomté S,Gourgand M,2009.Particle swarm optimization:A study of particle displacement for solving continuous and combinatorial optimization problems(Article)[J].International Journal of Production Economics,121(1):57-67.

Kennedy J,Eberhart R,1995.Particle swarm optimization[C]//International Conference on Neural Networks.Perth:IEEE:1942-1948.

Li Guoyong,2008.Optimal Control Theory and Application[M].Beijing:National Defence Industry Press:246.

Li Jianguo,Zhan Kai,Shi Feng,al et,2015.Auto-driving technology for underground scraper based on optimal trajectory tracking[J].Journal of Agricultural Engineering,46(12):323-328.

Liu Hongbo,Wang Xiukun,Tan Guozhen,2006.Convergence analysis of particle swarm optimization and its improved algorithm based on Chaos[J].Control and Decision,21(6):636-640.

Luo Weidong,Ma Baoquan,Meng Yu,al et,2020.Reactive navigation system of underground unmanned Load-Haul-Dump unit based on NMPC[J].Journal of China Coal Society,45(4):1536-1546.

Meng Yu,Wang Jue,Gu Qing,al et,2018.LQR- GA path tracking control of articulated vehicle based on predictive information [J].Transactions of the Chinese Society for Agricultural Machinery,49(6):375-384.

Nayl T,Nikolakopoulos G,Gustafsson T,2015.Effect of kinematic parameters on MPC based on-line motion planning for an articulated vehicle[J].Robotics and Autonomous Systems,70:16-24.

Ridley P,Corke P,2003.Load haul dump vehicle kinematics and control[J].Journal of Dynamic Systems. Measurement and Control,125(1):54-59.

Sasiadek J Z,Lu Y,2005.Path tracking of an autonomous LHD articulated vehicle [C]//The 16th IFAC World Congress.Prague:IFAC:55-60.

Shi Y,Eberhart R,1998.A modified particle swarm optimizer[C]//IEEE International Conference on Evolutionary Computation.Anchorage: IEEE:69-73.

Shiroma N,Ishikawa S,Inoue K,al et,2009.Nonlinear straight path tracking control for an articulated steering type vehicle [C]//SICE Annual Conference.Fukuoka:IEEE:2206-2211.

Sun J,Feng B,Xu W,2004.Particle swarm optimization with particles having quantum behavior[C]//Congress on Evolutionary Computation.Portland:IEEE,(1):325-331.

Van den Bergh F,2001.An Analysis of Particle Swarm Optimizers[D].Pretoria:University of Pretoria.

Wang Yong,2000.Research on Nonlinear PID Control[D].Nanjing:Nanjing University of Science and Technology.

Zhang Donglin,2002.Undergound LHD[M].Beijing:Metallurgical Industry Press:509.

Zhao Xuan,Yang Jue,Zhang Wenming,al et,2015.Sliding mode control algorithm for path tracking of articulated dump truck[J].Journal of Agricultural Engineering,31(10):198-203.

Zheng Weibo,2016.Research on Improvement of Particle Swarm Optimization Algorithm and Its Application[D].Qingdao:Qingdao University

Zou Chenchen,2017.Study on the Control of LQR Linear Two-stage Inverted Pendulum Based on Particle Swarm Optimization[D].Xi’an:Xi’an University of Science and Technology.

方伟,孙俊,谢振平,等,2010.量子粒子群优化算法的收敛性分析及控制参数研究[J].物理学报,59(6):3686-3694.

郭鑫,战凯,顾洪枢,等,2009.无人操纵铲运机井下导航研究[J].有色金属,61(4):143-147.

康燕,孙俊,须文波,2007.具有量子行为的粒子群优化算法的参数选择[J].计算机工程与应用,43(23):40-42.

李国勇,2008.最优控制理论与应用[M].北京:国防工业出版社:246.

李建国,战凯,石峰,等,2015.基于最优轨迹跟踪的地下铲运机无人驾驶技术[J].农业机械学报,46(12):323-328.

刘洪波,王秀坤,谭国真,2006.粒子群优化算法的收敛性分析及其混沌改进算法[J].控制与决策,21(6):636-640.

罗维东,马宝全,孟宇,等,2020.基于NMPC的地下无人铲运机反应式导航系统[J].煤炭学报,45(4):1536-1546.

孟宇,汪钰,顾青,等,2018.基于预见位姿信息的铰接式车辆LQR-GA路径跟踪控制[J].农业机械学报,49(6):375-384.

王勇,2000.非线性PID控制的研究[D].南京:南京理工大学.
[1] 姜丹,王李管. 地下铲运机自主铲装技术现状及发展趋势[J]. 黄金科学技术, 2021, 29(1): 35-42.
[2] 许瑞, 侯奎奎, 王玺, 刘兴全, 李夕兵. 基于核主成分分析与SVM的岩爆烈度组合预测模型[J]. 黄金科学技术, 2020, 28(4): 575-584.
Viewed
Full text


Abstract

Cited

  Shared   
  Discussed   
No Suggested Reading articles found!