一种基于多源感知的机器人作业轨迹规划方法及系统与流程
本发明涉及机器人智能控制,尤其涉及一种基于多源感知的机器人作业轨迹规划方法及系统。
背景技术:
1、随着移动机器人、机械臂及环境感知技术的发展,机器人逐渐应用于混凝土凿毛、表面清理、除冰、打磨及材料去除作业。现有机器人作业轨迹规划通常先利用激光雷达、视觉传感器、深度传感器获取作业区域的空间信息,再根据目标作业面的几何形态、作业边界和障碍区域建立环境模型,并通过路径搜索方法生成机器人移动路径及机械臂末端运动轨迹。
2、现有轨迹规划方法通常以目标作业面的静态几何可达性作为主要规划依据,环境感知结果、机器人运动状态与工具实际接触状态之间缺少统一的作业空间关联,规划阶段确定的工具位置和姿态难以准确反映工具受表面起伏、机器人定位偏差、机械臂轨迹偏差及工具推进偏差影响后的实际接触状态;对于曲面连续作业,常见方案往往先生成几何路径,再独立进行工具姿态调整,工具作业方向变化难以直接参与路径搜索区间和传播位置的确定,容易产生几何路径可达但机械臂无法保持连续作业姿态的问题。
3、同时,工具沿目标作业面持续执行覆盖作业时,已完成作业范围不断改变剩余未作业区域的空间连接关系,现有方法通常在发现残留区域、轨迹阻断或作业状态异常后重新进行整体路径规划,难以在轨迹传播过程中提前识别剩余作业区域连通状态的变化,也难以根据实时感知状态仅调整受到影响的局部轨迹范围,容易造成重复作业、无效回退、已规划有效路径丢失及轨迹重构计算量增加。
4、因此,如何提供一种基于多源感知的机器人作业轨迹规划方法及系统是本领域技术人员亟需解决的问题。
技术实现思路
1、本发明的一个目的在于提出一种基于多源感知的机器人作业轨迹规划方法及系统,本发明通过多源作业感知状态融合机器人环境、姿态及工具接触信息,并对polyanya的传播根点、传播区间及传播分支进行动态修正,使轨迹规划能够适应复杂作业表面的姿态变化、接触偏差及覆盖状态变化,减少无效重规划和重复作业,提高机器人作业轨迹规划的准确性、连续性和执行稳定性。
2、根据本发明实施例的一种基于多源感知的机器人作业轨迹规划方法,包括如下步骤:
3、获取多源作业感知数据并进行作业空间关联,形成多源作业感知状态;
4、依据多源作业感知状态提取目标作业面的作业约束信息,根据空间连续关系划分作业表面分区并建立作业表面约束拓扑;
5、针对作业表面约束拓扑调用polyanya建立传播根点,根据作业约束信息确定工具作业方向的曲面传递关系,并裁剪候选几何传播区间,得到姿态连续作业区间;
6、依据多源作业感知状态确定实际稳定接触位置并修正传播根点,重新投影姿态连续作业区间并结合曲面传递关系,形成接触修正作业区间;
7、基于接触修正作业区间建立残余作业域,根据作业覆盖变化及残余作业域的连通状态,反向修剪接触修正作业区间,得到残余作业约束区间;
8、基于残余作业约束区间重新执行区间投影,根据多源作业感知状态更新区间有效关系,撤销失效区间及关联传播分支,保留有效传播分支,形成动态作业轨迹;
9、依据动态作业轨迹输出机器人作业轨迹规划结果。
10、可选的,所述多源作业感知状态的得到具体包括:
11、采集机器人作业区域的环境空间感知数据、目标作业面的局部作业面感知数据、机器人运动状态数据和工具接触状态数据,按照机器人作业进程对采集结果进行归集,形成多源作业感知数据;
12、对多源作业感知数据执行作业空间关联,将不同感知来源形成的空间位置、机器人位姿和工具接触状态关联至统一机器人作业空间,并按照作业时刻保持感知状态之间的空间对应,形成空间关联多源作业感知数据;
13、针对空间关联多源作业感知数据建立作业状态承接关系,将目标作业面状态、机械臂末端状态和工具接触状态按照作业位置连续关联,并沿机器人作业进程更新状态关联,形成多源作业感知状态。
14、可选的,所述作业表面约束拓扑的得到具体包括:
15、依据多源作业感知状态提取目标作业面的局部作业状态,按照空间位置建立局部作业状态之间的约束关联,形成作业约束信息;
16、依据作业约束信息和目标作业面的空间连续关系划分作业表面分区,并按照作业约束信息限定作业表面分区的空间范围,形成作业表面分区集合;
17、依据作业表面分区集合确定相邻作业表面分区的共享边界,按照共享边界建立作业表面分区之间的邻接关系,并将作业约束信息关联至作业表面分区和共享边界,形成作业表面约束拓扑。
18、可选的,所述姿态连续作业区间的得到具体包括:
19、针对作业表面约束拓扑确定当前作业表面分区,将机器人当前作业位置确定为传播根点,调用polyanya由传播根点向相邻作业表面分区的共享边界执行区间投影,确定候选几何传播区间并建立传播根点与候选几何传播区间的传播来源关系;
20、获取传播根点处的工具作业方向,沿目标作业面建立传播根点至候选几何传播区间内各候选位置的曲面传递路径,采用pole ladder沿曲面传递路径将工具作业方向传递至对应候选位置,连续记录候选几何传播区间内传递工具方向随表面变化形成的方向演化关系;
21、依据方向演化关系和作业约束信息确定候选几何传播区间内的姿态连续边界,按照姿态连续边界分割候选几何传播区间,对分割区段执行传播根点继承和传播根点重新确定,形成传播根点更新结果;
22、依据传播根点更新结果裁剪候选几何传播区间,保留满足作业约束信息并具有对应传播根点的连续区段,剔除不能建立有效传播关系的分割区段,将保留的连续区段确定为姿态连续作业区间,并建立姿态连续作业区间与对应传播根点之间的区间传播关系。
23、可选的,所述接触修正作业区间的得到具体包括:
24、从多源作业感知状态中提取与姿态连续作业区间对应的接触位置观测,将接触位置观测关联至统一机器人作业空间和对应作业位置,形成接触位置观测集;
25、针对接触位置观测集选取初始接触中心,计算各接触位置观测与初始接触中心之间的空间距离,按照空间距离越小位置更新作用越强的关系确定各接触位置观测对应的位置更新权重,依据位置更新权重重新确定接触中心,重复执行空间距离计算、位置更新权重确定和接触中心更新,直至连续两次接触中心的位置变化满足稳定条件,将满足稳定条件的接触中心确定为实际稳定接触位置;
26、将实际稳定接触位置与当前传播根点建立位置偏移关系,以实际稳定接触位置修正当前传播根点,并重新确定修正传播根点相对于对应作业表面分区共享边界的连续可达范围,形成修正传播根点;
27、以修正传播根点作为新的区间投影起点,对姿态连续作业区间执行重新投影,根据修正传播根点至对应共享边界的连续可达范围重新确定区间边界,并以修正传播根点对应的工具作业方向作为曲面传递起始方向,依据曲面传递关系重新确定姿态连续作业区间内的方向演化关系,根据重新确定的区间边界和方向演化关系更新姿态连续作业区间,形成接触修正作业区间。
28、可选的,所述残余作业约束区间的得到具体包括:
29、依据接触修正作业区间的传播方向和工具有效作用范围,沿目标作业面预测工具继续执行区间传播时产生的作业覆盖带,将已经完成有效作业的表面范围从目标作业面的可作业范围中扣除,建立残余作业域,并按照接触修正作业区间的传播次序将作业覆盖带逐段作用于残余作业域,形成作业覆盖变化状态;
30、依据作业覆盖变化状态更新残余作业域,判断残余作业域的连通状态,并根据连通状态变化确定入口消失位置;
31、以入口消失位置作为反向追溯起点,沿产生入口消失位置的区间传播关系逆向追溯传播来源,按照区间之间的传播来源关系将入口消失位置逐级映射至接触修正作业区间,并将映射至接触修正作业区间的边界位置确定为反向修剪边界;
32、依据反向修剪边界裁剪接触修正作业区间,保留在作业覆盖带占用对应传播入口之前结束的连续区段,移除越过反向修剪边界并导致传播入口消失的区间范围,使残余作业域内各连续作业区域保持与当前区间传播关系相连的传播入口,形成残余作业约束区间。
33、可选的,所述动态作业轨迹的得到具体包括:
34、以残余作业约束区间作为当前传播区间,依据区间传播关系确定对应传播根点,调用polyanya沿作业表面约束拓扑向共享边界继续执行区间投影,生成传播区间并形成区间传播状态;
35、将多源作业感知状态与区间传播状态建立作业位置关联,根据传播根点、区间边界、工具作业方向和传播入口的状态变化更新区间有效关系,并在区间有效关系发生改变的位置确定失效边界位置;
36、按照失效边界位置分割对应传播区间,将不满足区间有效关系的分割区段确定为失效区间,沿传播来源关系撤销由失效区间生成的关联传播分支,并保留满足区间有效关系的分割区段和未依赖失效区间的有效传播分支;
37、从失效区间相邻的有效区段对应传播根点重新执行区间投影,仅重建受失效区间影响的区间传播关系,将重新生成的传播分支与有效传播分支按照共享边界的传播连接关系进行衔接,形成动态作业轨迹。
38、可选的,所述机器人作业轨迹规划结果的得到具体包括:
39、依据动态作业轨迹执行轨迹组织处理,按照有效传播分支和区间传播关系连接连续作业区段,形成连续作业轨迹;
40、依据连续作业轨迹执行作业姿态关联处理,将工具作业方向与作业位置进行空间关联,并按照轨迹执行次序组织,形成轨迹执行序列;
41、依据轨迹执行序列执行结果组织处理,将连续移动路径、轨迹执行次序及工具作业方向进行关联,输出机器人作业轨迹规划结果。
42、根据本发明实施例的一种基于多源感知的机器人作业轨迹规划系统,包括:
43、多源感知模块,用于获取多源作业感知数据并进行作业空间关联,形成多源作业感知状态;
44、作业表面约束模块,用于依据多源作业感知状态提取目标作业面的作业约束信息,根据空间连续关系划分作业表面分区并建立作业表面约束拓扑;
45、姿态区间传播模块,用于针对作业表面约束拓扑调用polyanya建立传播根点,根据作业约束信息确定工具作业方向的曲面传递关系,并裁剪候选几何传播区间,得到姿态连续作业区间;
46、接触位置修正模块,用于依据多源作业感知状态确定实际稳定接触位置并修正传播根点,重新投影姿态连续作业区间并结合曲面传递关系,形成接触修正作业区间;
47、残余作业约束模块,用于基于接触修正作业区间建立残余作业域,根据作业覆盖变化及残余作业域的连通状态,反向修剪接触修正作业区间,得到残余作业约束区间;
48、动态区间更新模块,用于基于残余作业约束区间重新执行区间投影,根据多源作业感知状态更新区间有效关系,撤销失效区间及关联传播分支,保留有效传播分支,形成动态作业轨迹;
49、作业轨迹输出模块,用于依据动态作业轨迹输出机器人作业轨迹规划结果。
50、本发明的有益效果是:
51、本技术针对机器人沿目标作业面连续作业时既需要满足空间可达要求,又需要保持工具作业姿态连续的问题,引入polyanya作为轨迹搜索基础。polyanya以传播根点和连续传播区间组织搜索状态,适合描述机器人沿连续作业表面进行区间扩展的轨迹规划过程;本技术并未直接采用polyanya仅依据几何可达关系进行传播的方式,而是将工具作业方向的曲面传递关系引入候选几何传播区间处理,根据目标作业面的表面方向变化确定姿态连续边界,并利用姿态连续边界更新传播根点及区间边界,使工具姿态约束直接参与polyanya区间传播,从而减少几何路径可达但机械臂无法保持连续作业姿态的情况,提高轨迹规划结果与机器人实际执行能力之间的一致性。
52、本技术针对规划接触位置与工具实际接触位置容易受到目标作业面起伏、机器人定位偏差、机械臂轨迹偏差及工具推进偏差影响的问题,利用多源作业感知状态形成接触位置观测,并根据接触位置观测与接触中心之间的空间距离关系持续更新接触中心,确定实际稳定接触位置;实际稳定接触位置直接用于修正polyanya传播根点,并基于修正传播根点重新确定共享边界上的连续可达范围,同时结合曲面传递关系更新姿态连续作业区间,使工具真实接触状态能够直接改变轨迹搜索起点及区间传播范围,降低规划轨迹与工具真实作用位置之间的累积偏差,提高复杂表面条件下轨迹规划的适应能力。
53、本技术针对连续覆盖作业过程中已完成作业范围持续改变残余作业域空间连接状态的问题,根据作业覆盖变化判断残余作业域的连通状态,在传播入口发生消失趋势时确定入口消失位置,并沿区间传播关系逆向追溯传播来源,将残余作业域的连通变化反向作用于接触修正作业区间,通过修剪区间边界形成残余作业约束区间;在实时作业状态发生变化时,再依据多源作业感知状态更新区间有效关系,仅撤销失效区间及关联传播分支,并保留有效传播分支,使局部状态变化无需触发完整轨迹重新构建,从而减少重复覆盖、无效回退和有效轨迹丢失,提高机器人连续作业轨迹规划的实时性、稳定性及作业覆盖完整性。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com