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

作者：王辉; 盛荣; 郭剑东^*

来源：矿山机械, 2023, 51(10): 10-17.

DOI：10.16816/j.cnki.ksjx.2023.10.011

• 凿岩机器人
• 动力学建模
• LQR算法
• 机械臂控制

钻爆法施工中越来越多使用凿岩机器人，改善了工人的工作环境和工作安全性，是隧道施工机械化发展的必然趋势。不同机型钻臂一般包括6～8个关节，钻臂精确定位与定向控制是凿岩机器人的关键技术。针对某型凿岩机器人，首先对其三角钻臂机构进行研究，使用PID方法进行钻臂控制；进而进行凿岩机器人机械臂动力学建模，在理论建模基础上设计了一种基于线性二次型的最优机械臂控制算法(LQR)，在Simulink仿真环境中开展数值仿真验证并与PID控制对比，结果表明，利用LQR方法控制的机械臂系统响应更快，可减少系统调解时间，同时削弱了运动过程中的抖动，有效提高了机械臂的定位精度。

• 单位
  自动化学院; 南京航空航天大学