CN117464693B - 一种基于三次样条插值的三维机械臂粒子群路径规划方法 - Google Patents

一种基于三次样条插值的三维机械臂粒子群路径规划方法 Download PDF

Info

Publication number
CN117464693B
CN117464693B CN202311819181.6A CN202311819181A CN117464693B CN 117464693 B CN117464693 B CN 117464693B CN 202311819181 A CN202311819181 A CN 202311819181A CN 117464693 B CN117464693 B CN 117464693B
Authority
CN
China
Prior art keywords
obstacle
path
virtual non
collision
cubic spline
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.)
Active
Application number
CN202311819181.6A
Other languages
English (en)
Other versions
CN117464693A (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.)
Chengdu Cetc Xingtuo Technology Co ltd
Original Assignee
Chengdu Cetc Xingtuo Technology 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 Chengdu Cetc Xingtuo Technology Co ltd filed Critical Chengdu Cetc Xingtuo Technology Co ltd
Priority to CN202311819181.6A priority Critical patent/CN117464693B/zh
Publication of CN117464693A publication Critical patent/CN117464693A/zh
Application granted granted Critical
Publication of CN117464693B publication Critical patent/CN117464693B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)
  • Numerical Control (AREA)

Abstract

本发明公开了一种基于三次样条插值的三维机械臂粒子群路径规划方法,涉及机械臂路径规划领域,包括:首先在三维空间中,对机械臂进行路径规划,得到一条最优路径;再识别三维空间中的障碍物边界;最后基于障碍物边界和最优路径,进行三次样条曲线插值,得到一条光滑的路径;本发明,能够有效避免机械臂与障碍物的碰撞,提高了路径的安全性。

Description

