基于行走路径规划的钻孔机器人姿态控制系统及方法与流程
本发明涉及机器人及自动化施工,尤其涉及基于行走路径规划的钻孔机器人姿态控制系统及方法。
背景技术:
1、在现代工业制造、建筑施工、航空航天部件加工等领域,钻孔作业作为关键工序,对作业精度、效率及安全性有着极高要求,随着自动化技术的发展,钻孔机器人逐步取代人工完成高难度、高强度的钻孔任务,其作业性能直接影响产品整体质量与生产进度。
2、当前,钻孔机器人的路径规划与姿态控制多为独立设计模式,一方面是仅依据当前孔位信息进行姿态调整,未考虑后续孔位的分布特征,导致机器人在连续钻孔作业中频繁切换姿态,动作连贯性差,作业效率低下,且移动平台、机械臂及末端执行器的运动控制相互独立,缺乏协同配合,严重降低作业效率;
3、另一方面是路径段运动平滑性设计不合理,相邻路径点间的曲率、坡度突变或关节角度转动速率失衡,易引发机器人运行抖动、调平滞后等问题,且路径与姿态的协同验证机制不完善,未通过数字孪生仿真与多维度参数校验实现全流程闭环优化,导致实际作业中碰撞风险、可达性失效等问题频发,难以保障作业质量的稳定性。
技术实现思路
1、本发明的目的在于提供基于行走路径规划的钻孔机器人姿态控制系统及方法,是通过多维度验证机制、绑定路径点位置与姿态可行域、统一时间轴、运动参数求解与标准化控制指令生成及模拟验证与指令输出,实现钻孔机器人的高效、精准、稳定钻孔作业,以解决上述提出的技术缺陷。
2、本发明的目的可以通过以下技术方案实现:基于行走路径规划的钻孔机器人姿态控制系统,包括采集处理模块、姿态控制中心、路径规划模块、姿态适配模块、运动参数求解模块、模拟验证模块及后端可视模块;
3、采集处理模块用于对获取的工件三维模型和待钻孔位坐标集进行预处理得到初始标准数据,并将初始标准数据发送至姿态控制中心进行存储;
4、路径规划模块基于初始标准数据,并采用路径规划算法生成路径点序列,结合机器人本体运动学、作业环境及姿态适配约束,对路径点进行可达性、碰撞风险及姿态约束适配验证,对路径段进行运动平滑性验证,通过修正迭代形成可行路径点序列;
5、姿态适配模块用于对可行路径点序列中每个路径点,筛选前方k个待钻孔位并提取其空间分布特征与法向特征,求解得到姿态可行域,将其与路径点三维位置坐标绑定,形成位置-姿态双属性路径点;
6、运动参数求解模块用于调用机器人运动学模型参数,基于路径点姿态约束通过运动学逆解求得多组运动参数并筛选最优运动参数集,对相邻路径点运动参数进行平滑过渡处理,生成时序轨迹数据集并转换为标准化控制指令;
7、模拟验证模块用于基于标准化控制指令进行钻孔模拟,评估运行稳定性、执行准确性及协同一致性并评分,结合钻孔质量数据计算质量达标率,通过迭代调整直至模拟合格并输出标准化控制指令。
8、优选的,所述路径规划模块的分析过程如下:
9、t1:以孔位作业顺序为指引,采用路径规划算法,规划移动机器人平台的全局行走轨迹,生成由一系列连续路径点构成的路径点序列p0,p1,…,pn,其中,i=0,1,…,n,p0为作业起始点,pn对应最后一个孔位的作业区域邻近点,各路径点均包含三维位置坐标(x,y,z);
10、t2:获取到钻孔机器人的预设基础约束条件,基于预设基础约束条件,针对路径点序列p0,p1,…,pn中的每个路径点pi进行可达性验证、碰撞风险验证及姿态约束适配验证,若均验证通过,则分析相邻路径点pi与p(i+1)之间的路径段,对pi与p(i+1)之间的路径段进行运动平滑性验证,若验证满足要求,则判定路径段合格,若验证不满足要求,判定路径段不合格;
11、若验证存在不通过,则将对应的路径点pi设定为待规划路径点,对待规划路径点进行修正;
12、t3:对修正后的路径点及路径段重复上述t1至t2验证流程,直至所有路径点和路径段均验证通过,形成最终的可行路径点序列。
13、优选的,运动平滑性验证:分析相邻路径点pi与p(i+1)之间的路径段,计算路径段的稳定参数和关节角度转动参数,对路径段的稳定参数和关节角度转动参数进行判别处理,若路径段的稳定参数和关节角度转动参数均满足预设阈值范围内,则判定为路径段合格,若路径段的稳定参数和关节角度转动参数中存在不满足预设阈值范围的情况,则判定为路径段不合格,立即输出修正指令。
14、优选的,所述姿态适配模块的分析过程如下:
15、s1:针对可行路径点序列中每个路径点pi,筛选路径点pi前方未来k个待钻孔位,k>0;
16、s2:提取筛选出的k个孔位的空间分布特征和法向特征,建立孔位空间特征数据集;
17、s3:基于孔位空间特征数据集,通过空间几何运算和约束条件求解,得到路径点pi的姿态可行域;
18、s4:将得出的姿态可行区域作为附加姿态约束,与路径点pi的三维位置坐标绑定,形成位置-姿态双属性路径点。
19、优选的,所述运动参数求解模块的分析过程如下:
20、ss1:调用钻孔机器人运动学模型参数;
21、ss2:针对路径点序列中的每个路径点pi,将路径点pi对应的预期姿态域作为目标约束,结合机器人运动学模型,求得满足目标约束的多组机械臂各关节角度、移动平台转向角度、调平支腿初始高度;
22、ss3:基于关节运动行程最小、机械臂避障最优为目标,筛选出路径点对应的最优关节角度组合与平台调整参数,组成最优运动参数集。
23、优选的,还包括ss4:针对相邻路径点pi和p(i+1)的最优运动参数集,对相邻路径点间的运动参数进行平滑过渡处理,生成移动平台轮组速度曲线、调平支腿高度调整时序、机械臂各关节角度变化轨迹;
24、ss5:以移动平台的行驶时间为基准,将各时间节点tk对应的所有部件插值参数按时间轴排序,形成完整的时序轨迹数据集,将时序轨迹数据集转换为钻孔机器人各执行部件可识别的标准化控制指令。
25、优选的,所述模拟验证模块的分析过程如下:
26、获取到钻孔模拟过程中钻孔机器人的运行视频流,基于运行视频流获取到钻孔机器人的运行稳定性、执行准确性及协同一致性;
27、获取到运行稳定性、执行准确性及协同一致性对应的预设权重系数,基于运行稳定性×对应的预设权重系数+执行准确性×对应的预设权重系数+协同一致性×对应的预设权重系数计算得到测试过程评分,并对测试过程评分进行判别处理,得到钻孔模拟失败或反馈指令。
28、优选的,当生成反馈指令时,获取到钻孔模拟过程中工件的钻孔质量数据,逐一对钻孔质量数据中参数与预设基准进行比对,记录合格项参数的占比率,并将合格项参数的占比率设定为质量达标率,对质量达标率进行判别处理,基于判别结果,直接输出标准化控制指令。
29、本发明的有益效果如下:
30、(1)本发明是通过多维度验证机制:可达性验证、碰撞风险验证、姿态约束适配验证及运动平滑性验证结合数字孪生虚拟仿真,全面排查路径点及路径段的潜在问题,从源头规避碰撞风险、可达性失效等安全隐患,且通过绑定路径点位置与姿态可行域,形成位置-姿态双属性路径点,大幅减少姿态调整耗时,同时基于孔位空间分布特征与法向特征动态求解姿态可行域,使机器人姿态能够精准匹配孔位分布规律与作业朝向要求,有效的解决多孔位、复杂法向场景下的姿态适配难题;
31、(2)本发明还通过以移动平台行驶时间为统一时间轴,同步规划机械臂、移动平台、调平支腿的运动参数,确保同一时间节点下各部件动作精准匹配,彻底解决协调作业失衡问题,以及基于运行稳定性、执行准确性、协同一致性及作业质量数据进行双重校验,及时发现并修正控制指令中的不合理参数,确保系统在复杂作业环境下始终保持高可靠性与稳定性。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com