露天矿钻机变幅机构运动学建模与仿真

Kinematic modeling and simulation of the luffing mechanism of an open-pit mine drill rig for safety-oriented operation

  • 摘要: 针对露天矿爆区复杂工况下潜孔钻机自主穿孔作业对末端定位精度和运动平稳性的要求,以某型潜孔钻机五自由度变幅机构为研究对象,开展运动学建模、参数标定与轨迹规划研究。基于SolidWorks建立变幅机构三维数字样机模型并导入Webots构建虚拟作业场景;采用标准D-H参数法建立机构运动学模型,求解正、逆运动学方程,并利用蒙特卡洛法分析末端可达工作空间和有效工作空间。针对理论模型与仿真模型间存在的几何参数偏差,提出粗标定与最小二乘精标定相结合的两阶段参数修正方法。在此基础上,结合钻孔作业中末端垂直地面的姿态约束,设计关节空间两阶段轨迹规划方法,采用五次多项式插值实现平移定位与垂直推进。标定结果表明,末端平均位置误差由73.5 mm减小至4.0 mm,最大位置误差控制在9.5 mm以内。仿真结果表明:逆运动学驱动下末端平均位置误差为4.55 mm,最大位置误差为8.10 mm;各关节位移、速度及加速度曲线连续,无明显突变。所提方法能够满足潜孔钻机自主穿孔作业对定位精度和运动平稳性的要求,可为露天矿钻机自主穿孔作业系统的控制方法设计与虚拟调试提供参考。

     

    Abstract: To meet the requirements for end-effector positioning accuracy and motion smoothness in autonomous drilling operations of down-the-hole drills under complex blasting-area conditions in open-pit mines, a five-degree-of-freedom luffing mechanism was studied in terms of kinematic modeling, parameter calibration, and trajectory planning. A three-dimensional digital prototype of the mechanism was established in SolidWorks and imported into Webots to construct a virtual operating environment. The standard D-H parameter method was employed to establish the kinematic model, and the forward and inverse kinematics were derived. The reachable and effective workspaces of the end effector were analyzed using the Monte Carlo method. To compensate for geometric parameter deviations between the theoretical model and the simulation model, a two-stage parameter correction method combining coarse calibration and least-squares fine calibration was proposed. Considering the attitude constraint that the end effector must remain perpendicular to the ground during drilling, a two-stage joint-space trajectory planning method was designed, and quintic polynomial interpolation was used to realize translational positioning and vertical feeding. The calibration results show that the average position error of the end effector is reduced from 73.5 mm to 4.0 mm, and the maximum position error is controlled within 9.5 mm. The simulation results show that, under inverse-kinematics-based driving, the average and maximum position errors of the end effector are 4.55 mm and 8.10 mm, respectively. In addition, the displacement, velocity, and acceleration curves of all joints are continuous without obvious abrupt changes. The proposed method can satisfy the requirements of autonomous drilling operations for positioning accuracy and motion smoothness and provide a reference for control method design and virtual debugging of autonomous drilling systems for open-pit mine drills.

     

/

返回文章
返回