一种基于三次样条插值的三维机械臂粒子群路径规划方法
技术领域
本发明涉及机械臂路径规划领域,具体涉及一种基于三次样条插值的三维机械臂粒子群路径规划方法。
背景技术
本节中的陈述仅提供与本公开相关的背景信息,并且可能不构成现有技术。
三维机械臂路径规划是指在三维空间中,对三维机械臂进行路径规划,使其能够从起始位置移动到目标位置,并且在移动过程中满足各种约束条件,同时尽可能地优化路径长度和机械臂移动速度等性能指标。
目前,传统的三维机械臂路径规划算法往往忽略了运动空间中的障碍物对路径规划的影响,容易导致生成的路径与障碍物碰撞或绕行不够优化。
发明内容
本发明的目的在于:针对现有技术中存在的问题,提供了一种基于三次样条插值的三维机械臂粒子群路径规划方法,能够对三维粒子群算法所生成的路径节点与空间障碍物边界非碰撞节点进行曲线插值,最终获得一条光滑的空间路径,从而解决了上述问题。
本发明的技术方案如下:
一种基于三次样条插值的三维机械臂粒子群路径规划方法,包括:
步骤S1:在三维空间中,对机械臂进行路径规划,得到一条最优路径;
步骤S2:识别三维空间中的障碍物边界;
步骤S3:基于障碍物边界和最优路径,进行三次样条曲线插值,得到一条光滑的路径。
进一步地,所述步骤S1,包括:
使用三维粒子群算法,对机械臂进行路径规划,得到一个点集;
所述点集包括多个路径节点,所述点集构成的曲线即为最优路径。
进一步地,所述步骤S2,包括:
步骤S21:获取三维空间中的障碍物信息;
步骤S22:基于所述障碍物信息,识别障碍物边界。
进一步地,所述障碍物信息,包括:
障碍物位置、障碍物大小和障碍物形状。
进一步地,所述步骤S3,包括:
步骤S31:在障碍物边界外设置一系列虚拟非碰撞节点;
步骤S32:基于虚拟非碰撞节点和点集,进行三次样条曲线插值,得到一条光滑的路径。
进一步地,所述步骤S31,包括:
在障碍物边界基础上,按照机械臂的尺寸向外进行扩展,并采样N个的虚拟节点,作为虚拟非碰撞节点。
进一步地,所述步骤S32,还包括:
对所有虚拟非碰撞节点进行筛选,得到能够用于三次样条曲线插值的虚拟非碰撞节点。
进一步地,所述筛选,包括:
判断当前虚拟非碰撞节点是否在任一障碍物范围内;
若当前虚拟非碰撞节点不在任一障碍物范围内,则当前虚拟非碰撞节点可用于三次样条插值。
进一步地,所述判断,包括:
其中:
表示当前虚拟非碰撞节点的x轴坐标;
表示当前虚拟非碰撞节点的y轴坐标;
表示当前虚拟非碰撞节点的z轴坐标;
表示当前障碍物的x轴坐标;
表示当前障碍物的y轴坐标;
表示当前障碍物的z轴坐标;
表示当前虚拟非碰撞节点到当前障碍物的距离;
大于当前障碍物边界尺寸时,判断该虚拟非碰撞节点可用于三次样条插值。
与现有的技术相比本发明的有益效果是:
1、一种基于三次样条插值的三维机械臂粒子群路径规划方法,可以有效地解决机械臂在复杂环境中的路径规划问题,并且能够保证机械臂与障碍物之间的安全距离,提高路径规划的准确性和可靠性。
2、一种基于三次样条插值的三维机械臂粒子群路径规划方法,通过使用三次样条曲线插值,将三维粒子群算法生成的路径节点与障碍物边界外的虚拟非碰撞节点进行曲线插值,生成光滑的路径轨迹;这种插值方法使得机械臂在运动过程中变化连续而自然,减少了机械臂运动中的抖动和不稳定性,提高了路径的稳定性和精确性。
3、一种基于三次样条插值的三维机械臂粒子群路径规划方法,在路径规划中,通过获取障碍物信息,并在障碍物边界外设置虚拟非碰撞节点,保证机械臂与障碍物无法发生冲突;使得机械臂能够避开障碍物,避免碰撞和损坏,提高了路径的安全性。
4、一种基于三次样条插值的三维机械臂粒子群路径规划方法,相较于某些传统的路径规划方法,该方法在考虑障碍物的情况下,仍能够保持较高的计算效率。
5、一种基于三次样条插值的三维机械臂粒子群路径规划方法,无论是在工业自动化、装配、生产线、物流等领域,还是在其他需要机械臂路径规划的领域值班费,都能够有效地生成安全、光滑且高效的路径。
附图说明
图1为一种基于三次样条插值的三维机械臂粒子群路径规划方法的流程图。
具体实施方式
需要说明的是,术语“第一”和“第二”等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
下面结合实施例对本发明的特征和性能作进一步的详细描述。
实施例一
请参阅图1,一种基于三次样条插值的三维机械臂粒子群路径规划方法,具体包括如下步骤:
步骤S1:在三维空间中,对机械臂进行路径规划,得到一条最优路径;
步骤S2:识别三维空间中的障碍物边界;
步骤S3:基于障碍物边界和最优路径,进行三次样条曲线插值,得到一条光滑的路径;则机械臂沿着生成的路径运动,可以有效避免障碍物。
在本实施例中,具体的,所述步骤S1,包括:
使用三维粒子群算法,对机械臂进行路径规划,得到一个点集;
所述点集包括多个路径节点,所述点集构成的曲线即为最优路径;需要说明的是,三维粒子群算法是一种现有优化算法,即通过优化三维粒子群算法的参数,如粒子的速度和位置等,即可找到一条最优路径,以达到目标位置;因此,关于通过三维粒子群算法,如何获取最优路径是本领域人员能够知晓,在此不再进行赘述。
在本实施例中,具体的,所述步骤S2,包括:
步骤S21:获取三维空间中的障碍物信息;
步骤S22:基于所述障碍物信息,识别障碍物边界。
在本实施例中,具体的,所述障碍物信息,包括:
障碍物位置、障碍物大小和障碍物形状。
在本实施例中,具体的,所述步骤S3,包括:
步骤S31:在障碍物边界外设置一系列虚拟非碰撞节点;
步骤S32:基于虚拟非碰撞节点和点集,进行三次样条曲线插值,得到一条光滑的路径。
在本实施例中,具体的,所述步骤S31,包括:
在障碍物边界基础上,按照机械臂的尺寸向外进行扩展,并采样N个的虚拟节点,作为虚拟非碰撞节点。
在本实施例中,具体的,所述步骤S32,还包括:
对所有虚拟非碰撞节点进行筛选,得到能够用于三次样条曲线插值的虚拟非碰撞节点。
在本实施例中,具体的,所述筛选,包括:
判断当前虚拟非碰撞节点是否在任一障碍物范围内;
若当前虚拟非碰撞节点不在任一障碍物范围内,则当前虚拟非碰撞节点可用于三次样条插值。
在本实施例中,具体的,所述判断,包括:
其中:
表示当前虚拟非碰撞节点的x轴坐标;
表示当前虚拟非碰撞节点的y轴坐标;
表示当前虚拟非碰撞节点的z轴坐标;
表示当前障碍物的x轴坐标;
表示当前障碍物的y轴坐标;
表示当前障碍物的z轴坐标;
表示当前虚拟非碰撞节点到当前障碍物的距离;
大于当前障碍物边界尺寸时,判断该虚拟非碰撞节点可用于三次样条插值。
在本实施例中,进一步给出三次样条插值公式,具体如下:
其中:为样条曲线中任意一点的值,/>为样条曲线的系数,/>为离该点最近的虚拟非碰撞节点的位置,/>和/>一个表示三次样条曲线的函数自变量和因变量。通过上述公式可以得到/>随着/>变化的函数曲线。
实施例二
实施例二是实施例一提出的三维机械臂粒子群路径规划方法在工业自动化装配线和医疗手术机器人两个场景下的具体应用。
场景一:工业自动化装配线
在工业自动化装配线中,机械臂被广泛用于对产品的自动组装、处理和搬运。路径规划是关键的环节,它直接影响到机械臂的运动效率和准确性。基于三次样条插值的三维机械臂粒子群路径规划方法在这样的场景中具有显著的优势。
首先,通过使用三维粒子群算法,机械臂能够在装配线的三维空间中进行全局搜索,找到最优的路径,从而最大程度地减少了运动时间。这对于工业生产线来说非常重要,因为时间的节约能够提高生产效率,降低成本。
其次,该方法考虑了障碍物信息,并在障碍物边界外设置虚拟非碰撞节点。在自动装配过程中,通常会有许多障碍物,如零件、设备、传送带等。通过避开这些障碍物,机械臂可以在自由空间内规划路径,避免碰撞和损坏,保证装配的安全性和稳定性。
最后,该方法在采用三次样条曲线插值,生成光滑的路径轨迹。这对于机械臂的运动非常重要,特别是在高速运动和精确定位的情况下。光滑的路径轨迹可以减少机械臂的抖动和不稳定性,提高装配的精度和质量。
场景二:医疗手术机器人
医疗手术机器人在现代医疗领域扮演着越来越重要的角色,它们能够在微创手术中进行高精度的操作,减少手术风险和创伤。路径规划对于医疗手术机器人尤为关键,而基于三次样条插值的三维机械臂粒子群路径规划方法适用于这样的场景。
首先,由于医疗手术机器人需要在复杂的三维解剖结构中进行操作,路径规划的准确性和安全性至关重要。三维粒子群算法能够帮助机器人在手术区域进行全局搜索,找到最优路径,避免了在手术过程中可能发生的碰撞和冲突。
其次,考虑到手术过程中的解剖结构和器官位置,该方法能够在手术目标和患者解剖结构之间进行规避,确保手术操作不会对患者造成伤害。同时,通过三次样条曲线插值,机器人能够以光滑的方式移动,减少手术创伤,缩短患者的康复时间。
最后,医疗手术通常要求高度精准的操作,而光滑的路径轨迹可以减少机器人在手术过程中的抖动和波动,从而提高手术的精度和成功率。同时,路径规划的高效性能也确保了机器人在手术过程中能够快速响应,满足医生对手术速度和时间的要求。
综上所述,基于三次样条插值的三维机械臂粒子群路径规划方法适用于工业自动化装配线和医疗手术机器人等场景。其能够实现全局搜索、考虑障碍物避让、生成光滑路径轨迹,提高路径规划的效率和精确性,满足不同场景对于路径规划的要求,为工业自动化和医疗领域带来显著的益处。
以上所述实施例仅表达了本申请的具体实施方式,其描述较为具体和详细,但并不能因此而理解为对本申请保护范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本申请技术方案构思的前提下,还可以做出若干变形和改进,这些都属于本申请的保护范围。
提供本背景技术部分是为了大体上呈现本发明的上下文,当前所署名的发明人的工作、在本背景技术部分中所描述的程度上的工作以及本部分描述在申请时尚不构成现有技术的方面,既非明示地也非暗示地被承认是本发明的现有技术。

