机器人示教数据的采集方法和数据采集装置与流程
本申请涉及数据处理领域,尤其涉及一种机器人示教数据的采集方法和数据采集装置。
背景技术:
1、手持式机器人示教数据采集装置通常由操作者握持,并在操作者手部运动下带动末端操作机构运动。现有装置一般通过传感器获取末端操作机构或工具中心点的位姿,并将该位姿与图像数据、夹爪状态等信息关联,形成示教训练数据。由于操作者手部抖动会直接传递至末端操作机构,所采集的数据中可能混入非期望运动。部分方案在数据处理阶段对位姿序列进行平滑处理,但平滑后的动作标签与图像所记录的真实交互之间可能不再严格对应,影响示教训练数据的质量。
技术实现思路
1、本申请实施例提供了一种机器人示教数据的采集方法和数据采集装置,可以解决现有技术中现有手持式示教数据采集装置难以兼顾手抖抑制与动作标签同真实交互的一致性,导致示教数据质量下降的问题。所述技术方案如下:
2、第一方面,本申请实施例提供了一种机器人示教数据的采集方法,包括:
3、数据采集装置包括用户操作组件、抖动补偿组件和末端执行组件;所述用户操作组件包括第一惯性测量单元;所述抖动补偿组件包括编码器和补偿执行机构;所述末端执行组件包括视觉传感器、第二惯性测量单元和末端操作机构,所述末端操作机构具有工具中心点;所述方法包括:
4、获取所述第一惯性测量单元输出的输入运动数据,以及获取所述第二惯性测量单元输出的末端运动数据;
5、获取所述编码器输出的反馈位置数据,以及所述末端操作机构的操作状态数据;
6、基于预设的标定参数,根据所述输入运动数据、所述末端运动数据与所述反馈位置数据,计算所述用户操作组件的原始位姿数据、所述末端执行组件的末端位姿数据和所述工具中心点的中心位姿数据,并根据所述末端位姿数据校验所述中心位姿数据,得到校验后的中心位姿数据;
7、根据预设的任务配置参数、所述标定参数和所述原始位姿数据,在所述工具中心点处确定待衰减运动分量;
8、根据所述待衰减运动分量和所述操作状态数据生成补偿控制量,所述控制量用于驱动所述补偿执行机构进行抖动补偿操作,并通过所述编码器反馈形成控制闭环;
9、对所述视觉传感器采集的图像观测数据、所述操作状态数据和所述校验后的中心位姿数据进行对齐,并根据已对齐的中心位姿数据生成训练动作标签;
10、将已对齐的图像观测数据、操作状态数据和所述训练动作标签关联,得到示教训练数据。
11、第二方面,本申请实施例提供了一种机器人示教数据的采集装置,包括:
12、获取模块,用于获取所述第一惯性测量单元输出的输入运动数据,以及获取所述第二惯性测量单元输出的末端运动数据;
13、所述获取模块,还用于获取所述编码器输出的反馈位置数据,以及所述末端操作机构的操作状态数据;
14、计算模块,用于基于预设的标定参数,根据所述输入运动数据、所述末端运动数据与所述反馈位置数据,计算所述用户操作组件的原始位姿数据、所述末端执行组件的末端位姿数据和所述工具中心点的中心位姿数据,并根据所述末端位姿数据校验所述中心位姿数据,得到校验后的中心位姿数据;
15、确定模块,用于根据预设的任务配置参数、所述标定参数和所述原始位姿数据,在所述工具中心点处确定待衰减运动分量;
16、驱动模块,用于根据所述待衰减运动分量和所述操作状态数据生成补偿控制量,所述控制量用于驱动所述补偿执行机构进行抖动补偿操作,并通过所述编码器反馈形成控制闭环;
17、采集模块,用于对所述视觉传感器采集的图像观测数据、所述操作状态数据和所述校验后的中心位姿数据进行对齐,并根据已对齐的中心位姿数据生成训练动作标签;
18、生成模块,用于将已对齐的图像观测数据、操作状态数据和所述训练动作标签关联,得到示教训练数据。
19、第三方面,本申请实施例提供一种计算机存储介质,所述计算机存储介质存储有多条指令,所述指令适于由处理器加载并执行上述的方法步骤。
20、第四方面,本申请实施例提供一种机器人,可包括:处理器和存储器;其中,所述存储器存储有计算机程序,所述计算机程序适于由所述处理器加载并执行上述的方法步骤。
21、本申请一些实施例提供的技术方案带来的有益效果至少包括:
22、本申请通过抖动补偿组件在用户操作组件与末端执行组件之间进行物理补偿,并由编码器反馈形成控制闭环,使手抖在末端操作机构与物体交互前即被抑制,训练动作标签对应补偿后真实发生的末端轨迹,避免事后平滑造成观察与动作错位。同时,基于输入运动数据、末端运动数据与反馈位置数据计算并校验工具中心点的中心位姿数据,在工具中心点处结合任务配置参数确定待衰减运动分量,并结合操作状态数据生成补偿控制量,使补偿兼顾目标机器人可执行能力与接触阶段操作需求。由此,本申请在抑制手抖的同时保持图像观测、操作状态与训练动作标签同源对齐,提高示教训练数据的一致性和可用性。
1.一种机器人示教数据的采集方法,其特征在于,所述方法应用于数据采集装置,所述数据采集装置包括用户操作组件、抖动补偿组件和末端执行组件;所述用户操作组件包括第一惯性测量单元;所述抖动补偿组件包括编码器和补偿执行机构;所述末端执行组件包括视觉传感器、第二惯性测量单元和末端操作机构,所述末端操作机构具有工具中心点;所述方法包括:
2.根据权利要求1所述的方法,其特征在于,所述基于所述标定参数,根据所述输入运动数据、所述末端运动数据与所述反馈位置数据,计算所述用户操作组件的原始位姿数据、所述末端执行组件的末端位姿数据和所述工具中心点的中心位姿数据,并根据所述末端位姿数据校验所述中心位姿数据,得到校验后的中心位姿数据,包括:
3.根据权利要求2所述的方法,其特征在于,所述根据所述输入运动数据和所述标定参数,计算所述用户操作组件的原始位姿数据,包括:
4.根据权利要求2所述的方法,其特征在于,所述根据所述反馈位置数据和所述标定参数,计算所述用户操作组件与所述末端执行组件之间的相对位姿数据,包括:
5.根据权利要求1所述的方法,其特征在于,所述根据所述任务配置参数和所述标定参数,基于所述原始位姿数据,在所述工具中心点处确定待衰减运动分量,包括:
6.根据权利要求1所述的方法,其特征在于,所述根据所述待衰减运动分量和所述操作状态数据生成补偿控制量,包括:
7.根据权利要求6所述的方法,其特征在于,驱动所述补偿执行机构进行抖动补偿操作,并通过所述编码器反馈形成控制闭环,包括:
8.根据权利要求1所述的方法,其特征在于,所述根据已对齐的中心位姿数据生成训练动作标签,包括:
9.根据权利要求1所述的方法,其特征在于,还包括:
10.根据权利要求1所述的方法,其特征在于,还包括:
11.根据权利要求9所述的方法,其特征在于,还包括:
12.一种数据采集装置,其特征在于,包括:处理器和存储器;其中,所述存储器存储有计算机程序,所述计算机程序适于由所述处理器加载并执行如权利要求1至11任意一项所述的机器人示教数据的采集方法的步骤。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com