一种动态物料追随拾捡轨迹的生成方法技术

本发明专利技术涉及一种动态物料追随拾捡轨迹的生成方法，该方法包括：1、确定下一个待抓取物料，并获取其位姿数据作为主运动的目标点，机器人当前位姿为主运动的起点；2、根据起点终点，轨迹路径参数和运动参数，规划主运动运动轨迹；3、根据轨迹规划结果，确定追随运动的发生点和结束点；4、启动主运动并开始实时计算动态物料的运动距离；5、主运动行进到追随运动启动时间点时，考虑物料运动方向动态规划和生成追随运动轨迹；6、将主运动和追随运动生成的结果叠加，获取动态物料追随运动轨迹。与现有技术相比，本发明专利技术方法可实现自动对动态物料进行有效的追随和拾捡作业，且能够自动适应该物料的速度变化确保追随的准确性。

A generation method of dynamic material following picking track

【技术实现步骤摘要】
一种动态物料追随拾捡轨迹的生成方法
本专利技术涉及动态物料可靠抓取
，尤其是涉及一种动态物料追随拾捡轨迹的生成方法。
技术介绍
拾捡作业是机器人应用的一个常见任务类型，即将物料从一个位置抓取，移动放置到另一个位置。静态物料的拾捡是一个简单任务，已经得到了很好的应用。然而动态物料拾捡仍是一个具有挑战的任务，它的作业过程可简述为：物料在输送线上高速通过机器人下方，具备视觉能力的机器人在一定的抓取策略下筛选和定位抓取目标，然后在运动和追随算法的支撑下高速运动并追随物料完成抓取动作。该应用场景的一个典型配置如图1所示。此动态拾捡作业的轨迹路径一般包含三段：上升段，平移段和下落段；机器人在上升段离开输送线表面上升至高于物料的位置开始进入平移段；在平移段起点处，机器人开始追赶物料，并在平移段结束处追随上物料并位于其正上方，此时机器人运动速度达到了物料的运动速度，运动轨迹进入下落段；在下落段，机器人正向接近，接触和抓取物料，整个下落过程中两者始终保持同样速度直至抓取动作完成，此时可以触发机器人的返回动作使物料脱离输送线。该作业过程的技术难点在于：1)物料动态移动并且移动速度可能一直随机变化，这样导致无法预测抓取作业的终点位置，也就无法在抓取开始前预先规划作业轨迹。这就要求机器人在抓取作业过程中必须能够适应物料的速度变化，必须具备动态调整和执行追随运动的轨迹的能力，保证在规定的时间内抵达物料的正上方；2)在抓取动作过程中(接近，接触和抓取物料)机器人必须能够始终维持与物料相同的速度，抓手与物料始终处于相对静止的状态，否则会导致两者之间发生碰擦，造成抓取动作不稳定，增加抓取失败的风险。
技术实现思路
本专利技术的目的就是为了克服上述现有技术存在的缺陷而提供一种自动适应物料速度、追随稳定准确的动态物料追随拾捡轨迹的生成方法。本专利技术的目的可以通过以下技术方案来实现：一种动态物料追随拾捡轨迹的生成方法，该方法包括以下步骤：S1：确定机器人的下一个待抓取物料，将物料的当前位姿作为主运动的目标点，将机器人的当前位姿作为主运动的起点。主运动包括上升段、平移段和下落段。S2：获取包括最大速度限值、最大加速度限值和最大加加速度限值的主运动的运动参数，获取主运动的轨迹路径参数，结合主运动的起点和目标点对主运动轨迹进行规划。主运动的轨迹路径参数包括上升段的竖直高度和弯角高度，以及下落段的竖直高度和弯角高度。优选地，采用S型速度轨迹规划方法对主运动的三段轨迹分别进行规划，将主运动的三段轨迹设计为由七段曲线组合而成的轨迹曲线，七段曲线包括八个关键点，通过步骤1)给定的主运动起点和目标点以及轨迹路径参数获取三段轨迹各段的起点和目标点；然后结合主运动的运动参数计算各段轨迹的八个关键点运动参量，最后依据各段关键点的规划结果和轨迹路径参数融合生成主运动轨迹。优选地，关键点的运动参量包括每处时间点所对应的位置、速度、加速度和加加速度。S3：指定追随运动的发生点和结束点，根据主运动的规划结果确定追随运动的启动时刻和总用时。指定追随运动的启动时刻和总用时，需保证追随运动发生和完成时间在主运动时间历程之内。即在指定追随运动的发生点和结束点时，可以指定追随运动与主运动同时发生，或者追随运动开始于主运动平移段行程的一半位置处，也可以指定在其他位置；且追随运动一定要在主运动结束之前达到物料运动速度并转入紧密跟随运动阶段。优选地，在确定追随运动的时间点时，采用数值二分算法计算轨迹上某点位置对应的时间。S4：触发主运动并同时开始实时计算动态物料的运动距离。具体内容为：触发主运动时刻，记录物料的当前位姿，随后将其清零，并开始实时计算物料从此刻起在输送线上的运动距离，并获取输送线在机器人基坐标系中的方向，将实时获取的运动方向和运动距离作为规划追随运动的基础。S5：当主运动行进到追随运动的启动时间点时，结合物料运动方向开始动态规划并生成追随运动轨迹。S6：将主运动轨迹与追随运动轨迹叠加，生成动态物料追随拾捡轨迹。与现有技术相比，本专利技术基于拾捡作业的特点和其对轨迹规划的要求，将拾捡作业的运动过程分解为主运动及追随运动两部分运动，通过运动同步方法和叠加方法，实现了自动对动态物料进行有效的追随和拾捡作业，能够自动适应物料的速度变化以确保追随和保持跟随的准确性，进而能够提高物料抓取动作的稳定性和成功率。附图说明图1为动态物料追随拾捡作业原理示意图；图2为本专利技术中动态物料追随拾捡运动轨迹生成流程图；图3为典型的动态物料追随拾捡运动轨迹示意图；图4为典型的动态物料追随拾捡运动主运动的运动轨迹；图5为典型的动态物料追随拾捡运动追随运动的运动轨迹；图6为典型的单段轨迹规划结果图；图7为采用二分法对给定位置求解时间点的流程图；图8为本专利技术实施例中生成的动态物料追随拾捡运动的主运动轨迹；图9为本专利技术实施例中生成的动态物料追随拾捡运动的追随运动轨迹；图10为本专利技术实施例中生成的动态物料追随拾捡运动的追随拾捡运动轨迹。具体实施方式下面结合附图和具体实施例对本专利技术进行详细说明。实施例本专利技术涉及一种动态物料追随拾捡轨迹的生成方法，包括下列步骤：步骤一、在物料进入机器人可抓取区域后，触发动态追随拾捡运动。将机器人当前的位姿指定为主运动的起点P0＝(-0.3，0.3，-0.8，0，0，0)；将动态物料当前的位姿指定为主运动的终点P3(0.1，-0.2，-0.8，0，0，0)。主运动跳跃轨迹两侧的竖直端高度h1＝0.01、h2＝0.01，以及弯角高度c1＝0.02和c2＝0.02，可得辅助点P1(-0.3，0.3，-0.77，0，0，0)和P2(0.1，-0.2，-0.77，0,0，0)。(P0,P1,P2和P3确定了主运动轨迹规划所需的上升段，平移段和下落段的起点和目标点)。主运动的运动参数约束指定为最大速度Vmax＝5m/s，最大加速度Accmax＝80m/s2，最大加加速度Jc＝2400m/s3。步骤二、一个典型的主运动的轨迹规划结果如图4所示，主运动一般由三段组成，即起跳向上运动(上升段)、水平跨越运动(平移段)和降落向下运动(下落段)。每一段轨迹可以采用S型速度曲线规划方法分别规划，然后进行融合。指定追随运动的启动时刻和总用时，在理论上只要保证追随运动发生和完成时间在主运动时间历程之内即可。例如，可以指定追随运动与主运动同时发生，或者追随运动开始于主运动平移段行程的一半的位置如图3所示的点1处，也可以指定在别的位置；追随运动一定要在主运动结束之前达到物料运动速度并转入紧密跟随运动阶段。在本专利技术中，规定追随运动发生于图4中的1处，即平移段轨迹开始处，于4处完成追随运动阶段而进入跟随运动阶段，即平移段轨迹结束处，此时刚好处在物料的正上方并与其保持同速。一个典型S型速度曲线的规划结果由7段曲线组合而成，如图6所示。轨迹由7段曲线拼接而成。6个本文档来自技高网...

