基于PID/LQR凿岩机器人机械臂控制算法  

PID/LQR-based control algorithm for robotic arm of rock-drilling robot

作　　者：王辉[1,2] 盛荣 郭剑东 WANG Hui;SHENG Rong;GUO Jiandong(College of Automation Engineering,Nanjing University of Aeronautics and Astronautics,Nanjing 210016,Jiangsu,China;Xuzhou WIKA Electronics Control Technology Co.,Ltd.,Xuzhou 221122,Jiangsu,China;Key Laboratory of Advanced Technology for Small and Medium-Sized UAV,Ministry of Industry and Information Technology,Nanjing University of Aeronautics and Astronautics,Nanjing 210016,Jiangsu,China)

机构地区：[1]南京航空航天大学自动化学院,江苏南京210016 [2]徐州威卡电子控制技术有限公司,江苏徐州221122 [3]南京航空航天大学中小型无人机先进技术工信部重点实验室,江苏南京210016

出　　处：《矿山机械》2023年第10期10-17,共8页Mining & Processing Equipment

基　　金：青年科技创新基金(NO.56XAC22030)。

摘　　要：钻爆法施工中越来越多使用凿岩机器人,改善了工人的工作环境和工作安全性,是隧道施工机械化发展的必然趋势。不同机型钻臂一般包括6~8个关节,钻臂精确定位与定向控制是凿岩机器人的关键技术。针对某型凿岩机器人,首先对其三角钻臂机构进行研究,使用PID方法进行钻臂控制;进而进行凿岩机器人机械臂动力学建模,在理论建模基础上设计了一种基于线性二次型的最优机械臂控制算法(LQR),在Simulink仿真环境中开展数值仿真验证并与PID控制对比,结果表明,利用LQR方法控制的机械臂系统响应更快,可减少系统调解时间,同时削弱了运动过程中的抖动,有效提高了机械臂的定位精度。The increasing use of rock-drilling robots in the drilling and blasting construction has improved the working environment and safety of workers,which is an inevitable trend in the development of the tunnel construction mechanization.Different types of drilling arms generally include 6~8 joints,and the precise positioning and the directional control of the drlling arm are key technologies for rock-drilling robots.In this paper,for a certain type of rock-drlling robot,the triangular drilling arm mechanism was first studied,and the PID method was used to control it.Then,the dynamic modeling of the robotic arm of the rock-drilling robot was carried out.On the basis of the theoretical modeling,an optimal robotic arm control algorithm based on linear quadratic(LQR)was designed.The numerical simulation validation was conducted in the Simulink simulation environment and compared with PID control.The results showed that the robotic arm system controlled by LQR method responded faster,which could reduce the system tuning time,weaken the jitter in the motion process,and effectively improve the positioning accuracy of the robotic arm.

关 键 词：凿岩机器人 动力学建模 LQR算法 机械臂控制 

分 类 号：TD421.2[矿业工程—矿山机电]