CN107980109A - 机器人运动轨迹规划方法及相关装置 - Google Patents
机器人运动轨迹规划方法及相关装置 Download PDFInfo
- Publication number
- CN107980109A CN107980109A CN201780002249.8A CN201780002249A CN107980109A CN 107980109 A CN107980109 A CN 107980109A CN 201780002249 A CN201780002249 A CN 201780002249A CN 107980109 A CN107980109 A CN 107980109A
- Authority
- CN
- China
- Prior art keywords
- movement locus
- point
- section
- sections
- orbit segment
- 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
Links
- 230000033001 locomotion Effects 0.000 title claims abstract description 260
- 238000000034 method Methods 0.000 title claims abstract description 40
- 239000013256 coordination polymer Substances 0.000 claims abstract description 210
- 238000010276 construction Methods 0.000 claims description 6
- 230000007704 transition Effects 0.000 claims description 5
- 238000010586 diagram Methods 0.000 description 12
- 230000006870 function Effects 0.000 description 10
- 238000004891 communication Methods 0.000 description 7
- 230000008569 process Effects 0.000 description 7
- 238000013461 design Methods 0.000 description 5
- 238000009499 grossing Methods 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 3
- 238000012545 processing Methods 0.000 description 2
- 230000003068 static effect Effects 0.000 description 2
- 238000006467 substitution reaction Methods 0.000 description 2
- 238000012546 transfer Methods 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 230000006399 behavior Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D3/00—Control of position or direction
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
一种机器人运动轨迹规划方法,根据第一CP运动轨迹段和第二CP运动轨迹段确定出三次Bezier曲线的特征点;并根据确定出的特征点构建三次Bezier曲线,构建出的三次Bezier曲线作为第一CP运动轨迹段和第二CP运动轨迹段之间的平滑过渡轨迹段。这种方法能够实现CP运动的平滑连接,同时,速度不必降为零。还涉及采用这种方法的运动轨迹规划装置和机器人。
Description
技术领域
本发明涉及运动控制领域,更具体地说,涉及机器人运动轨迹规划技术。
背景技术
在对机器人运动控制中,被控部件(例如操作臂)的轨迹运动方式可分为CP运动(连续运行,包括直线运动和圆弧运动)和PTP运动(点到点运动)。
在对机器人进行运动轨迹规划时,可能需要多段CP运动连续进行。以两段CP运动连续进行为例,请参见图1a,CP运动轨迹段1(也可称为轨迹段1)和CP运动轨迹段2(也可称为轨迹段2)可分别为直线段,此外,还可圆弧段与圆弧段(图1b)、圆弧段与直线段(图1c和图1d)连续进行。
在单段CP运动的规划中,其初速度和末速度都为0,如果在多段CP连续运动的过程中令每段CP运动的初始速度和末速度都降为0,会大大降低工作效率,并且频繁的加减速也会对电机和减速器的寿命有影响。因此,运动轨迹规则的趋势是不令多段CP连续运动中的各段CP运动的速度降为零。
这就面临另一问题:仍请参见图1a,若连续的直线段不在同一直线上,就会有尖角。尖角的顶点为O(O点是两轨迹段的交点)。同理,请参见图1b,若连续的两圆弧段切线不重合,也会有尖角。同理,若直线段与的圆弧段的切线不重合(请参见图1c和图1d),也会有尖角。速度不为0通过尖角的话,会产生振动。
为此,可在连续的两CP运动轨迹段之间设计平滑过渡轨迹段。例如,请参见图2,可采用矢量叠加法得到平滑过渡轨迹段。这种方式通过空间向量加法,令图2中轨迹段1从拐出点A到交点O的插补点,与轨迹段2从拐入点B到交点O的插补点重合。叠加后的插补点会组成空间的一段弧形(也即图2中点A与点B之间的弧形),使轨迹平滑。
也即,最终规划出的运行轨迹是,由C点运行至A点,之后拐出轨迹段1,进入点A和点B之间的平滑过渡轨迹段,再由点B拐入轨迹段2,最后到达D。
当然,对于超过两段CP运动的连续运动,可分别对两两连续的CP运动轨迹段进行如此设计。
矢量叠加法虽然对前后相连的CP运动进行了平滑,但在实际应用中,如图1a-1d所示,有直线段与直线段转接、直线段与圆弧段转接、圆弧段与圆弧段转接。矢量叠加法虽可用圆弧替代尖角,但其仅在直线段与直线段转接的场景下肯定适用,在直线段与圆弧段转接、圆弧段与圆弧段的转接中可能无法找到与两条轨迹都相切的圆弧。这是因为空间中相交的直线段与直线段是肯定共面的,但是直线段与圆弧段、圆弧段与圆弧段都不一定共面,在不共面的情况下就无法找出公切的圆弧转接。
因此,现在需要机器人运动轨迹规划技术解决方案,以令无论连续的运动轨迹段是否共面均能进行平滑转接,并在拐点处(拐入点和拐出点)速度连续(也即速度不必降为0)。
发明内容
有鉴于此,本发明实施例的目的在于提供机器人运动轨迹规划方法及相关装置,以令连续的CP运动平滑转接,同时,速度不必降为0。
本申请发明人在研究过程中发现:
Bezier曲线由线段和节点组成的数学曲线。其整体形状并不局限于圆弧,可实现非共面的轨迹平滑,从而可应用在机器人运动轨迹规划方面。
可令Bezier曲线作为连续的运动轨迹段间的平滑过渡轨迹段,Bezier曲线的起始点与一运动轨迹段(可称为lc轨迹段)的拐出点重合,Bezier曲线的终止点与另一运动轨迹段(可称为ln轨迹段)的拐入点重合。
发明人发现,欲实现在拐点处(拐出点和拐入点)速度连续,则Bezier曲线在其起始点需与lc轨迹相切,同时在其终止点需与ln轨迹相切。
n次(n次)Bezier曲线公式为:
其中bi,n(t)称为Bernstein基函数,t=0对应Beizer曲线的起始点,t=1对应Beizer曲线的终止点。
P0-Pn这n个特征点或控制点在平面或在三维空间定义了n次Bezier曲线,其组成的多边形称为特征多边形或控制多边形。其中,P0为起始点,Pn为终止点,P1-Pn-1为中间点。例如请参见图3,P0、P1、P2、P3四个点定义了三次Bezier曲线,三次Bezier曲线起始于P0走向P1,并从P2方向到P3。需要说明的是,一般三次Bezier曲线不经过P1、P2,这两个点只提供方向。
根据Bezier基函数的导函数性质可求取n次Bezier曲线始末点的切矢量为则:
当t=0时,B′(0)=n(P1-P0),,B′(0)即为n次Bezier曲线在起始点的切矢量;
当t=1时,B′(1)=n(Pn-Pn-1),B′(1)即为n次Bezier曲线在终止点的切矢量。
观察上述切矢量可知,n次Bezier曲线在起始点和终止点处的切线方向(即切矢量)和特征多边型的第一条边及最后一条边走向一致。以图3所示三次Bezier曲线为例,,B′(0)=3(P1-P0),,B′(1)=3(P3-P2),而图3的第一条边是P1 P0,最后一条边是P3 P2。
为令n次Bezier曲线在始末点的切矢方向分别与lc轨迹段和ln轨迹段切矢方向相同,需要最少四个特征点或控制点,所以可选用三次Bezier曲线作为平滑过渡轨迹段。
基于上述研究发现,本发明实施例提供如下技术方案:
一方面,本申请的实施例提供机器人运动轨迹规划方法,至少用于基于三次Bezier曲线实现连续的两CP运动轨迹段之间的平滑转接,所述连续的两CP运动轨迹段包括第一CP运动轨迹段和第二CP运动轨迹段;该方法包括:根据所述第一CP运动轨迹段和第二CP运动轨迹段确定三次Bezier曲线的特征点;所述特征点包括P0、P1、P2、P3,其中,P0为起始点、P3为终止点,P1、P2为中间点;根据所述特征点构建三次Bezier曲线,作为所述第一CP运动轨迹段和第二CP运动轨迹段之间的平滑过渡轨迹段,所述平滑过渡轨迹段的起始点与所述第一CP运动轨迹段的拐出点相重合,所述平滑过渡轨迹段的终止点与所述第二CP运动轨迹段的拐入点相重合;其中,所述平滑过渡轨迹段在所述起始点上的切矢量方向、与所述第一CP运动轨迹段在在所述拐出点上的切矢量方向相同;所述平滑过渡轨迹段在所述终止点上的切矢量方向和所述第二CP运动轨迹段在所述拐入点上的切矢量方向的方向相同。在本实施例中,采用三次Bezier曲线作为第一CP运动轨迹段和第二CP运动轨迹段之间的平滑过渡轨迹段,由于平滑过渡轨迹段在始末点的切矢方向分别与所述第一CP运动轨迹段和第二CP运动轨迹段的切矢方向相同,因此,该平滑过渡轨迹段在其起始点与第一CP运动轨迹段相切,同时在其终止点与第二CP运动轨迹段相切,从而可实现在拐点处(拐出点和拐入点)速度连续,也即可实现连续的CP运动平滑转接,同时,速度不必降为0。
在一个可能的设计中,在所述确定三次Bezier曲线的特征点之前,还包括:规划连续的CP运动轨迹段。
在一个可能的设计中,当所述第一CP运动轨迹段为直线段时,选择交点O和起始点P0之间的线段上的一点作为所述中间点P1;而当所述第一CP运动轨迹段为圆弧段时,可选择所述起始点P0切线上的一点作为所述中间点P1,并且,所述中间点P1位于所述交点O和起始点P0之间,交点O为所述第一CP运动轨迹段和第二CP运动轨迹段的交点。这样,可实现平滑过渡轨迹段在所述起始点上的切矢量方向、与所述第一CP运动轨迹段在在所述拐出点上的切矢量方向相同。
在一个可能的设计中,当所述第二CP运动轨迹段为直线段时,可选择所述交点O和终止点P3之间的线段上的一点作为所述中间点P2;而当所述第二CP运动轨迹段为圆弧段时,可选择所述终止点P3切线上的一点作为所述中间点P2,并且,所述中间点P2位于所述交点O和终止点P3之间。这样可实现,所述平滑过渡轨迹段在所述终止点上的切矢量方向和所述第二CP运动轨迹段在所述拐入点上的切矢量方向的方向相同。
在一个可能的设计中,所述中间点P1到所述交点O的距离,等于所述中间点P1到所述起始点P0的距离;所述中间点P2到所述交点O的距离,等于所述中间点P2到所述终止点P3的距离。
另一方面,本发明实施例提供了一种机器人运动轨迹规划装置,该装置具有实现上述方法实际中机器人运动轨迹规划装置行为的功能。所述功能可以通过硬件实现,也可以通过硬件执行相应的软件实现。所述硬件或软件包括一个或多个与上述功能相对应的模块。
在一个可能的设计中,机器人运动轨迹规划装置的结构包括:处理器和存储器,所述处理器通过运行存储在所述存储器内的软件程序、调用存储在所述存储器内的数据,执行上述方法。
再一方面,本发明实施例提供了一种机器人,其包括上述的机器人运动轨迹规划装置,以及按照上述机器人运动轨迹规划装置规划出的连续的两CP运动轨迹段及平滑过渡轨迹段运行的被控器件。该控制器件例如可以是操作臂。
再一方面,本发明实施例提供了一种计算机存储介质,用于储存为上述机器人运动轨迹规划装置所用的计算机软件指令,其包含用于执行上述方面所设计的程序。
再一方面,本发明实施例提供了一种计算机存储介质,用于储存为上述机器人所用的计算机软件指令,其包含用于执行上述方面所设计的程序。
相较于现有技术,本实施例采用三次Bezier曲线作为第一CP运动轨迹段和第二CP运动轨迹段之间的平滑过渡轨迹段,由于平滑过渡轨迹段在始末点的切矢方向分别与所述第一CP运动轨迹段和第二CP运动轨迹段的切矢方向相同,因此,该平滑过渡轨迹段在其起始点与第一CP运动轨迹段相切,同时在其终止点与第二CP运动轨迹段相切,从而可实现在拐点处(拐出点和拐入点)速度连续,也即可实现连续的CP运动平滑转接,同时,速度不必降为0。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1a-1d为本发明实施例提供的连续的运动轨迹段的示意图;
图2为本发明实施例提供的采用矢量叠加法得到平滑过渡轨迹段示意图;
图3为本发明实施例提供的三次Bezier曲线示意图;
图4-6a,7a,图8a,图9a为本发明实施例提供的机器人运动轨迹规划方法示例性流程图;
图6b,图7b,图8b,图9b为本发明实施例提供的两连续运动轨迹段利用平滑过渡轨迹段过渡示意图;
图10为本发明实施例提供的机器人运动轨迹规划装置结构示意图;
图11为本发明实施例提供的机器人运动轨迹规划装置通用计算机架构示意图。
具体实施方式
本发明可能使用的技术名词、简写或缩写如下:
TCP点:工具坐标中心点;
直线运动:机器人TCP点在笛卡尔空间内沿直线轨迹运动;
圆弧运动:机器人CP点在笛卡尔空间内沿圆弧轨迹运动;
CP:连续运动,笛卡尔空间下的轨迹运动方式,包括直线运动和圆弧运动;
n次Bezier曲线:n次Bezier曲线公式为:其中bi,n(t)称为Bernstein基函数,t=0对应Beizer曲线的起始点,t=1对应Beizer曲线的终止点。
P0-Pn这n个特征点或控制点在平面或在三维空间定义了n次Bezier曲线,其组成的多边形称为特征多边形或控制多边形。其中,P0为起始点,Pn为终止点,P1-Pn-1为中间点。例如请参见图3,P0、P1、P2、P3四个点定义了三次Bezier曲线,三次Bezier曲线起始于P0走向P1,并从P2方向到P3。需要说明的是,一般三次Bezier曲线不经过P1、P2,这两个点只提供方向。
本发明实施例提供了机器人运动轨迹规划方法及相关装置,以令连续的CP运动平滑转接,同时,速度不必降为0。本发明实施例所涉及到的机器人运动轨迹规划装置应用于机器人中,其具体可为机器人中的控制器/处理器。
本发明的一个实施例提供一种实现机器人运动轨迹规划的方法,和基于这个方法的机器人运动轨迹规划装置。该装置采用三次Bezier曲线实现连续的两CP运动轨迹段(第一CP运动轨迹段和第二CP运动轨迹段)之间的平滑转接,请参见图4,其具体操作包括:
在401部分:根据第一CP运动轨迹段和第二CP运动轨迹段确定三次Bezier曲线的特征点;
其中,特征点可包括P0、P1、P2、P3,其中,P0为起始点、P3为终止点,P1、P2为中间点。
在402部分:根据上述特征点构建三次Bezier曲线,作为第一CP运动轨迹段和第二CP运动轨迹段之间的平滑过渡轨迹段。
在确定出特征点后,根据特征点构建三次Bezier曲线可采用现有的构建方式,在此不作赘述。
上述平滑过渡轨迹段的起始点与第一CP运动轨迹段的拐出点相重合,平滑过渡轨迹段的终止点与所述第二CP运动轨迹段的拐入点相重合。
其中,平滑过渡轨迹段在起始点P0上的切矢量方向、与第一CP运动轨迹段在拐出点上的切矢量方向相同,这样,平滑过渡轨迹段在其起始点与第一CP运动轨迹段相切;同时,平滑过渡轨迹段在其终止点P3上的切矢量方向和第二CP运动轨迹段在拐入点上的切矢量方向的方向相同。这样,平滑过渡轨迹段在其终止点与第二CP运动轨迹段相切。由于平滑过渡轨迹段在始末点分别与第一CP运动轨迹段和第二CP运动轨迹段相切,则可实现在拐点处(拐出点和拐入点)速度连续,也即可实现连续的CP运动平滑转接,同时,速度不必降为0。
在一个示例中,拐出点和拐入点可根据用户的配置来确定。更具体的,用户可指定第一CP运动轨迹段和第二CP运动轨迹段的交点(例如图6b、7b、8b、9b所示的点O)与拐出点的距离,拐入点与交点的距离应等于拐出点与交点的距离。在指定距离后,即可确定拐出点和拐入点。
需要说明的是,对于连续的多段CP运动轨迹段,可针对每两个连续的CP运动轨迹段执行上述401部分和402部分。例如,对于连续的三段CP运动轨迹段1-3,可先规划出CP运动轨迹段1-2之间的平滑过渡轨迹段,再规划出CP运动轨迹段2-3之间的平滑过渡轨迹段。
下面结合附图5,对本发明的实施例提供的方案进行说明。
图5为本发明实施例提供的机器人运动轨迹规划方法的另一示例性流程图。
在500部分:规划连续的CP运动轨迹段。
连续的CP运动轨迹段也是需要预先规划的。500部分是后续501部分和502部分的基础。
在一个示例中,可一次性规划出所需的所有CP运动轨迹段。例如,一共需要连续的4个CP运动轨迹段以完成机器人的某个操作,则可一次性规划出4个连续的CP运动轨迹段。
在另一个示例中,也可分批次规划出所需的所有CP运动轨迹段。仍以需要连续的CP运动轨迹段1-4以完成机器人的某个操作为例,可先规划CP运动轨迹段1-2,然后,执行后续的501部分和502部分,以得到CP运动轨迹段1-2之间的平滑过渡轨迹段。之后,再规划出CP运动轨迹段3,再执行后续的501部分和502部分,以得到CP运动轨迹段2-3之间的平滑过渡轨迹段,以此类推。
在另一个示例中,还可采用前瞻X段(X可取3)的方式进行规划:以需要连续的CP运动轨迹段1-8以完成机器人的某个操作为例,可先规划CP运动轨迹段1-2,然后,执行后续的501部分和502部分,以得到CP运动轨迹段1-2之间的平滑过渡轨迹段。之后,再规划出CP运动轨迹段3,再执行后续的501部分和502部分,以得到CP运动轨迹段2-3之间的平滑过渡轨迹段。之后,等CP运动轨迹段1运行完,再规划CP运动轨迹段4,再执行后续的501部分和502部分,以得到CP运动轨迹段3-4之间的平滑过渡轨迹段。然后,等CP运动轨迹段2运行完,再规划CP运动轨迹段5,再执行后续的501部分和502部分,以得到CP运动轨迹段4-5之间的平滑过渡轨迹段,以此类推。
在501部分:根据第一CP运动轨迹段和第二CP运动轨迹段确定三次Bezier曲线的特征点。
501部分与401部分相类似,在此不作赘述。
在502部分:根据上述特征点构建三次Bezier曲线,作为第一CP运动轨迹段和第二CP运动轨迹段之间的平滑过渡轨迹段。
502部分与402部分相类似,在此不作赘述。
在实际应用中,第一CP运动轨迹段和第二CP运动轨迹段可分别为:直线段与直线段、直线段与圆弧段、圆弧段与直线段、圆弧段与圆弧段四种情况。下面将分情况,对本发明的实施例做进一步说明。
图6a为第一CP运动轨迹段和第二CP运动轨迹段分别为直线段时,本发明实施例提供的又一种机器人运动轨迹规划方法示例性流程图。图6b显示的是第一CP运动轨迹段(lc)和第二CP运动轨迹段(ln)以及平滑过渡轨迹段。lc轨迹段和ln轨迹段相交于交点O。
在601部分,确定lc轨迹段的拐出点为平滑过渡轨迹段的起始点P0,确定ln轨迹段的拐入点为平滑过渡轨迹段的终止点P3。
在602部分:选择线段P0O(也即交点O和起始点P0之间的线段)上的一点作为中间点P1;线段P0O是交点O和起始点P0之间的线段。
在一个示例中,中间点P1到交点O的距离,等于其到起始点P0的距离。因此,在求解P1坐标时,可使P0P1=P1O,进而获得P1点坐标。需要说明的是,P0P1=P1O可以使特征点分布均匀,而特征点均匀分布可以使Beizer曲线的参数均匀,轨迹曲率变化平稳。
在603部分:选择线段OP3交上的一点作为中间点P2。
线段OP3是交点O和终止点P3之间的线段。
在一个示例中,中间点P2到交点O的距离,等于中间点P2到终止点P3的距离。因此,在求解P2坐标时,可使P3P2=P2O,从而获得P2点坐标。
中间点P1可称为第一中间点,中间点P2可称为第二中间点。
在604部分:根据上述特征点构建三次Bezier曲线,作为第一CP运动轨迹段和第二CP运动轨迹段之间的平滑过渡轨迹段。
604部分与前述的402和502部分相类似,在此不作赘述。
图7a为第一CP运动轨迹段为直线段,第二CP运动轨迹段为圆弧段时,本发明实施例提供的又一种机器人运动轨迹规划方法示例性流程图。图7b显示的是第一CP运动轨迹段(lc)和第二CP运动轨迹段(ln)以及平滑过渡轨迹段。
在701部分,确定lc轨迹段的拐出点为平滑过渡轨迹段的起始点P0,确定ln轨迹段的拐入点为平滑过渡轨迹段的终止点P3。
701部分与601部分相类似,在此不作赘述。
在702部分:选择线段P0O(也即交点O和起始点P0之间的线段)上的一点作为中间点P1。
702部分与602部分相类似,在此不作赘述。
在703部分:选择终止点P3切线上的一点作为中间点P2,并且,中间点P2位于交点O和终止点P3之间(可参见图7b)。
在一个示例中,中间点P2到交点O的距离,等于中间点P2到终止点P3的距离。因此,在求解P2坐标时,可使P3P2=P2O,从而获得P2点坐标。
在704部分:根据上述特征点构建三次Bezier曲线,作为第一CP运动轨迹段和第二CP运动轨迹段之间的平滑过渡轨迹段。
704部分与前述的402、502和604部分相类似,在此不作赘述。
图8a为第一CP运动轨迹段为圆弧段,第二CP运动轨迹段为直线段时,本发明实施例提供的又一种机器人运动轨迹规划方法示例性流程图。图8b显示的是第一CP运动轨迹段(lc)和第二CP运动轨迹段(ln)以及平滑过渡轨迹段。
在801部分,确定lc轨迹段的拐出点为平滑过渡轨迹段的起始点P0,确定ln轨迹段的拐入点为平滑过渡轨迹段的终止点P3。
801部分与601、701部分相类似,在此不作赘述。
在802部分:选择起始点P0切线上的一点作为中间点P1,并且,中间点P1位于交点O和起始点P0之间(可参见图8b)。
在一个示例中,中间点P1到交点O的距离,等于其到起始点P0的距离。因此,在求解P1坐标时,可使P0P1=P1O,进而获得P1点坐标。
在803部分:选择线段OP3交上的一点作为中间点P2。线段OP3是交点O和终止点P3之间的线段。
803部分与603部分相类似,在此不作赘述。
在804部分:根据上述特征点构建三次Bezier曲线,作为第一CP运动轨迹段和第二CP运动轨迹段之间的平滑过渡轨迹段。
804部分与前述的402、502、604和704部分相类似,在此不作赘述。
图9a为第一CP运动轨迹段和第二CP运动轨迹段均为圆弧段时,本发明实施例提供的又一种机器人运动轨迹规划方法示例性流程图。图9b显示的是第一CP运动轨迹段(lc)和第二CP运动轨迹段(ln)以及平滑过渡轨迹段。
在901部分,确定lc轨迹段的拐出点为平滑过渡轨迹段的起始点P0,确定ln轨迹段的拐入点为平滑过渡轨迹段的终止点P3。
901部分与601、701、801部分相类似,在此不作赘述。
在902部分:选择起始点P0切线上的一点作为中间点P1,并且,中间点P1位于交点O和起始点P0之间(可参见图9b)。
902部分与802部分相类似,在此不作赘述。
在903部分:选择终止点P3切线上的一点作为中间点P2,并且,中间点P2位于交点O和终止点P3之间(可参见图9b)。
903部分与703部分相类似,在此不作赘述。
在904部分:根据上述特征点构建三次Bezier曲线,作为第一CP运动轨迹段和第二CP运动轨迹段之间的平滑过渡轨迹段。
904部分与前述的402、502、604、704和804部分相类似,在此不作赘述。
图10示出了上述实施例中所涉及的机器人运动轨迹规划装置的一种可能的结构示意图,包括:
特征点确定单元101,用于根据第一CP运动轨迹段和第二CP运动轨迹段确定三次Bezier曲线的特征点。
平滑过渡轨迹构建单元102,用于获根据所述特征点构建三次Bezier曲线,作为所述第一CP运动轨迹段和第二CP运动轨迹段之间的平滑过渡轨迹段,所述平滑过渡轨迹段的起始点与所述第一CP运动轨迹段的拐出点相重合,所述平滑过渡轨迹段的终止点与所述第二CP运动轨迹段的拐入点相重合;其中,所述平滑过渡轨迹段在所述起始点上的切矢量方向、与所述第一CP运动轨迹段在所述拐出点上的切矢量方向相同;所述平滑过渡轨迹段在所述终止点上的切矢量方向和所述第二CP运动轨迹段在所述拐入点上的切矢量方向的方向相同。
此外,还可包括规划单元103,用于在所述特征点确定单元确定三次Bezier曲线的特征点之前,规划连续的CP运动轨迹段。
其中,特征点确定单元101可用于执行图4所示的401部分、图5所示的501部分、图6所示的601-603部分、图7所示的701-703部分、图8所示的801-803部分,以及,图9所示的901-903部分。
平滑过渡轨迹构建单元102可用于执行图4所示的402部分、图5所示的502部分、图6所示的604部分、图7所示的704部分、图8所示的804部分,以及,图9所示的904部分。
规划单元103可用于执行图5所示的500部分。
图11示出了上述实施例中所涉及的机器人的一种可能的结构示意图,包括:
总线、控制器/处理器1、存储器2、通信接口3、输入设备4、输出设备5和被控器件6。处理器1、存储器2、通信接口3、输入设备4、输出设备5和被控器件6可通过总线相互连接。其中:
总线可包括一通路,在计算机系统各个部件之间传送信息。
控制器/处理器1(机器人运动轨迹规划装置)可以是通用处理器,例如通用中央处理器(CPU)、网络处理器(Network Processor,简称NP)、微处理器等,也可以是特定应用集成电路(application-specific integrated circuit,ASIC),或一个或多个用于控制本发明方案程序执行的集成电路。还可以是数字信号处理器(DSP)、专用集成电路(ASIC)、现成可编程门阵列(FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件。控制器/处理器1也可以是实现计算功能的组合,例如包含一个或多个微处理器组合,DSP和微处理器的组合等等。
存储器2中保存有执行本发明技术方案的程序,还可以保存有操作系统和其他应用程序。具体地,程序可以包括程序代码,程序代码包括计算机操作指令。更具体的,存储器2可以是只读存储器(read-only memory,ROM)、可存储静态信息和指令的其他类型的静态存储设备、随机存取存储器(random access memory,RAM)、可存储信息和指令的其他类型的动态存储设备、磁盘存储器等等。
输入设备4可包括接收用户输入的数据和信息的装置,例如键盘、鼠标、摄像头、扫描仪、光笔、语音输入装置、触摸屏等。
输出设备5可包括允许输出信息给用户的装置,例如显示屏、打印机、扬声器等。
通信接口3可包括使用任何收发器一类的装置,以便与其他设备或通信网络通信,如以太网,无线接入网(RAN),无线局域网(WLAN)等。
控制器/处理器1可用于执行图4、5、6a、7a、8a、9a中涉及机器人运动轨迹规划装置的处理过程和/或用于本申请所描述的技术的其他过程。控制器/处理器也可用于实现前述特征点确定单元101、平滑过渡轨迹构建单元102和规划单元103的功能。
被控器件6可用于按照控制器/处理器1规划出的连续的两CP运动轨迹段及平滑过渡轨迹段运行。
可以理解的是,图11仅仅示出了机器人的简化设计。在实际应用中,机器人可以包含任意数量的发射器,接收器,处理器,控制器,存储器,通信接口等,而所有可以实现本发明的机器人都在本发明的保护范围之内。
上述所有实施例所公开的方法和装置可运用于机械臂控制中,实现机械臂在笛卡尔空间下两条连续运行轨迹中的平滑转接。当然也可以拓展到任何需要规划路径的设备中,如小车、飞行器等等。
结合本发明公开内容所描述的方法或者算法的步骤可以硬件的方式来实现,也可以是由处理器执行软件指令的方式来实现。软件指令可以由相应的软件模块组成,软件模块可以被存放于RAM存储器、闪存、ROM存储器、EPROM存储器、EEPROM存储器、寄存器、硬盘、移动硬盘、CD-ROM或者本领域熟知的任何其它形式的存储介质中。一种示例性的存储介质耦合至处理器,从而使处理器能够从该存储介质读取信息,且可向该存储介质写入信息。当然,存储介质也可以是处理器的组成部分。
本领域技术人员应该可以意识到,在上述一个或多个示例中,本发明所描述的功能可以用硬件、软件、固件或它们的任意组合来实现。当使用软件实现时,可以将这些功能存储在计算机可读介质中或者作为计算机可读介质上的一个或多个指令或代码进行传输。计算机可读介质包括计算机存储介质和通信介质,其中通信介质包括便于从一个地方向另一个地方传送计算机程序的任何介质。存储介质可以是通用或专用计算机能够存取的任何可用介质。以上所述的具体实施方式,对本发明的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本发明的具体实施方式而已,并不用于限定本发明的保护范围,凡在本发明的技术方案的基础之上,所做的任何修改、等同替换、改进等,均应包括在本发明的保护范围之内。
Claims (12)
1.一种机器人运动轨迹规划方法,其特征在于,至少用于基于三次Bezier曲线实现连续的两CP运动轨迹段之间的平滑转接,所述连续的两CP运动轨迹段包括第一CP运动轨迹段和第二CP运动轨迹段;
所述方法包括:
根据所述第一CP运动轨迹段和第二CP运动轨迹段确定三次Bezier曲线的特征点;
根据所述特征点构建三次Bezier曲线,作为所述第一CP运动轨迹段和第二CP运动轨迹段之间的平滑过渡轨迹段,所述平滑过渡轨迹段的起始点与所述第一CP运动轨迹段的拐出点相重合,所述平滑过渡轨迹段的终止点与所述第二CP运动轨迹段的拐入点相重合;
其中,所述平滑过渡轨迹段在所述起始点上的切矢量方向、与所述第一CP运动轨迹段在所述拐出点上的切矢量方向相同;所述平滑过渡轨迹段在所述终止点上的切矢量方向和所述第二CP运动轨迹段在所述拐入点上的切矢量方向的方向相同。
2.如权利要求1所述的方法,其特征在于,在所述确定三次Bezier曲线的特征点之前,还包括:规划连续的CP运动轨迹段。
3.如权利要求1或2所述方法,其特征在于,所述特征点包括起始点P0、终止点P3、第一中间点P1和第二中间点P2;所述第一CP运动轨迹段和第二CP运动轨迹段的交点表示为O点;
所述根据所述第一CP运动轨迹段和第二CP运动轨迹段确定三次Bezier曲线的特征点还包括:
当所述第一CP运动轨迹段为直线段时,选择所述交点O和起始点P0之间的线段上的一点作为所述中间点P1;
当所述第一CP运动轨迹段为圆弧段时,选择所述起始点P0切线上的一点作为所述中间点P1,并且,所述中间点P1位于所述交点O和起始点P0之间。
4.如权利要求3所述的方法,其特征在于,所述根据所述第一CP运动轨迹段和第二CP运动轨迹段确定三次Bezier曲线的特征点还包括:
当所述第二CP运动轨迹段为直线段时,选择所述交点O和终止点P3之间的线段上的一点作为所述中间点P2;
当所述第二CP运动轨迹段为圆弧段时,选择所述终止点P3切线上的一点作为所述中间点P2,并且,所述中间点P2位于所述交点O和终止点P3之间。
5.如权利要求3或4所述的方法,其特征在于,
所述中间点P1到所述交点O的距离,等于所述中间点P1到所述起始点P0的距离;
所述中间点P2到所述交点O的距离,等于所述中间点P2到所述终止点P3的距离。
6.一种机器人运动轨迹规划装置,其特征在于,至少用于基于三次Bezier曲线实现连续的两CP运动轨迹段之间的平滑转接,所述连续的两CP运动轨迹段包括第一CP运动轨迹段和第二CP运动轨迹段;所述装置包括:
特征点确定单元,用于根据所述第一CP运动轨迹段和第二CP运动轨迹段确定三次Bezier曲线的特征点;
平滑过渡轨迹构建单元,用于根据所述特征点构建三次Bezier曲线,作为所述第一CP运动轨迹段和第二CP运动轨迹段之间的平滑过渡轨迹段,所述平滑过渡轨迹段的起始点与所述第一CP运动轨迹段的拐出点相重合,所述平滑过渡轨迹段的终止点与所述第二CP运动轨迹段的拐入点相重合;其中,所述平滑过渡轨迹段在所述起始点上的切矢量方向、与所述第一CP运动轨迹段在所述拐出点上的切矢量方向相同;所述平滑过渡轨迹段在所述终止点上的切矢量方向和所述第二CP运动轨迹段在所述拐入点上的切矢量方向的方向相同。
7.如权利要求6所述的装置,其特征在于,还包括:
规划单元,用于在所述特征点确定单元确定三次Bezier曲线的特征点之前,规划连续的CP运动轨迹段。
8.如权利要求6或7所述装置,其特征在于,所述特征点包括起始点P0、终止点P3、第一中间点P1和第二中间点P2;所述第一CP运动轨迹段和第二CP运动轨迹段的交点表示为O点;
在所述根据所述第一CP运动轨迹段和第二CP运动轨迹段确定三次Bezier曲线的特征点的方面,所述平滑过渡轨迹构建单元用于:
当所述第一CP运动轨迹段为直线段时,选择所述交点O和起始点P0之间的线段上的一点作为所述中间点P1;
当所述第一CP运动轨迹段为圆弧段时,选择所述起始点P0切线上的一点作为所述中间点P1,并且,所述中间点P1位于所述交点O和起始点P0之间。
9.如权利要求8所述的装置,其特征在于,在所述根据所述第一CP运动轨迹段和第二CP运动轨迹段确定三次Bezier曲线的特征点的方面,所述平滑过渡轨迹构建单元还用于:
当所述第二CP运动轨迹段为直线段时,选择所述交点O和终止点P3之间的线段上的一点作为所述中间点P2;
当所述第二CP运动轨迹段为圆弧段时,选择所述终止点P3切线上的一点作为所述中间点P2,并且,所述中间点P2位于所述交点O和终止点P3之间。
10.一种机器人运动轨迹规划装置,其特征在于,至少用于基于三次Bezier曲线实现连续的两CP运动轨迹段之间的平滑转接,所述连续的两CP运动轨迹段包括第一CP运动轨迹段和第二CP运动轨迹段;
所述装置包括:处理器和存储器,所述处理器通过运行存储在所述存储器内的软件程序、调用存储在所述存储器内的数据,至少执行如下步骤:
根据所述第一CP运动轨迹段和第二CP运动轨迹段确定三次Bezier曲线的特征点;
根据所述特征点构建三次Bezier曲线,作为所述第一CP运动轨迹段和第二CP运动轨迹段之间的平滑过渡轨迹段,所述平滑过渡轨迹段的起始点与所述第一CP运动轨迹段的拐出点相重合,所述平滑过渡轨迹段的终止点与所述第二CP运动轨迹段的拐入点相重合;
其中,所述平滑过渡轨迹段在所述起始点上的切矢量方向、与所述第一CP运动轨迹段在所述拐出点上的切矢量方向相同;所述平滑过渡轨迹段在所述终止点上的切矢量方向和所述第二CP运动轨迹段在所述拐入点上的切矢量方向的方向相同。
11.一种机器人,其特征在于,包括机器人运动轨迹规划装置和被控器件,其中:
所述机器人运动轨迹规划装置用于:根据连续的两CP运动轨迹段中的第一CP运动轨迹段和第二CP运动轨迹段,确定三次Bezier曲线的特征点;根据所述特征点构建三次Bezier曲线,作为所述第一CP运动轨迹段和第二CP运动轨迹段之间的平滑过渡轨迹段,所述平滑过渡轨迹段的起始点与所述第一CP运动轨迹段的拐出点相重合,所述平滑过渡轨迹段的终止点与所述第二CP运动轨迹段的拐入点相重合;其中,所述平滑过渡轨迹段在所述起始点上的切矢量方向、与所述第一CP运动轨迹段在所述拐出点上的切矢量方向相同;所述平滑过渡轨迹段在所述终止点上的切矢量方向和所述第二CP运动轨迹段在所述拐入点上的切矢量方向的方向相同;
所述被控器件用于:按照所述机器人运动轨迹规划装置规划出的连续的两CP运动轨迹段及平滑过渡轨迹段运行。
12.如权利要求11所述的机器人,其特征在于,所述被控器件具体为:操作臂。
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/CN2017/070131 WO2018126354A1 (zh) | 2017-01-04 | 2017-01-04 | 机器人运动轨迹规划方法及相关装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107980109A true CN107980109A (zh) | 2018-05-01 |
CN107980109B CN107980109B (zh) | 2021-05-07 |
Family
ID=62006148
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201780002249.8A Active CN107980109B (zh) | 2017-01-04 | 2017-01-04 | 机器人运动轨迹规划方法及相关装置 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN107980109B (zh) |
WO (1) | WO2018126354A1 (zh) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108919750A (zh) * | 2018-07-27 | 2018-11-30 | 深圳市雷赛控制技术有限公司 | 一种基于非均匀b样条的加工轨迹实时规划方法及装置 |
CN109164797A (zh) * | 2018-07-17 | 2019-01-08 | 袁乐铮 | 一种用于船舶智能控制的航迹制导方法及系统 |
CN109176504A (zh) * | 2018-08-09 | 2019-01-11 | 深圳蓝胖子机器人有限公司 | 机械手路径规划方法及装置 |
CN109648557A (zh) * | 2018-12-21 | 2019-04-19 | 上海信耀电子有限公司 | 一种六轴机器人空间运动规划方法 |
CN109773791A (zh) * | 2019-01-31 | 2019-05-21 | 北京华航唯实机器人科技股份有限公司 | 路径生成方法及装置 |
CN110948477A (zh) * | 2018-09-26 | 2020-04-03 | 深圳市优必选科技有限公司 | 一种机器人及其动作优化方法和装置 |
CN112276957A (zh) * | 2020-11-05 | 2021-01-29 | 哈工大机器人(合肥)国际创新研究院 | 一种直线段和圆弧的平滑过渡方法及系统 |
CN113110423A (zh) * | 2021-03-26 | 2021-07-13 | 深圳市优必选科技股份有限公司 | 步态轨迹规划方法、装置、计算机可读存储介质及机器人 |
CN113246143A (zh) * | 2021-06-25 | 2021-08-13 | 视比特(长沙)机器人科技有限公司 | 一种机械臂动态避障轨迹规划方法及装置 |
CN115509240A (zh) * | 2022-11-21 | 2022-12-23 | 合肥井松智能科技股份有限公司 | 一种基于可通行区域的路径规划方法 |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113711155A (zh) * | 2019-07-19 | 2021-11-26 | 西门子(中国)有限公司 | 机器人路径规划器、方法、装置和计算机可读存储介质 |
CN111857037B (zh) * | 2020-06-19 | 2022-07-26 | 深圳市亿维自动化技术有限公司 | 一种过渡轨迹的生成方法、机器人及计算机可读存储介质 |
CN113791576B (zh) * | 2021-08-19 | 2023-10-17 | 五邑大学 | 一种轨迹间的局部光顺过渡方法、装置、设备及存储介质 |
CN116610070B (zh) * | 2023-07-20 | 2023-10-20 | 杭州芯控智能科技有限公司 | 基于笛卡尔空间的轨迹匀速过渡方法和装置 |
Citations (31)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0762265A2 (en) * | 1995-08-31 | 1997-03-12 | Canon Kabushiki Kaisha | Coordinate input device and method |
US5920679A (en) * | 1997-08-25 | 1999-07-06 | The Research Foundation Of State University Of New York | Apparatus and method for computer-aided low-harmonic trajectory planning for computer-controlled machinery |
JP2000056822A (ja) * | 1998-08-13 | 2000-02-25 | Mitsubishi Electric Corp | 軌跡制御装置 |
US20040019394A1 (en) * | 2001-10-16 | 2004-01-29 | Red Walter E. | Systems and methods for representing complex n-curves for direct control of tool motion |
US20060015247A1 (en) * | 2004-07-07 | 2006-01-19 | The Boeing Company | Bezier curve flightpath guidance using moving waypoints |
WO2007041523A2 (en) * | 2005-09-30 | 2007-04-12 | Sunfish Studio, Llc | System and method to compute narrow bounds on a modal interval polynomial function |
CN101206472A (zh) * | 2007-12-06 | 2008-06-25 | 上海交通大学 | 用于高速数控加工轨迹拐角的速度平滑方法 |
US20090027398A1 (en) * | 2007-07-26 | 2009-01-29 | Tufts University | Method for recognizing a shape from a path of a digitizing device |
US20100106417A1 (en) * | 2008-10-27 | 2010-04-29 | International Business Machines Corporation | System and method for identifying a trajectory for each vehicle involved in an accident |
US20100289801A1 (en) * | 2009-05-15 | 2010-11-18 | Microsoft Corporation | Interactive connector routing between obstacles |
EP2254092A2 (en) * | 2009-05-19 | 2010-11-24 | Mitsubishi Electric Corporation | Method for reconstructing a distance field of a swept volume at a sample point |
US20100298961A1 (en) * | 2009-05-19 | 2010-11-25 | Frisken Sarah F | Method for simulating numerically controlled milling using adaptively sampled distance fields |
EP2255931A2 (de) * | 2009-05-29 | 2010-12-01 | KUKA Roboter GmbH | Verfahren und Vorrichtung zur Steuerung eines Manipulators |
CN102091966A (zh) * | 2011-01-04 | 2011-06-15 | 山东理工大学 | 三角Bézier曲面数控加工刀轨生成方法 |
CN102091879A (zh) * | 2011-01-04 | 2011-06-15 | 长沙红点自动化科技有限公司 | 一种焊接机器人过渡轨迹规划方法 |
CN102147600A (zh) * | 2011-04-30 | 2011-08-10 | 上海交通大学 | 实时生成曲率连续路径的数控插补系统 |
CN102207736A (zh) * | 2010-03-31 | 2011-10-05 | 中国科学院自动化研究所 | 基于贝塞尔曲线的机器人路径规划方法及装置 |
CN102528802A (zh) * | 2010-12-31 | 2012-07-04 | 中国科学院计算技术研究所 | 九自由度机器人的运动驱动方法 |
WO2013033289A1 (en) * | 2011-09-02 | 2013-03-07 | Brooks Automation, Inc. | Time-optimal trajectories for robotic transfer devices |
CN102998684A (zh) * | 2012-11-21 | 2013-03-27 | 厦门雅迅网络股份有限公司 | 一种基于贝塞尔曲线的终端定位轨迹拟合方法 |
CN103189809A (zh) * | 2010-10-25 | 2013-07-03 | 株式会社牧野铣床制作所 | 工具路径的生成方法以及生成装置 |
CN103336590A (zh) * | 2013-07-17 | 2013-10-02 | 天脉聚源(北京)传媒科技有限公司 | 一种输入方法及装置 |
CN103353761A (zh) * | 2013-07-12 | 2013-10-16 | 北京配天大富精密机械有限公司 | 机器人连续加工方法、装置及平滑转接方法、装置 |
CN103500037A (zh) * | 2013-09-11 | 2014-01-08 | 天脉聚源(北京)传媒科技有限公司 | 一种轨迹平滑的方法及装置 |
CN103646150A (zh) * | 2013-12-23 | 2014-03-19 | 北京航空航天大学 | 一种基于5次Bezier曲线的G3连续过渡曲线构造方法 |
CN105435997A (zh) * | 2015-12-14 | 2016-03-30 | 江苏大学 | 基于Bézier曲线的喷涂机器人路径规划方法 |
CN105500354A (zh) * | 2016-02-02 | 2016-04-20 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人应用的过渡轨迹规划方法 |
CN105573315A (zh) * | 2015-12-01 | 2016-05-11 | 珞石(北京)科技有限公司 | 用于工业机器人的笛卡尔空间轨迹的几何平滑方法 |
CN105651295A (zh) * | 2016-01-15 | 2016-06-08 | 武汉光庭信息技术股份有限公司 | 基于Bezier曲线构建交叉路口驶入驶出车道Link的连接曲线算法 |
CN105945942A (zh) * | 2016-04-05 | 2016-09-21 | 广东工业大学 | 一种机器人离线编程系统及方法 |
CN106227152A (zh) * | 2016-10-17 | 2016-12-14 | 合肥工业大学 | 一种cnc加工的平滑过渡方法及其平滑过渡装置 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20050012323A (ko) * | 2003-07-25 | 2005-02-02 | 정원지 | 6축 수직다관절 로봇의 용접경로 생성방법 |
-
2017
- 2017-01-04 WO PCT/CN2017/070131 patent/WO2018126354A1/zh active Application Filing
- 2017-01-04 CN CN201780002249.8A patent/CN107980109B/zh active Active
Patent Citations (31)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0762265A2 (en) * | 1995-08-31 | 1997-03-12 | Canon Kabushiki Kaisha | Coordinate input device and method |
US5920679A (en) * | 1997-08-25 | 1999-07-06 | The Research Foundation Of State University Of New York | Apparatus and method for computer-aided low-harmonic trajectory planning for computer-controlled machinery |
JP2000056822A (ja) * | 1998-08-13 | 2000-02-25 | Mitsubishi Electric Corp | 軌跡制御装置 |
US20040019394A1 (en) * | 2001-10-16 | 2004-01-29 | Red Walter E. | Systems and methods for representing complex n-curves for direct control of tool motion |
US20060015247A1 (en) * | 2004-07-07 | 2006-01-19 | The Boeing Company | Bezier curve flightpath guidance using moving waypoints |
WO2007041523A2 (en) * | 2005-09-30 | 2007-04-12 | Sunfish Studio, Llc | System and method to compute narrow bounds on a modal interval polynomial function |
US20090027398A1 (en) * | 2007-07-26 | 2009-01-29 | Tufts University | Method for recognizing a shape from a path of a digitizing device |
CN101206472A (zh) * | 2007-12-06 | 2008-06-25 | 上海交通大学 | 用于高速数控加工轨迹拐角的速度平滑方法 |
US20100106417A1 (en) * | 2008-10-27 | 2010-04-29 | International Business Machines Corporation | System and method for identifying a trajectory for each vehicle involved in an accident |
US20100289801A1 (en) * | 2009-05-15 | 2010-11-18 | Microsoft Corporation | Interactive connector routing between obstacles |
EP2254092A2 (en) * | 2009-05-19 | 2010-11-24 | Mitsubishi Electric Corporation | Method for reconstructing a distance field of a swept volume at a sample point |
US20100298961A1 (en) * | 2009-05-19 | 2010-11-25 | Frisken Sarah F | Method for simulating numerically controlled milling using adaptively sampled distance fields |
EP2255931A2 (de) * | 2009-05-29 | 2010-12-01 | KUKA Roboter GmbH | Verfahren und Vorrichtung zur Steuerung eines Manipulators |
CN102207736A (zh) * | 2010-03-31 | 2011-10-05 | 中国科学院自动化研究所 | 基于贝塞尔曲线的机器人路径规划方法及装置 |
CN103189809A (zh) * | 2010-10-25 | 2013-07-03 | 株式会社牧野铣床制作所 | 工具路径的生成方法以及生成装置 |
CN102528802A (zh) * | 2010-12-31 | 2012-07-04 | 中国科学院计算技术研究所 | 九自由度机器人的运动驱动方法 |
CN102091879A (zh) * | 2011-01-04 | 2011-06-15 | 长沙红点自动化科技有限公司 | 一种焊接机器人过渡轨迹规划方法 |
CN102091966A (zh) * | 2011-01-04 | 2011-06-15 | 山东理工大学 | 三角Bézier曲面数控加工刀轨生成方法 |
CN102147600A (zh) * | 2011-04-30 | 2011-08-10 | 上海交通大学 | 实时生成曲率连续路径的数控插补系统 |
WO2013033289A1 (en) * | 2011-09-02 | 2013-03-07 | Brooks Automation, Inc. | Time-optimal trajectories for robotic transfer devices |
CN102998684A (zh) * | 2012-11-21 | 2013-03-27 | 厦门雅迅网络股份有限公司 | 一种基于贝塞尔曲线的终端定位轨迹拟合方法 |
CN103353761A (zh) * | 2013-07-12 | 2013-10-16 | 北京配天大富精密机械有限公司 | 机器人连续加工方法、装置及平滑转接方法、装置 |
CN103336590A (zh) * | 2013-07-17 | 2013-10-02 | 天脉聚源(北京)传媒科技有限公司 | 一种输入方法及装置 |
CN103500037A (zh) * | 2013-09-11 | 2014-01-08 | 天脉聚源(北京)传媒科技有限公司 | 一种轨迹平滑的方法及装置 |
CN103646150A (zh) * | 2013-12-23 | 2014-03-19 | 北京航空航天大学 | 一种基于5次Bezier曲线的G3连续过渡曲线构造方法 |
CN105573315A (zh) * | 2015-12-01 | 2016-05-11 | 珞石(北京)科技有限公司 | 用于工业机器人的笛卡尔空间轨迹的几何平滑方法 |
CN105435997A (zh) * | 2015-12-14 | 2016-03-30 | 江苏大学 | 基于Bézier曲线的喷涂机器人路径规划方法 |
CN105651295A (zh) * | 2016-01-15 | 2016-06-08 | 武汉光庭信息技术股份有限公司 | 基于Bezier曲线构建交叉路口驶入驶出车道Link的连接曲线算法 |
CN105500354A (zh) * | 2016-02-02 | 2016-04-20 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人应用的过渡轨迹规划方法 |
CN105945942A (zh) * | 2016-04-05 | 2016-09-21 | 广东工业大学 | 一种机器人离线编程系统及方法 |
CN106227152A (zh) * | 2016-10-17 | 2016-12-14 | 合肥工业大学 | 一种cnc加工的平滑过渡方法及其平滑过渡装置 |
Non-Patent Citations (2)
Title |
---|
XINPING BU ETAL: "Curvature Continuous Path Smoothing Based on Cubic Bezier Curves for Car-Like Vehicles", 《PROCEEDINGS OF THE 2015 IEEE CONFERENCE ON ROBOTICS AND BIOMIMETICS》 * |
蔡茂佼: "基于曲线特征的视觉形状伺服的研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109164797B (zh) * | 2018-07-17 | 2021-12-14 | 袁乐铮 | 一种用于船舶智能控制的航迹制导方法及系统 |
CN109164797A (zh) * | 2018-07-17 | 2019-01-08 | 袁乐铮 | 一种用于船舶智能控制的航迹制导方法及系统 |
CN108919750A (zh) * | 2018-07-27 | 2018-11-30 | 深圳市雷赛控制技术有限公司 | 一种基于非均匀b样条的加工轨迹实时规划方法及装置 |
CN108919750B (zh) * | 2018-07-27 | 2020-01-21 | 深圳市雷赛控制技术有限公司 | 一种基于非均匀b样条的加工轨迹实时规划方法及装置 |
CN109176504A (zh) * | 2018-08-09 | 2019-01-11 | 深圳蓝胖子机器人有限公司 | 机械手路径规划方法及装置 |
CN109176504B (zh) * | 2018-08-09 | 2019-09-20 | 深圳蓝胖子机器人有限公司 | 机械手路径规划方法及装置 |
CN110948477A (zh) * | 2018-09-26 | 2020-04-03 | 深圳市优必选科技有限公司 | 一种机器人及其动作优化方法和装置 |
CN110948477B (zh) * | 2018-09-26 | 2021-12-17 | 深圳市优必选科技有限公司 | 一种机器人及其动作优化方法和装置 |
CN109648557A (zh) * | 2018-12-21 | 2019-04-19 | 上海信耀电子有限公司 | 一种六轴机器人空间运动规划方法 |
CN109773791A (zh) * | 2019-01-31 | 2019-05-21 | 北京华航唯实机器人科技股份有限公司 | 路径生成方法及装置 |
CN112276957A (zh) * | 2020-11-05 | 2021-01-29 | 哈工大机器人(合肥)国际创新研究院 | 一种直线段和圆弧的平滑过渡方法及系统 |
CN112276957B (zh) * | 2020-11-05 | 2022-03-11 | 哈工大机器人(合肥)国际创新研究院 | 一种直线段和圆弧的平滑过渡方法及系统 |
CN113110423A (zh) * | 2021-03-26 | 2021-07-13 | 深圳市优必选科技股份有限公司 | 步态轨迹规划方法、装置、计算机可读存储介质及机器人 |
WO2022198995A1 (zh) * | 2021-03-26 | 2022-09-29 | 深圳市优必选科技股份有限公司 | 步态轨迹规划方法、装置、计算机可读存储介质及机器人 |
CN113110423B (zh) * | 2021-03-26 | 2024-04-26 | 深圳市优必选科技股份有限公司 | 步态轨迹规划方法、装置、计算机可读存储介质及机器人 |
CN113246143A (zh) * | 2021-06-25 | 2021-08-13 | 视比特(长沙)机器人科技有限公司 | 一种机械臂动态避障轨迹规划方法及装置 |
CN115509240A (zh) * | 2022-11-21 | 2022-12-23 | 合肥井松智能科技股份有限公司 | 一种基于可通行区域的路径规划方法 |
Also Published As
Publication number | Publication date |
---|---|
WO2018126354A1 (zh) | 2018-07-12 |
CN107980109B (zh) | 2021-05-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107980109A (zh) | 机器人运动轨迹规划方法及相关装置 | |
CN107980108A (zh) | 机器人运动轨迹规划方法及相关装置 | |
US11262764B2 (en) | Computer-implemented method and a system for defining a path for a vehicle within an environment with obstacles | |
Kallmann | Shortest Paths with Arbitrary Clearance from Navigation Meshes. | |
CN106313047A (zh) | 一种基于Bezier样条的机器人实时拐角过渡方法 | |
CN110187706A (zh) | 一种速度规划方法、装置、电子设备及存储介质 | |
CN110231041B (zh) | 一种车道切换的导航方法和装置 | |
US9278448B2 (en) | Position control for a positioning system comprising larger scale and smaller scale positioning mechanisms | |
JPS6074003A (ja) | 形状創成装置 | |
CN103731377B (zh) | 处理报文的方法与设备 | |
JP2003150980A (ja) | ビデオゲーム装置、ビデオゲームにおけるキャラクタの表示方法、プログラム及び記録媒体 | |
WO2022161315A1 (zh) | 机器人路径规划方法、运行方法、机器人以及介质 | |
CN111539345A (zh) | 用于确定变道动作的方法、装置、设备及可读存储介质 | |
CN117516573A (zh) | 一种多目标航点规划方法及系统 | |
CN109141450A (zh) | 目标速度确定方法和系统、计算机设备、计算机存储介质 | |
Wu et al. | Time‐Optimal Trajectory Planning along Parametric Polynomial Lane‐Change Curves with Bounded Velocity and Acceleration: Simulations for a Unicycle Based on Numerical Integration | |
JP2021060324A (ja) | 経路設定装置、経路設定方法及び経路設定プログラム | |
JP5945170B2 (ja) | 電子機器、電子機器に画像を表示するための方法、および、当該方法を実現するためのプログラム | |
CN113534702A (zh) | 一种控制方法、装置、设备及存储介质 | |
CN115179299A (zh) | 一种多轴设备的关节空间轨迹的规划方法及装置 | |
WO2020034887A1 (zh) | 智能体行进路径的确定方法及装置 | |
JP6315811B2 (ja) | プログラム及び運転曲線作成装置 | |
JP2010097307A (ja) | 空域設定装置及び空域設定方法及び空域設定プログラム | |
CN105426077B (zh) | 一种基于cocos2dx框架的变化比例确定方法及装置 | |
TWI716127B (zh) | 機器人及其路徑插值規劃命令產生系統 |
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 |