
国家知识产权局信息显示,中国矿业大学、山东天河科技股份有限公司申请一项名为“煤矿井下钻孔机器人全自动姿态与方位角调整方法及系统”的专利,公开号CN123109623A,申请日期为2026年10月。
专利摘要显示,本发明公开了一种煤矿井下钻孔机器人全自动姿态与方位角调整方法及系统。方法包括:S1获取目标钻孔参数;S2采集实时姿态数据并自动调平,建立寻北‑四元数初始基准;S3解算各自由度偏差量并映射为各关节执行参数作为前馈量,对前馈量进行第一级预补偿;S4采用前馈与反馈复合控制策略,以四元数‑模糊PID联合控制器实现闭环姿态自动调节;S5姿态调整过程中同步启动第二级在线补偿,实时计算残余动态误差并进行微调补偿;S6精度满足后锁定姿态并输出完成信号;S7钻进过程中持续监测并动态修正姿态。本发明实现了钻孔机器人姿态与方位角的全流程自动化闭环控制,无需人工干预,定位精度高、调节效率高、适应性强。
声明:市场有风险,投资需谨慎。本文为AI基于第三方数据生成,仅供参考,不构成个人投资建议。













