多设备协同作业的控制方法及系统与流程
本申请涉及工业机器人运动控制,具体涉及多设备协同作业的控制方法及系统。
背景技术:
1、在工业机器人作业场景中,机器人常需与变位机、滑台、移动平台等外部运动机构配合使用。现有技术通常采用针对固定构型的专用映射模型,或将外部机构简单视为附加关节进行位置同步。然而,当现场设备构型发生重组、多级串接或混合平移与回转时,固定构型模型难以复用,需重新建模;同时,若仅在运动开始前进行一次坐标转换,当工件随外部机构移动或旋转时,工具相对于工件的路径会发生偏移,无法保持稳定的相对轨迹;此外,现有方案往往缺乏对机器人与外部机构协同运动能力的执行前校验,容易在执行过程中因速度或加速度超限而导致跟随失稳或任务中断。因此,急需一种能够适应多变构型、保持相对轨迹稳定且具备协同可行性预判的多设备协同作业的控制方法。
技术实现思路
1、针对现有技术存在的多设备协同作业中构型固化难扩展、相对轨迹易漂移以及协同运动缺乏执行前可达性校验的问题,本申请通过多设备协同作业的控制方法,实现运动链的灵活重构、工具相对于作业对象的局部路径严格一致以及协同运动的可行性与平滑性保障。
2、为实现上述目的,本申请采用如下技术方案:
3、一种多设备协同作业的控制方法,包括:获取多个空间关系节点,每个所述空间关系节点包含创建参考关系和运行挂接关系,所述创建参考关系用于指示局部空间表达,所述运行挂接关系用于指示运行时随动的父节点;基于所述运行挂接关系递归求解作业参考坐标系的当前空间位姿;获取所述作业参考坐标系的起始空间关系,并基于所述起始空间关系将原始目标转换为局部目标;基于所述当前空间位姿将所述局部目标映射为补偿目标,并基于所述补偿目标生成协同控制指令。
4、作为一种可选实施方式,所述创建参考关系在运行过程中保持不变,所述运行挂接关系支持动态挂接与解挂;所述基于所述运行挂接关系递归求解作业参考坐标系的当前空间位姿,包括:从所述作业参考坐标系对应的目标节点向根节点进行递归遍历,依次叠加各所述空间关系节点的静态安装关系与动态运动关系,得到所述当前空间位姿。
5、作为一种可选实施方式,所述空间关系节点包括线性运动节点;进行所述叠加时,基于标定得到的平移方向和零位位置,将当前位置表示为沿所述平移方向的动态平移关系,所述标定得到的平移方向通过采集多个不同位置下的同一参考点的位移向量拟合确定;将所述动态平移关系与对应的静态安装关系叠加。
6、作为一种可选的实施方式,所述空间关系节点包括回转运动节点;进行所述叠加时,基于标定得到的旋转轴线和旋转中心,将当前角度表示为围绕所述旋转轴线并经过所述旋转中心的动态旋转关系,所述标定得到的旋转轴线和旋转中心通过采集多个不同姿态下的参考点轨迹拟合确定;将所述动态旋转关系与对应的静态安装关系叠加。
7、作为一种可选的实施方式,当所述作业参考坐标系从一个所述空间关系节点切换至另一个所述空间关系节点时,保持所述局部空间表达不变,仅更新对应的所述运行挂接关系,其中,切换父节点时,重新计算相对于新父节点的安装关系,以保持全局位姿连续。
8、作为一种可选实施方式,所述基于所述起始空间关系将原始目标转换为局部目标,包括:基于所述起始空间关系的逆变换,将所述原始目标从全局基准坐标系转换至所述作业参考坐标系,得到所述局部目标;所述基于所述当前空间位姿将所述局部目标映射为补偿目标,包括:在每个控制周期内,基于所述当前空间位姿的正变换,将所述局部目标从所述作业参考坐标系映射回所述全局基准坐标系,得到所述补偿目标;对所述补偿目标进行逆运动学求解,得到机器人关节目标。
9、作为一种可选实施方式,所述基于主运动规划时间对协同运动轴进行可达性预判,包括:获取所述协同运动轴的当前运动状态和目标运动状态;基于所述当前运动状态和目标运动状态,计算所述协同运动轴的最短可行时间;若所述最短可行时间大于所述主运动规划时间,则在执行前生成不可达结果;若所述最短可行时间小于或等于所述主运动规划时间,则在所述主运动规划时间内生成满足所述速度约束和所述加速度约束的同步轨迹。
10、作为一种可选实施方式,所述方法还包括安全退出流程:响应于接收到停用请求,冻结最后一个所述补偿目标以及所述协同运动轴的目标位置和速度,得到冻结状态;以所述冻结状态为起点生成平滑减速段,使机器人基于所述补偿目标和所述协同运动轴的速度连续衰减至预设阈值;在所述速度衰减至所述预设阈值后,统一停用所述作业参考坐标系的跟随关系与所述补偿目标的补偿关系;其中,在生成所述平滑减速段的过程中,保持所述机器人和所述协同运动轴在同一个控制周期内输出减速目标,所述平滑减速段的速度曲线满足加速度连续性约束。
11、作为一种可选实施方式,当存在连续转接场景时,所述方法还包括:获取相邻运动段的转接点处的边界速度;若所述边界速度无法在所述速度约束和所述加速度约束内衔接,则在执行前返回规划失败结果,或者在允许的工艺范围内降低局部速度并重新分配相邻运动段的同步时间;在生成所述同步轨迹时,对于单个所述协同运动轴,基于满足预设运动约束的轨迹规划方式计算所述最短可行时间。
12、此外,本申请还提供了一种机器人系统,包括:机器人本体;至少一个协同运动轴;以及控制装置,所述控制装置分别与所述机器人本体和所述至少一个协同运动轴通信连接,用于基于如上控制方法,控制所述机器人本体和所述至少一个协同运动轴协同作业。
13、有益效果:
14、本申请提供的多设备协同作业的控制方法、装置、存储介质及机器人系统,通过构建包含创建参考关系和运行挂接关系的层级空间节点,并基于运行挂接关系递归求解当前空间位姿,实现了运动链的按需重构与坐标系的动态切换,使得同一套控制逻辑能够适应线性、回转及其多级串接等多种现场构型,解决了传统固定构型模型难以复用的问题。
15、进一步地,通过记录作业参考坐标系的起始空间关系,将原始目标转换为局部目标,并在每个控制周期基于当前空间位姿将局部目标重映射为补偿目标,确保了无论外部运动机构如何移动或旋转,工具相对于作业对象的局部路径始终保持严格一致,有效消除了因工件位姿变化导致的相对轨迹漂移。
16、此外,通过基于主运动规划时间对协同运动轴进行最短可行时间预判,并在执行前拦截不可达情况,以及在停用补偿时采用冻结末态并生成平滑减速段的安全退出机制,从规划源头和执行末端双重保障了多轴协同运动的运动学可行性与状态连续性,避免了执行过程中的被动超限、抖动或突变停机,显著提升了协同作业的可靠性与安全性。
1.一种多设备协同作业的控制方法,其特征在于,包括:
2.根据权利要求1所述的控制方法,其特征在于,所述创建参考关系在运行过程中保持不变,所述运行挂接关系支持动态挂接与解挂;
3.根据权利要求2所述的控制方法,其特征在于,所述空间关系节点包括线性运动节点;
4.根据权利要求2所述的控制方法,其特征在于,所述空间关系节点包括回转运动节点;
5.根据权利要求2-4任一项所述的控制方法,其特征在于,所述方法还包括:
6.根据权利要求1所述的控制方法,其特征在于,所述基于所述起始空间关系将原始目标转换为局部目标,包括:
7.根据权利要求1所述的控制方法,其特征在于,基于主运动规划时间对协同运动轴进行可达性预判,包括:
8.根据权利要求1-7任一项所述的控制方法,其特征在于,所述方法还包括安全退出流程:
9.根据权利要求7所述的控制方法,其特征在于,当存在连续转接场景时,所述方法还包括:
10.一种机器人系统,其特征在于,包括:
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com