基于点云模型的清洁机器人机械臂路径生成方法及系统与流程
本申请涉及路径生成领域,且更为具体地,涉及一种基于点云模型的清洁机器人机械臂路径生成方法及系统。
背景技术:
1、随着智能清洁机器人在卫浴、厨房等复杂曲面环境中的应用日益深入,其机械臂需要在具有多变曲率的异形表面上完成喷淋、擦拭、吸污、风干等多道工序的精密作业。这些作业表面往往具有不规则的几何形态,传统的基于二维平面或简单参数曲面的路径规划方法难以准确描述其空间拓扑特征,导致机械臂末端执行器无法与目标表面保持合理的作业姿态与距离关系。三维点云模型能够以离散采样的方式高保真地还原目标表面的几何细节与法向分布信息,为机械臂在复杂曲面上的路径生成提供精确的空间参考基准,因此构建基于点云模型的清洁机器人机械臂路径生成方案具有显著的工程必要性。
2、然而,现有技术中针对机械臂路径规划的研究多聚焦于工业焊接、喷涂等场景,其末端执行器类型单一且固定不变,规划算法将机械臂末端视为具有恒定几何参数的单一工具坐标点进行全局轨迹求解。而清洁机器人配备磁吸式快拆接口,需在喷水头、污水回收头、风干头等多种工具之间进行频繁切换,不同工具不仅结构尺寸差异显著导致工具坐标系空间偏移量突变,且各自要求的作业空间拓扑关系完全不同——污水回收头需与曲面实现近零距离物理贴合,高压喷水头需保持十五至二十厘米的非接触喷淋射距,风干头则需维持特定倾角的气流动力学间距。现有方案在完成某项工序并执行换头动作后,仅对路径坐标进行简单的线性平移补偿,未能建立工具物理属性与点云曲面法向拓扑之间的深度语义耦合关系,当目标曲面存在曲率突变时,不同作业距离的非线性投影干涉使得新工具无法获得从旧轨迹退出点到新作业曲面的平滑切入路径,从而产生运动学断层,导致机械臂在工具切换后出现剧烈顿挫碰撞或路径求解失效的停机现象。
3、为此,期望一种基于点云模型的清洁机器人机械臂路径生成方法,能够在工具频繁切换时实现旧轨迹退出与新轨迹切入之间的时空连续平滑过渡,消除运动学断层。
技术实现思路
1、针对现有技术中所存在的上述问题,本申请提供了一种基于点云模型的清洁机器人机械臂路径生成方法,其包括:s1,对获取的多源感知数据进行空间配准与泊松曲面重建以得到携带各顶点高斯曲率法向量的基准表面异形网格集合,其中,多源感知数据包含多线激光雷达三维点云坐标集合和深度相机作业面深度图像矩阵;s2,基于当前挂载快拆工具头硬件识别码,对设备属性数据库进行检索与语义封装处理以得到融合静态几何碰撞边界矩阵与动态作业流场视距约束向量的当前工具数字孪生语义包络模型;s3,基于当前工具数字孪生语义包络模型,对基准表面异形网格集合进行沿法向的自适应膨胀或坍缩偏移及碰撞试探剔除以得到专属三维作业流形曲面点集;s4,以上一序工具退出位姿矩阵为过渡起始锚点、以专属三维作业流形曲面点集中运动学代价最低的边缘节点为切入目标锚点,进行时空过渡张量场桥接规划以得到多模态工具无缝切入桥接轨迹矩阵;s5,将多模态工具无缝切入桥接轨迹矩阵与专属三维作业流形曲面点集进行时间戳串接后,基于六轴机械臂本征底座坐标系参数进行逆运动学求解与奇点松弛平滑处理以得到六轴机械臂连续关节角驱动指令集。
2、本申请还提供了一种基于点云模型的清洁机器人机械臂路径生成系统,其包括:多源感知数据处理模块,用于对获取的多源感知数据进行空间配准与泊松曲面重建以得到携带各顶点高斯曲率法向量的基准表面异形网格集合,其中,多源感知数据包含多线激光雷达三维点云坐标集合和深度相机作业面深度图像矩阵;设备属性数据检索封装模块,用于基于当前挂载快拆工具头硬件识别码,对设备属性数据库进行检索与语义封装处理以得到融合静态几何碰撞边界矩阵与动态作业流场视距约束向量的当前工具数字孪生语义包络模型;流形曲面生成模块,用于基于当前工具数字孪生语义包络模型,对基准表面异形网格集合进行沿法向的自适应膨胀或坍缩偏移及碰撞试探剔除以得到专属三维作业流形曲面点集;张量场桥接规划模块,用于以上一序工具退出位姿矩阵为过渡起始锚点、以专属三维作业流形曲面点集中运动学代价最低的边缘节点为切入目标锚点,进行时空过渡张量场桥接规划以得到多模态工具无缝切入桥接轨迹矩阵;关节角驱动指令生成模块,用于将多模态工具无缝切入桥接轨迹矩阵与专属三维作业流形曲面点集进行时间戳串接后,基于六轴机械臂本征底座坐标系参数进行逆运动学求解与奇点松弛平滑处理以得到六轴机械臂连续关节角驱动指令集。
3、与现有技术相比,本申请提供的一种基于点云模型的清洁机器人机械臂路径生成方法及系统,其在于建立从点云曲面感知到工具语义封装再到跨工具轨迹桥接的全链路动态适配机制。首先通过多源传感器融合与泊松曲面重建获取携带高斯曲率法向信息的基准表面模型,为路径偏移提供精确几何锚定;其次以工具头硬件识别码为索引提取当前工具的碰撞边界与作业流场约束并封装为数字孪生语义包络模型,将工具多维物理特性转化为可参与路径运算的结构化约束参量;再以该语义包络模型驱动基准表面沿法向自适应偏移并剔除碰撞干涉节点,生成专属于当前工具的三维作业流形曲面,解决不同工具作业距离与姿态要求差异导致的空间投影失配问题;最后以上一工具退出位姿为起点、以新工具作业流形的运动学代价最优边缘节点为终点,通过势能场梯度引导与b样条平滑实现跨工具时空过渡桥接,消除工具切换时的运动学断层,保证机械臂关节角驱动指令的连续平滑可执行性。
1.一种基于点云模型的清洁机器人机械臂路径生成方法,其特征在于,包括:
2.根据权利要求1所述的基于点云模型的清洁机器人机械臂路径生成方法,其特征在于,步骤s1,包括:
3.根据权利要求1所述的基于点云模型的清洁机器人机械臂路径生成方法,其特征在于,步骤s2,包括:
4.根据权利要求1所述的基于点云模型的清洁机器人机械臂路径生成方法,其特征在于,步骤s3,包括:
5.根据权利要求1所述的基于点云模型的清洁机器人机械臂路径生成方法,其特征在于,步骤s4,包括:
6.根据权利要求1所述的基于点云模型的清洁机器人机械臂路径生成方法,其特征在于,步骤s5,包括:
7.根据权利要求6所述的基于点云模型的清洁机器人机械臂路径生成方法,其特征在于,基于雅可比条件数操作度评估特征向量的奇异阈值检测结果,对未平滑六轴关节角序列状态表中的濒危帧进行奇异区域容差松弛解算与关节运动平滑以得到六轴机械臂连续关节角驱动指令集,包括:
8.一种基于点云模型的清洁机器人机械臂路径生成系统,其特征在于,包括:
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com