Claims (3)

1.一种基于三次样条插值的三维机械臂粒子群路径规划方法,其特征在于,包括:
步骤S1:在三维空间中,对机械臂进行路径规划,得到一条最优路径;
步骤S2:识别三维空间中的障碍物边界;
步骤S3:基于障碍物边界和最优路径,进行三次样条曲线插值,得到一条光滑的路径;
所述步骤S1,包括:
使用三维粒子群算法,对机械臂进行路径规划,得到一个点集;
所述点集包括多个路径节点,所述点集构成的曲线即为最优路径;
所述步骤S3,包括:
步骤S31:在障碍物边界外设置一系列虚拟非碰撞节点;
步骤S32:基于虚拟非碰撞节点和点集,进行三次样条曲线插值,得到一条光滑的路径;
所述步骤S31,包括:
在障碍物边界基础上,按照机械臂的尺寸向外进行扩展,并采样N个的虚拟节点,作为虚拟非碰撞节点;
所述步骤S32,还包括:
对所有虚拟非碰撞节点进行筛选,得到能够用于三次样条曲线插值的虚拟非碰撞节点;
所述筛选,包括:
判断当前虚拟非碰撞节点是否在任一障碍物范围内;
若当前虚拟非碰撞节点不在任一障碍物范围内,则当前虚拟非碰撞节点可用于三次样条插值;
所述判断,包括:
其中:
表示当前虚拟非碰撞节点的x轴坐标;
表示当前虚拟非碰撞节点的y轴坐标;
表示当前虚拟非碰撞节点的z轴坐标;
表示当前障碍物的x轴坐标;
表示当前障碍物的y轴坐标;
表示当前障碍物的z轴坐标;
表示当前虚拟非碰撞节点到当前障碍物的距离;
大于当前障碍物边界尺寸时,判断该虚拟非碰撞节点可用于三次样条插值。
2.根据权利要求1所述的一种基于三次样条插值的三维机械臂粒子群路径规划方法,其特征在于,所述步骤S2,包括:
步骤S21:获取三维空间中的障碍物信息;
步骤S22:基于所述障碍物信息,识别障碍物边界。
3.根据权利要求2所述的一种基于三次样条插值的三维机械臂粒子群路径规划方法,其特征在于,所述障碍物信息,包括:
障碍物位置、障碍物大小和障碍物形状。
CN202311819181.6A 2023-12-27 2023-12-27 一种基于三次样条插值的三维机械臂粒子群路径规划方法 Active CN117464693B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202311819181.6A CN117464693B (zh) 2023-12-27 2023-12-27 一种基于三次样条插值的三维机械臂粒子群路径规划方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202311819181.6A CN117464693B (zh) 2023-12-27 2023-12-27 一种基于三次样条插值的三维机械臂粒子群路径规划方法

Publications (2)

Publication Number Publication Date
CN117464693A CN117464693A (zh) 2024-01-30
CN117464693B true CN117464693B (zh) 2024-03-19

Family

ID=89635107

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202311819181.6A Active CN117464693B (zh) 2023-12-27 2023-12-27 一种基于三次样条插值的三维机械臂粒子群路径规划方法

Country Status (1)

Country Link
CN (1) CN117464693B (zh)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3566920B2 (ja) * 1999-10-08 2004-09-15 ダッソー システムズ コンピュータシステム操作方法、コンピュータシステム、cad/cam装置およびデータのセットを探索する方法
CN109227549A (zh) * 2018-11-08 2019-01-18 汕头大学 一种基于切线递推的机器人平滑避障运动规划方法
CN110744543A (zh) * 2019-10-25 2020-02-04 华南理工大学 基于ur3机械臂的改进式prm避障运动规划方法
CN114193457A (zh) * 2022-01-07 2022-03-18 珞石(北京)科技有限公司 一种基于局部搜索算法的机械臂自主避障路径生成方法
CN115079693A (zh) * 2022-06-08 2022-09-20 江苏师范大学 基于改进遗传算法和b样条拟合的无人车路径规划方法
CN116572244A (zh) * 2023-05-30 2023-08-11 贵州大学 基于rrt*fn算法的机械臂避障路径规划方法
CN116852367A (zh) * 2023-07-21 2023-10-10 昆明理工大学 一种基于改进RRTstar的六轴机械臂避障路径规划方法

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115605328A (zh) * 2020-02-19 2023-01-13 发那科株式会社(Jp) 一种用于工业机器人的碰撞避免运动规划方法
US20220063099A1 (en) * 2020-09-03 2022-03-03 Fanuc Corporation Framework of robotic online motion planning
US20220163969A1 (en) * 2020-11-20 2022-05-26 Rapyuta Robotics Co., Ltd. Systems and methods for optimizing route plans in an operating environment
US20220100184A1 (en) * 2021-12-09 2022-03-31 Intel Corporation Learning-based techniques for autonomous agent task allocation
US20230330853A1 (en) * 2022-04-14 2023-10-19 Mitsubishi Electric Research Laboratories, Inc. System and Method for Controlling a Motion of a Robot

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3566920B2 (ja) * 1999-10-08 2004-09-15 ダッソー システムズ コンピュータシステム操作方法、コンピュータシステム、cad/cam装置およびデータのセットを探索する方法
CN109227549A (zh) * 2018-11-08 2019-01-18 汕头大学 一种基于切线递推的机器人平滑避障运动规划方法
CN110744543A (zh) * 2019-10-25 2020-02-04 华南理工大学 基于ur3机械臂的改进式prm避障运动规划方法
CN114193457A (zh) * 2022-01-07 2022-03-18 珞石(北京)科技有限公司 一种基于局部搜索算法的机械臂自主避障路径生成方法
CN115079693A (zh) * 2022-06-08 2022-09-20 江苏师范大学 基于改进遗传算法和b样条拟合的无人车路径规划方法
CN116572244A (zh) * 2023-05-30 2023-08-11 贵州大学 基于rrt*fn算法的机械臂避障路径规划方法
CN116852367A (zh) * 2023-07-21 2023-10-10 昆明理工大学 一种基于改进RRTstar的六轴机械臂避障路径规划方法

Non-Patent Citations (6)

* Cited by examiner, † Cited by third party
Title
Informed RRT* with Adjoining Obstable Process for Robot Path Planning;Huanyu Jiang;《2020 IEEE 20th International Conference on Communication Technology》;20201031;全文 *
基于PSO和三次样条插值的多机器人全局路径规划;强宁、高洁;《系统仿真学报》;20170708;全文 *
基于粒子群算法的机械臂轨迹规划研究;周伟;《中国优秀硕士学位论文全文库 信息科技辑》;20230215;全文 *
水果采摘机器人运动规划研究;曹晓曼;《中国博士学位论文全文数据库 信息科技辑》;20220215;全文 *
考虑能耗的煤矿井下水仓清挖机器人轨迹规划方法;彭海兵;《工矿自动化》;20221015;全文 *
输电线路跨越式巡检机器人越障运动优化;吴毅,吴功平,黄乐;《机械设计与制造》;20230526;全文 *

Also Published As

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

Similar Documents

Publication Publication Date Title
KR101667031B1 (ko) 로봇의 경로 계획 장치 및 그 방법
JP2023513841A (ja) 産業ロボット用の衝突回避モーション計画方法
US11919170B2 (en) Fast method for robot path planning with obstacle avoidance
CN112809682B (zh) 机械臂避障路径规划方法、系统及存储介质
EP4157589A1 (en) A robot path planning method with static and dynamic collision avoidance in an uncertain environment
Ahlin et al. Autonomous leaf picking using deep learning and visual-servoing
KR20120073616A (ko) 로봇의 경로 계획 장치 및 그 방법
CN113858205A (zh) 一种基于改进rrt*的七轴冗余机械臂避障算法
CN110275528B (zh) 针对rrt算法改进的路径优化方法
CN112975938B (zh) 一种基于零空间的机械臂速度层轨迹规划方法
CN117464693B (zh) 一种基于三次样条插值的三维机械臂粒子群路径规划方法
Li et al. Hybrid uncalibrated visual servoing control of harvesting robots with RGB-D cameras
CN114939872B (zh) 基于MIRRT*-Connect算法的智能仓储冗余机械臂动态避障运动规划方法
Dalvand et al. Teleoperation of ABB industrial robots
US20210323154A1 (en) Disassembly based assembly planning
Yang et al. Optimal configuration for mobile robotic grinding of large complex components based on redundant parameters
Dai et al. Manipulator path-planning avoiding obstacle based on screw theory and ant colony algorithm
CN116149311A (zh) 动态运动规划系统
CN114986501A (zh) 一种机械臂路径规划方法、系统及机械臂
CN114740862A (zh) 一种用于自动采血机器人的路径规划方法及系统
Zhao et al. Obstacle Avoidance Strategy of Improved APF Method in C-space
CN113510699A (zh) 一种基于改进蚁群优化算法的机械臂运动轨迹规划方法
CN115946117B (zh) 一种三维空间路径规划方法
TWI829561B (zh) 機械臂動態環境路徑規劃之方法與系統
Wang et al. An efficient constraint method for solving planning problems under end-effector constraints

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