【技术保护点】
1.一种动态物料追随拾捡轨迹的生成方法，其特征在于，该方法包括以下步骤：/n1)确定机器人的下一个待抓取物料，将物料的当前位姿作为主运动的目标点，将机器人的当前位姿作为主运动的起点；/n2)获取主运动的运动参数及主运动的轨迹路径参数，结合主运动的起点和目标点对主运动轨迹进行规划；/n3)指定追随运动的发生点和结束点，根据主运动的规划结果确定追随运动的启动时刻和总用时；/n4)触发主运动并同时开始实时计算动态物料的运动距离；/n5)当主运动行进到追随运动的启动时间点时，结合物料运动方向开始动态规划并生成追随运动轨迹；/n6)将主运动轨迹与追随运动轨迹叠加，生成动态物料追随拾捡轨迹。/n

【技术特征摘要】
1.一种动态物料追随拾捡轨迹的生成方法，其特征在于，该方法包括以下步骤：
1)确定机器人的下一个待抓取物料，将物料的当前位姿作为主运动的目标点，将机器人的当前位姿作为主运动的起点；
2)获取主运动的运动参数及主运动的轨迹路径参数，结合主运动的起点和目标点对主运动轨迹进行规划；
3)指定追随运动的发生点和结束点，根据主运动的规划结果确定追随运动的启动时刻和总用时；
4)触发主运动并同时开始实时计算动态物料的运动距离；
5)当主运动行进到追随运动的启动时间点时，结合物料运动方向开始动态规划并生成追随运动轨迹；
6)将主运动轨迹与追随运动轨迹叠加，生成动态物料追随拾捡轨迹。


2.根据权利要求1所述的一种动态物料追随拾捡轨迹的生成方法，其特征在于，所述的主运动的运动参数包括最大速度限值、最大加速度限值和最大加加速度限值。


3.根据权利要求2所述的一种动态物料追随拾捡轨迹的生成方法，其特征在于，所述的主运动由上升段、平移段和下落段三段轨迹组成，主运动的轨迹路径参数包括上升段的竖直高度和弯角高度，以及下落段的竖直高度和弯角高度。


4.根据权利要求3所述的一种动态物料追随拾捡轨迹的生成方法，其特征在于，步骤2)具体包括以下步骤：
201)采用S型速度轨迹规划方法对主运动的三段轨迹分别进行规划，将各段轨迹设计为由七段曲线组合而成的轨迹曲线，七段曲线包括八个关键点；
202)通过步骤1)给定的主运动的起点和目标点，结合主运动的轨迹路...

【专利技术属性】
技术研发人员：顾文昊，袁晗，肖武云，杨君娟，童上高，
申请(专利权)人：上海沃迪智能装备股份有限公司，
类型：发明
国别省市：上海;31