CN114888794A - 一种机器人人机交互运行路径标记方法及装置 - Google Patents

一种机器人人机交互运行路径标记方法及装置 Download PDF

Info

Publication number
CN114888794A
CN114888794A CN202210435599.6A CN202210435599A CN114888794A CN 114888794 A CN114888794 A CN 114888794A CN 202210435599 A CN202210435599 A CN 202210435599A CN 114888794 A CN114888794 A CN 114888794A
Authority
CN
China
Prior art keywords
point
robot
marking
path
target position
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202210435599.6A
Other languages
English (en)
Other versions
CN114888794B (zh
Inventor
阎相伊
许佳音
李玉河
董建
张晓芳
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Tianjin Research Institute Of Construction Machinery Co ltd
Original Assignee
Tianjin Research Institute Of Construction Machinery Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Tianjin Research Institute Of Construction Machinery Co ltd filed Critical Tianjin Research Institute Of Construction Machinery Co ltd
Priority to CN202210435599.6A priority Critical patent/CN114888794B/zh
Publication of CN114888794A publication Critical patent/CN114888794A/zh
Application granted granted Critical
Publication of CN114888794B publication Critical patent/CN114888794B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Abstract

本申请一种机器人人机交互运行路径标记方法及装置,包括:获取工件的三维点云图,在所述三维点云图中设置路径规划的点云图截断面;在所述截断面中选择机器人目标位置,基于所述目标位置确定穿过所述目标位置的直线的最远点和最近点,生成位置基线;获取当前视面上的每个点到所述位置基线的距离,选择所述距离最小的点作为近邻点,将所述近邻点垂直连接到所述位置基线的垂点作为标记点;将多个所述标记点连接生成所述机器人运行路径。本申请通过实现自动确定标记点,生成路径,实现可视化路径点选,通过人机交互进行路径规划,提高路径规划精度的同时简化规划步骤。

Description

一种机器人人机交互运行路径标记方法及装置
技术领域
本申请请求保护路径规划技术,尤其涉及一种机器人人机交互运行路径标记方法及一种机器人曲面运行路径标记方法。本申请还涉及一种机器人人机交互运行路径标记装置及一种机器人曲面运行路径标记装置。
背景技术
工业机器人是指关节性机器人,其根据任务作业需求,需要进行运动轨迹的规划,以实现任务执行的完成。现有技术中,工业机器人作业的轨迹生成主要有四种方式,包括人工示教、离线仿真编程、拖动示教、视觉免示教四种方法。
人工示教方法采用示教器操作机器人在精准定位的工件上进行逐点示教,记录所有点位数据形成作业路径,该方法适用于精度要求较低,路径轨迹较为简单的作业,无法适用于搞定度,高复杂性的轨迹生成。
离线仿真软件编程方法一般采用各机器人厂家自研的机器人仿真软件进行离线编程,其编程方法为在软件中导入工件及其作业线体的三维数模,并还原机器人与工件空间位置,在仿真软件上进行路径的编程操作,该方法前期准备工作较为复杂繁琐,限制条件较多,前期准备工作量较大,仅是在编程上节省了部分时间。
拖动示教方法仅适用于部分支持拖动示教的机器人,同时其该方法也无法适用于精度要求较高的作业。
视觉免示教方法为目前新兴的一种机器人路径规划方法,其原理为利用3D视觉传感器对工件进行图像采集得到工件表面三维点云,通过图像处理获取图像角点、轮廓等图像特征,经过对图像特征的一系列三维点云处理与分析形成机器人作业路径,最后通过机器人与相机的标定得到机器人与相机的空间转换关系,将图像上生成的路径转换为机器人最终作业路径。该方法速度快,灵活性强,但受制于三维点云处理算法的处理能力,对于外观形状不规则或较为复杂的工件最终生成的轨迹可能存在偏差,此时需要一种人机交互方法在采集到的三维点云上进行机器人路径的规划或纠偏。
发明内容
为了解决上述技术方案中的一个或者多个技术问题,本申请提供一种机器人人机交互运行路径标记方法及一种机器人曲面运行路径标记方法。本申请还涉及一种机器人人机交互运行路径标记装置及一种机器人曲面运行路径标记装置。
本申请提供一种机器人人机交互运行路径标记方法,包括:
获取工件的三维点云图,在所述三维点云图中设置路径规划的点云图截断面;
在所述截断面中选择机器人目标位置,基于所述目标位置确定穿过所述目标位置的直线的最远点和最近点,生成位置基线;
获取当前视面上的每个点到所述位置基线的距离,选择所述距离最小的点作为近邻点,将所述近邻点垂直连接到所述位置基线的垂点作为标记点;
将多个所述标记点连接生成所述机器人运行路径。
可选的,所述目标位置确定步骤如下:
将鼠标移动到所述点云的显示窗口中所述目标位置,获取所述鼠标在桌面的坐标,获取所述显示窗口在桌面的坐标;
将所述鼠标在桌面的坐标减去所述显示窗口在桌面的坐标,获得所述目标位置。
可选的,还包括:
根据所述点云图的获取装置坐标与机器人坐标关系,进行空间关系变换;
根据所述空间关系变化,将所述运行路径转换为机器人的作业路径。
可选的,所述最近点到最远点的向量为所述标记点的法向量。
本申请还提供一种机器人曲面运行路径标记方法,包括:
获取工件的三维点云图,根据所述点云图设置路径规划的点云图截断面;
在所述截断面中选择机器人目标位置,基于所述目标位置确定穿过所述目标位置的直线的最远点和最近点,生成位置基线;
获取当前视面上的每个点到所述位置基线的距离,选择所述距离最小的点作为近邻点,将所述近邻点垂直连接到所述位置基线的垂点作为标记点;
分别标记机器人在曲面运行路径的起始标记点和终止标记点,并生成标记点连线;
将所述标记点连线分割为多个间隔,获取每个间隔上距离所述标记点连接线的最近点;
连接所述最近点,生成曲面运行路径。
本申请还提供一种机器人人机交互运行路径标记装置,包括:
截面模块,用于获取工件的三维点云图,在所述三维点云图中设置路径规划的点云图截断面;
选择模块,用于在所述截断面中选择机器人目标位置,基于所述目标位置确定穿过所述目标位置的直线的最远点和最近点,生成位置基线;
标记模块,用于获取当前视面上的每个点到所述位置基线的距离,选择所述距离最小的点作为近邻点,将所述近邻点垂直连接到所述位置基线的垂点作为标记点;
路径模块,用于将多个所述标记点连接生成所述机器人运行路径。
可选的,所述选择模块包括:
坐标单元,用于根据鼠标移动到所述点云的显示窗口中所述目标位置,获取所述鼠标在桌面的坐标,获取所述显示窗口在桌面的坐标;
计算单元,用于将所述鼠标在桌面的坐标减去所述显示窗口在桌面的坐标,获得所述目标位置。
可选的,还包括:变换模块;
所述变换模块用于根据所述点云图的获取装置坐标与机器人坐标关系,进行空间关系变换;根据所述空间关系变化,将所述运行路径转换为机器人的作业路径。
可选的,所述最近点到最远点的向量为所述标记点的法向量。
本申请还提供一种机器人曲面运行路径标记装置,包括:
截面模块,用于获取工件的三维点云图,在所述三维点云图中设置路径规划的点云图截断面;
选择模块,用于在所述截断面中选择机器人目标位置,基于所述目标位置确定穿过所述目标位置的直线的最远点和最近点,生成位置基线;
获取当前视面上的每个点到所述位置基线的距离,选择所述距离最小的点作为近邻点,将所述近邻点垂直连接到所述位置基线的垂点作为标记点;
标记模块,用于分别标记机器人在曲面运行路径的起始标记点和终止标记点,并生成标记点连线;
间隔模块,用于将所述标记点连线分割为多个间隔,获取每个间隔上距离所述标记点连接线的最近点;
路径模块,用于连接所述最近点,生成曲面运行路径。
本申请相较于现有技术的优点是:
本申请一种机器人人机交互运行路径标记方法,包括:获取工件的三维点云图,在所述三维点云图中设置路径规划的点云图截断面;在所述截断面中选择机器人目标位置,基于所述目标位置确定穿过所述目标位置的直线的最远点和最近点,生成位置基线;获取当前视面上的每个点到所述位置基线的距离,选择所述距离最小的点作为近邻点,将所述近邻点垂直连接到所述位置基线的垂点作为标记点;将多个所述标记点连接生成所述机器人运行路径。本申请通过实现自动确定标记点,生成路径,实现可视化路径点选,通过人机交互进行路径规划,提高路径规划精度的同时简化规划步骤。
附图说明
图1是本申请中机器人运行路径标记流程图。
图2是本申请中距离鼠标最近点的选择示意图。
图3是本申请中工件平面邻近点示意图。
图4是本申请中机器人曲面运行路径标记流程图。
图5是本申请中机器人运行路径标记装置示意图。
图6是本申请中机器人曲面运行路径标记流程图。
具体实施方式
以下内容均是为了详细说明本申请要保护的技术方案所提供的具体实施过程的示例,但是本申请还可以采用不同于此的描述的其他方式实施,本领域技术人员可以在本申请构思的指引下,采用不同的技术手段实现本申请,因此本申请不受下面具体实施例的限制。
本申请一种机器人人机交互运行路径标记方法,包括:获取工件的三维点云图,在所述三维点云图中设置路径规划的点云图截断面;在所述截断面中选择机器人目标位置,基于所述目标位置确定穿过所述目标位置的直线的最远点和最近点,生成位置基线;获取当前视面上的每个点到所述位置基线的距离,选择所述距离最小的点作为近邻点,将所述近邻点垂直连接到所述位置基线的垂点作为标记点;将多个所述标记点连接生成所述机器人运行路径。本申请通过实现自动确定标记点,生成路径,实现可视化路径点选,通过人机交互进行路径规划,提供路径规划精度的同时简化规划步骤。
图1是本申请中机器人运行路径标记流程图。
请参照图1所示,S101获取工件的三维点云图,在所述三维点云图中设置路径规划的点云图截断面。
所示三维点云图是通过3D相机摄取的工件的点云数据,优选的,所述点云数据还可以通过激光扫描获得。在获取到所述点云数据后,该点云数据发送到显示器中,进行三维显示。
图2是本申请中距离鼠标最近点的选择示意图。
如图2所示,所述三维点云图组成三维视图在窗口中显示,当鼠标选择到一个位置时,识别所述鼠标最接近的三维点云图中的点,然后根据所述点进行三维点云图的截面操作,其中,所述截面上显示有已经确定的距离鼠标最近的点,需要清楚的是,所示距离鼠标最近的点是与所述鼠标端点重合的。
完成所述位置选择后,需要进行距离鼠标最近的点的标记,该标记可以采用坐标的方式表示,例如:将鼠标移动到所述点云的显示窗口中所述目标位置,获取所述鼠标在桌面的坐标,获取所述显示窗口在桌面的坐标;将所述鼠标在桌面的坐标减去所述显示窗口在桌面的坐标,获得所述鼠标位置标记,进而获取所述距离鼠标最近点的坐标。
具体的,当确定了距离鼠标最近的点后,按照所述点所在坐标系的三个轴线组成的三个基本面的其中一面,平行于该面进行截面操作,优选的,所述截面是可以选择的,即可以根据需求选择该截面平行的基础面。另一种优选的实施方式是,所述基本面设置为窗口的当前视面,所述截面平行于所述基本面。
请参照图1所示,S102在所述截断面中选择机器人目标位置,基于所述目标位置确定穿过所述目标位置的直线的最远点和最近点,生成位置基线。
所述最远点和最近点的选取是根据所述截断面实现的。本申请中,在所述三维点云图中,进行所述截断面的平行移动,确定平行于所述截断面的两个包围面,分别处于所述截断面的两侧,其中,每个包围面都是可移动的,且与所述三维点云图的表面点相交。
在进行最远点和最近点的选择时,首先设置一条经过所述已经确定了的,距离鼠标最近点的直线,该直线同时连接到两个所述包围面与所述点云图的相交,移动两个所述包围面获得最长线段后,在所述线段最长时,该线段连接的两个包围面与所述三维点云图相交处的点作为所述最近点和最远点,其中距离桌面窗口最近的点作为最近点,距离所述桌面窗口最远的点作为最远点。在上述描述中,所述最远点和最近点可以理解为,所述最远点和最近点与所述距离鼠标最近的点在当前视角上是重合的,其中所述最近点到最远点的向量为所述标记点的法向量。
确定完成所述最近点和最远点后,连接所述最近点、距离鼠标最近的点、所述最远点,形成一条直线,作为位置基线。
请参照图1所示,S103获取当前视面上的每个点到所述位置基线的距离,选择所述距离最小的点作为近邻点,将所述近邻点垂直连接到所述位置基线的垂点作为标记点。
本申请中,所述三维点云图的表示的工件的加工面是平面的,此时,将当前视面上的每个点都垂直的连接点所述位置基线上,计算每个点到所述位置基线上的垂线长度,将所述长度最短的点作为邻近点,该邻近点对应的在所述位置基线上的垂足设为标记点,如图3所示。
请参照图1所示,S104将多个所述标记点连接生成所述机器人运行路径。
上述已经确定了一个标记点,接下来重复上述步骤,确定多个标记点并连接,形成机器人的运行路径。根据所述点云图获取装置的坐标与机器人坐标的关系,进行空间关系变换;根据所述空间关系变化,将所述运行路径转换为机器人的作业路径,形成最终的作业路径。
本申请还提供一种机器人曲面运行路径标记方法,用于设置在曲面工件上进行机器人移动的路径。
图4是本申请中机器人曲面运行路径标记流程图。
请参照图4所示,S301获取工件的三维点云图,在所述三维点云图中设置路径规划的点云图截断面。
所示三维点云图是通过3D相机摄取的工件的点云数据,优选的,所述点云数据还可以通过激光扫描获得。在获取到所述点云数据后,该点云数据发送到显示器中,进行三维显示。
所述三维点云图组成三维视图在窗口中显示,当鼠标选择到一个位置是,识别所述鼠标最接近的三维点云图中的点,然后根据所述点进行三维点云图的截面操作,其中,所述截面上显示有已经确定的距离鼠标最近的点,需要清楚的是,所示距离鼠标最近的点是与所述鼠标端点重合的。
完成所述位置选择后,需要进行距离鼠标最近的点的标记,该标记可以采用坐标的方式表示,例如:将鼠标移动到所述点云的显示窗口中所述目标位置,获取所述鼠标在桌面的坐标,获取所述显示窗口在桌面的坐标;
将所述鼠标在桌面的坐标减去所述显示窗口在桌面的坐标,获得所述目标位置标记。
具体的,当确定了距离鼠标最近的点后,按照所述点所在坐标系的三个轴线组成的三个基本面的其中一面,平行于该面进行截面操作,优选的,所述截面是可以选择的,即可以根据需求选择该截面平行的基础面。另一种优选的实施方式是,所述基本面设置为窗口的当前视面,所述截面平行于所述基本面。
请参照图4所示,S302在所述截断面中选择机器人目标位置,基于所述目标位置确定穿过所述目标位置的直线的最远点和最近点,生成位置基线。
所述最远点和最近点的选取是根据所述截断面实现的。本申请中,在所述三维点云图中,进行所述截断面的平行移动,确定平行于所述截断面的两个包围面,分别处于所述截断面的两侧,其中,每个包围面都是可移动的,且与所述三维点云图的表面点相交。
在进行最远点和最近点的选择时,首先设置一条经过所述已经确定的,距离鼠标最近的点的线,该线同时连接到两个所述包围面与所述点云图的相交,移动两个所述包围面获得最长线段后,在所述线段最长时,该线段连接的两个包围面与所述三维点云图相交处的点作为所述最近点和最远点,其中距离桌面窗口最近的点作为最近点,距离所述桌面窗口最远的点作为最远点。在上述描述中,所述最远点和最近点可以理解为,所述最远点和最近点与所述距离鼠标最近的点三点在当前视角上是重合的,其中所述最近点到最远点的向量为所述标记点的法向量。
确定完成所述最近点和最远点后,连接所述最近点、距离鼠标最近的点、所述最远点,形成一条直线,作为位置基线。
请参照图4所示,S303获取当前视面上的每个点到所述位置基线的距离,选择所述距离最小的点作为近邻点,将所述近邻点垂直连接到所述位置基线的垂点作为标记点。
本申请中,所述三维点云图的表示的工件的加工面是平面的,此时,将当前视面上的每个点都垂直的连接点所述位置基线上,计算每个点到所述位置基线上的垂线长度,将所述长度最短的点作为邻近点,该邻近点对应的在所述位置基线上的垂足设为标记点。
请参照图4所示,S304分别标记机器人在曲面运行路径的起始标记点和终止标记点,并生成标记点连线。
所述起始点标记点和终止标记点之间是曲面构造,机器人在贴面移动时需要进行沿曲面的移动,因此首先在机器人在待加工工件上的开始点和终止点处进行标记点标记,连接所述标记点形成标记点连线。其中,所述开始标记点和终止标记点分别是机器人在工件表面移动时的起始点和目标点。
请参照图4所示,S305将所述标记点连线分割为多个间隔,获取每个间隔上距离所述标记点连接线的最近点。
所述标记点连线是一条直线,此时,根据预设的间隔距离,在所述标记点连线上分割为多个间隔。完成间隔的分割后,选择该间隔内的所有点,做垂直所述标记点连线的垂线段,将所述垂线段最短的点作为最近点。
S306连接所述最近点,生成曲面运行路径,完成曲面路径的规划。
本申请还提供一种机器人人机交互运行路径标记装置,包括截面模块401、选择模块402、标记模块403、路径模块404。
图5是本申请中机器人运行路径标记装置示意图。
请参照图5所示,截面模块401,用于获取工件的三维点云图,在所述三维点云图中设置路径规划的点云图截断面。
所示三维点云图是通过3D相机摄取的工件的点云数据,优选的,所述点云数据还可以通过激光扫描获得。在获取到所述点云数据后,该点云数据发送到显示器中,进行三维显示。
如图2所示,所述三维点云图组成三维视图在窗口中显示,当鼠标选择到一个位置是,识别所述鼠标最接近的三维点云图中的点,然后根据所述点进行三维点云图的截面操作,其中,所述截面上显示有已经确定的距离鼠标最近的点,需要清楚的是,所示距离鼠标最近的点是与所述鼠标端点重合的。
完成所述位置选择后,需要进行距离鼠标最近的点的标记,该标记可以采用坐标的方式表示,例如:将鼠标移动到所述点云的显示窗口中所述目标位置,获取所述鼠标在桌面的坐标,获取所述显示窗口在桌面的坐标;
将所述鼠标在桌面的坐标减去所述显示窗口在桌面的坐标,获得所述目标位置标记。
具体的,当确定了距离鼠标最近的点后,按照所述点所在坐标系的三个轴线组成的三个基本面的其中一面,平行于该面进行截面操作,优选的,所述截面是可以选择的,即可以根据需求选择该截面平行的基础面。另一种优选的实施方式是,所述基本面设置为窗口的当前视面,所述截面平行于所述基本面。
请参照图5所示,选择模块402,用于在所述截断面中选择机器人目标位置,基于所述目标位置确定穿过所述目标位置的直线的最远点和最近点,生成位置基线。
所述最远点和最近点的选取是根据所述截断面实现的。本申请中,在所述三维点云图中,进行所述截断面的平行移动,确定平行于所述截断面的两个包围面,分别处于所述截断面的两侧,其中,每个包围面都是可移动的,且与所述三维点云图的表面点相交。
在进行最远点和最近点的选择时,首先设置一条经过所述已经确定的,距离鼠标最近的点的线,该线同时连接到两个所述包围面与所述点云图的相交,移动两个所述包围面获得最长线段后,在所述线段最长时,该线段连接的两个包围面与所述三维点云图相交处的点作为所述最近点和最远点,其中距离桌面窗口最近的点作为最近点,距离所述桌面窗口最远的点作为最远点。在上述描述中,所述最远点和最近点可以理解为,所述最远点和最近点与所述距离鼠标最近的点三点在当前视角上是重合的,其中所述最近点到最远点的向量为所述标记点的法向量。
确定完成所述最近点和最远点后,连接所述最近点、距离鼠标最近的点、所述最远点,形成一条直线,作为位置基线。
请参照图5所示,标记模块403,用于获取当前视面上的每个点到所述位置基线的距离,选择所述距离最小的点作为近邻点,将所述近邻点垂直连接到所述位置基线的垂点作为标记点。
本申请中,所述三维点云图的表示的工件的加工面是平面的,此时,将当前视面上的每个点都垂直的连接点所述位置基线上,计算每个点到所述位置基线上的垂线长度,将所述长度最短的点作为邻近点,该邻近点对应的在所述位置基线上的垂足设为标记点,如图3所示。
请参照图5所示,路径模块404,用于将多个所述标记点连接生成所述机器人运行路径。
上述已经确定了一个标记点,接下来重复上述步骤,确定多个标记点,形成机器人的运行路径,根据所述点云图的获取装置坐标与机器人坐标关系,进行空间关系变换;根据所述空间关系变化,将所述运行路径转换为机器人的作业路径并进行连接,形成最终的作业路径。
本申请还提供一种机器人曲面运行路径标记装置,用于设置在曲面工件上进行机器人移动的路径,包括:截面模块501、选择模块502、标记模块503、、路径模块504、间隔模块505、规划模块506。
图6是本申请中机器人曲面运行路径标记流程图。
请参照图6所示,截面模块501,用于获取工件的三维点云图,在所述三维点云图中设置路径规划的点云图截断面。
所示三维点云图是通过3D相机摄取的工件的点云数据,优选的,所述点云数据还可以通过激光扫描获得。在获取到所述点云数据后,该点云数据发送到显示器中,进行三维显示。
所述三维点云图组成三维视图在窗口中显示,当鼠标选择到一个位置是,识别所述鼠标最接近的三维点云图中的点,然后根据所述点进行三维点云图的截面操作,其中,所述截面上显示有已经确定的距离鼠标最近的点,需要清楚的是,所示距离鼠标最近的点是与所述鼠标端点重合的。
完成所述位置选择后,需要进行距离鼠标最近的点的标记,该标记可以采用坐标的方式表示,例如:将鼠标移动到所述点云的显示窗口中所述目标位置,获取所述鼠标在桌面的坐标,获取所述显示窗口在桌面的坐标;
将所述鼠标在桌面的坐标减去所述显示窗口在桌面的坐标,获得所述目标位置标记。
具体的,当确定了距离鼠标最近的点后,按照所述点所在坐标系的三个轴线组成的三个基本面的其中一面,平行于该面进行截面操作,优选的,所述截面是可以选择的,即可以根据需求选择该截面平行的基础面。另一种优选的实施方式是,所述基本面设置为窗口的当前视面,所述截面平行于所述基本面。
请参照图6所示,选择模块502,用于在所述截断面中选择机器人目标位置,基于所述目标位置选取穿过所述目标位置的最远点和最近点,生成位置基线。
所述最远点和最近点的选取是根据所述截断面实现的。本申请中,在所述三维点云图中,进行所述截断面的平行移动,确定平行于所述截断面的两个包围面,分别处于所述截断面的两侧,其中,每个包围面都是可移动的,且与所述三维点云图的表面点相交。
在进行最远点和最近点的选择时,首先设置一条经过所述已经确定的,距离鼠标最近的点的线,该线同时连接到两个所述包围面与所述点云图的相交,移动两个所述包围面获得最长线段后,在所述线段最长时,该线段连接的两个包围面与所述三维点云图相交处的点作为所述最近点和最远点,其中距离桌面窗口最近的点作为最近点,距离所述桌面窗口最远的点作为最远点。在上述描述中,所述最远点和最近点可以理解为,所述最远点和最近点与所述距离鼠标最近的点三点在当前视角上是重合的,其中所述最近点到最远点的向量为所述标记点的法向量。
确定完成所述最近点和最远点后,连接所述最近点、距离鼠标最近的点、所述最远点,形成一条直线,作为位置基线。
请参照图6所示,标记模块503、获取当前视面上的每个点到所述位置基线的距离,选择所述距离最小的点作为近邻点,将所述近邻点垂直连接到所述位置基线的垂点作为标记点。
本申请中,所述三维点云图的表示的工件的加工面是平面的,此时,将当前视面上的每个点都垂直的连接点所述位置基线上,计算每个点到所述位置基线上的垂线长度,将所述长度最短的点作为邻近点,该邻近点对应的在所述位置基线上的垂足设为标记点。
请参照图6所示,路径模块504,用于分别标记机器人在曲面运行路径的起始标记点和终止标记点,并生成标记点连线。
所述起始点标记点和终止标记点之间是曲面构造,机器人在贴面移动时需要进行沿曲面的移动,因此首先在机器人在待加工工件上的开始点和终止点处进行标记点标记,连接所述标记点形成标记点连线。其中,所述开始标记点和终止标记点分别是机器人在工件表面移动时的起始点和目标点。
请参照图6所示,间隔模块505,用于将所述标记点连线分割为多个间隔,获取每个间隔上距离所述标记点连接线的最近点。
所述标记点连线是一条直线,此时,根据预设的间隔距离,在所述标记点连线上分割为多个间隔。完成间隔的分割后,选择该间隔内的所有点,做对所述标记点连线的垂线段,将所述垂线段最短的点作为最近点。
请参照图6所示,规划模块506,用于连接所述最近点,生成曲面运行路径,完成曲面路径的规划。

Claims (10)

1.一种机器人人机交互运行路径标记方法,其特征在于,包括:
获取工件的三维点云图,在所述三维点云图中设置路径规划的点云图截断面;
在所述截断面中选择机器人目标位置,基于所述目标位置确定穿过所述目标位置的直线的最远点和最近点,生成位置基线;
获取当前视面上的每个点到所述位置基线的距离,选择所述距离最小的点作为近邻点,将所述近邻点垂直连接到所述位置基线的垂点作为标记点;
将多个所述标记点连接生成所述机器人运行路径。
2.根据权利要求1所述机器人运行路径标记方法,其特征在于,所述目标位置确定步骤如下:
将鼠标移动到所述点云的显示窗口中所述目标位置,获取鼠标在显示窗口三维空间中距离鼠标位置最近坐标点和最远坐标点。
将所述鼠标在桌面的坐标减去所述显示窗口在桌面的坐标,获得所述目标位置。
3.根据权利要求1所述机器人运行路径标记方法,其特征在于,还包括:
根据所述点云图的获取装置坐标与机器人坐标关系,进行空间关系变换;
根据所述空间关系变化,将所述运行路径转换为机器人的作业路径。
4.根据权利要求1所述机器人运行路径标记方法,其特征在于,所述最近点到最远点的向量为所述标记点的法向量。
5.一种机器人曲面运行路径标记方法,其特征在于,包括:
获取工件的三维点云图,根据所述点云图设置路径规划的点云图截断面;
在所述截断面中选择机器人目标位置,基于所述目标位置选取穿过所述目标位置的最远点和最近点,生成位置基线;获取当前视面上的每个点到所述位置基线的距离,选择所述距离最小的点作为近邻点,将所述近邻点垂直连接到所述位置基线的垂点作为标记点;
分别标记机器人在曲面运行路径的起始标记点和终止标记点,并生成标记点连线;
将所述标记点连线分割为多个间隔,获取每个间隔上距离所述标记点连接线的最近点;
连接所述最近点,生成曲面运行路径。
6.一种机器人人机交互运行路径标记装置,其特征在于,包括:
截面模块,用于获取工件的三维点云图,在所述三维点云图中设置路径规划的点云图截断面;
选择模块,用于在所述截断面中选择机器人目标位置,基于所述目标位置确定穿过所述目标位置的直线的最远点和最近点,生成位置基线;
标记模块,用于获取当前视面上的每个点到所述位置基线的距离,选择所述距离最小的点作为近邻点,将所述近邻点垂直连接到所述位置基线的垂点作为标记点;
路径模块,用于将多个所述标记点连接生成所述机器人运行路径。
7.根据权利要求6所述机器人运行路径标记装置,其特征在于,所述选择模块包括:
坐标单元,用于根据鼠标移动到所述点云的显示窗口中所述目标位置,获取所述鼠标在桌面的坐标,获取所述显示窗口在桌面的坐标;
计算单元,用于将所述鼠标在桌面的坐标减去所述显示窗口在桌面的坐标,获得所述目标位置。
根据鼠标移动到所述点云的显示窗口中所述目标位置,获取鼠标在显示窗口三维空间中距离鼠标位置最近坐标点和最远坐标点,以此计算目标位置坐标。
8.根据权利要求6所述机器人运行路径标记装置,其特征在于,还包括:变换模块;
所述变换模块用于根据所述点云图的获取装置坐标与机器人坐标关系,进行空间关系变换;根据所述空间关系变化,将所述运行路径转换为机器人的作业路径。
9.根据权利要求6所述机器人运行路径标记装置,其特征在于,所述最近点到最远点的向量为所述标记点的法向量。
10.一种机器人曲面运行路径标记装置,其特征在于,包括:
截面模块,用于获取工件的三维点云图,在所述三维点云图中设置路径规划的点云图截断面;
选择模块,用于在所述截断面中选择机器人目标位置,基于所述目标位置选取穿过所述目标位置的最远点和最近点,生成位置基线;
标记模块、获取当前视面上的每个点到所述位置基线的距离,选择所述距离最小的点作为近邻点,将所述近邻点垂直连接到所述位置基线的垂点作为标记点;
路径模块,用于分别标记机器人在曲面运行路径的起始标记点和终止标记点,并生成标记点连线;
间隔模块,用于将所述标记点连线分割为多个间隔,获取每个间隔上距离所述标记点连接线的最近点;
规划模块,用于连接所述最近点,生成曲面运行路径。
CN202210435599.6A 2022-04-24 2022-04-24 一种机器人人机交互运行路径标记方法及装置 Active CN114888794B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210435599.6A CN114888794B (zh) 2022-04-24 2022-04-24 一种机器人人机交互运行路径标记方法及装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210435599.6A CN114888794B (zh) 2022-04-24 2022-04-24 一种机器人人机交互运行路径标记方法及装置

Publications (2)

Publication Number Publication Date
CN114888794A true CN114888794A (zh) 2022-08-12
CN114888794B CN114888794B (zh) 2024-01-30

Family

ID=82717778

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210435599.6A Active CN114888794B (zh) 2022-04-24 2022-04-24 一种机器人人机交互运行路径标记方法及装置

Country Status (1)

Country Link
CN (1) CN114888794B (zh)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109376900A (zh) * 2018-09-07 2019-02-22 北京航空航天大学青岛研究院 基于点云的无人机轨迹生成方法
CN110227876A (zh) * 2019-07-15 2019-09-13 西华大学 基于3d点云数据的机器人焊接路径自主规划方法
CN111055293A (zh) * 2019-11-21 2020-04-24 东南大学 一种基于曲面自适应的工业机器人高精度恒力打磨方法
CN111216124A (zh) * 2019-12-02 2020-06-02 广东技术师范大学 基于融入全局视觉和局部视觉的机器人视觉引导方法和装置
CN113276130A (zh) * 2021-05-28 2021-08-20 山东大学 一种基于点云切片的自由曲面喷涂路径规划方法及系统
CN113741426A (zh) * 2021-08-06 2021-12-03 武汉理工大学 一种基于局部点云曲线拟合的机器人加工路径规划方法
CN114041168A (zh) * 2019-05-02 2022-02-11 柯达阿拉里斯股份有限公司 自动化360度密集点对象检验

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109376900A (zh) * 2018-09-07 2019-02-22 北京航空航天大学青岛研究院 基于点云的无人机轨迹生成方法
CN114041168A (zh) * 2019-05-02 2022-02-11 柯达阿拉里斯股份有限公司 自动化360度密集点对象检验
CN110227876A (zh) * 2019-07-15 2019-09-13 西华大学 基于3d点云数据的机器人焊接路径自主规划方法
CN111055293A (zh) * 2019-11-21 2020-04-24 东南大学 一种基于曲面自适应的工业机器人高精度恒力打磨方法
CN111216124A (zh) * 2019-12-02 2020-06-02 广东技术师范大学 基于融入全局视觉和局部视觉的机器人视觉引导方法和装置
WO2021109575A1 (zh) * 2019-12-02 2021-06-10 广东技术师范大学 基于融入全局视觉和局部视觉的机器人视觉引导方法和装置
CN113276130A (zh) * 2021-05-28 2021-08-20 山东大学 一种基于点云切片的自由曲面喷涂路径规划方法及系统
CN113741426A (zh) * 2021-08-06 2021-12-03 武汉理工大学 一种基于局部点云曲线拟合的机器人加工路径规划方法

Also Published As

Publication number Publication date
CN114888794B (zh) 2024-01-30

Similar Documents

Publication Publication Date Title
CN112122840B (zh) 一种基于机器人焊接的视觉定位焊接系统及焊接方法
CN110238831B (zh) 基于rgb-d图像及示教器的机器人示教系统及方法
JP5981143B2 (ja) ロボットツールの制御方法
CN108286949B (zh) 一种可移动式三维检测机器人系统
JP4347386B2 (ja) 加工用ロボットプラグラムの作成装置
US9311608B2 (en) Teaching system and teaching method
CN110142770B (zh) 一种基于头戴显示装置的机器人示教系统及方法
CN111152229B (zh) 3d机械视觉的机械手引导方法和装置
CN109914756A (zh) 基于室内施工智能机器人的室内墙体3d腻子打印平整处理方法
CN113385486A (zh) 一种基于线结构光的激光清洗路径自动生成系统及方法
Fang et al. Robot path and end-effector orientation planning using augmented reality
TW201918348A (zh) 機械設備之定位系統及其方法
CN107097122A (zh) 一种自主研磨大型自由曲面的机器人
TW201714695A (zh) 即時三維建模之雷射飛行打標系統及其方法
CN114407015A (zh) 一种基于数字孪生的遥操作机器人在线示教系统及方法
CN110153582A (zh) 焊接方案生成方法、装置以及焊接系统
CN112958974A (zh) 一种基于三维视觉的可交互自动化焊接系统
CN114888794A (zh) 一种机器人人机交互运行路径标记方法及装置
CN116422551A (zh) 异型工件喷涂方法、装置、设备、存储介质及机器人
JPH11338532A (ja) 教示装置
CN109773581B (zh) 一种机器人应用于再现机加工的方法
JP4282874B2 (ja) マニピュレータ向け制御用データの生成方法
CN114939874B (zh) 一种机械手臂沿人体表面移动的姿态规划方法
JP2539043B2 (ja) 形状計測結果の表示方法
WO2023073959A1 (ja) 作業支援装置及び作業支援方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant