关节空间和工作空间的混合轨迹规划算法研究
- 格式:pdf
- 大小:881.48 KB
- 文档页数:5
机械手臂的运动学逆解与轨迹规划算法研究近年来,随着工业自动化的迅速发展,机械手臂在生产制造等领域扮演着越来越重要的角色。
而机械手臂的运动学逆解与轨迹规划算法研究则是实现机械手臂自动控制的基础。
本文将对这一领域的研究进行探讨,分析其意义和挑战,以及目前的研究成果。
第一部分:运动学逆解机械手臂的运动学逆解是指在给定的目标位置和姿态时,求解机械手臂的关节角度。
这一问题在机械手臂的运动控制中至关重要。
传统的运动学逆解方法包括解析法和数值法。
解析法是一种基于数学模型的精确解法。
通过建立机械手臂的几何模型和运动方程,可以通过一系列的数学运算得到逆解。
然而,由于机械手臂的结构和约束条件复杂多样,解析法往往无法得到解析解,使得这种方法适用性有限。
数值法则是通过迭代计算的方式求解运动学逆解。
典型的数值法包括牛顿-拉夫逊法和雅可比逆法。
这些方法通过不断迭代,逼近目标位置和姿态,直至达到精确解。
数值法具有较广泛的适用性和可靠性,但计算量大,收敛速度较慢。
第二部分:轨迹规划在机械手臂执行任务时,需要按照既定的路径运动。
轨迹规划是指在给定的起始点和终止点之间,找到一条连续且平滑的路径。
这条路径需要考虑机械手臂的结构、约束条件以及运动速度、加速度等因素。
常见的轨迹规划算法包括直线插补、圆弧插补和样条插补等。
直线插补是最简单的一种方法,直接连接起始点和终止点,但在复杂任务中效果有限。
圆弧插补则通过构建多个圆弧段来实现平滑路径,但只适用于特定情况。
样条插补是一种更加通用的轨迹规划方法。
它通过建立机械手臂的位置和速度函数,并通过控制点来拟合曲线,实现路径规划。
样条插补具有较好的平滑性和连续性,适用于各种复杂任务。
第三部分:研究进展与挑战在机械手臂的运动学逆解与轨迹规划算法研究领域,近年来取得了许多重要进展。
越来越多的研究者致力于提出新的算法和方法,以提高运动学逆解的精准度和轨迹规划的效果。
同时,这一领域也面临着许多挑战。
首先,机械手臂的结构和约束条件多样化,需要针对不同的情况进行逆解和轨迹规划。
机械臂轨迹规划问题的遗传算法优化研究引言机械臂是一种能够模拟人手运动功能的装置,广泛应用于制造业、医疗领域、航天工程等方面。
机械臂的轨迹规划是一个关键的问题,在保证机械臂工作空间约束条件下,寻找一条最优的轨迹,能够提高机械臂的运动效率和精度。
然而,传统的轨迹规划方法往往存在时间复杂度高、计算量大以及无法充分考虑系统约束等问题。
因此,研究一种高效的机械臂轨迹规划方法具有重要意义。
遗传算法在解决复杂优化问题方面具有优势,其借鉴了生物进化的原理,通过模拟自然选择过程寻找最优解。
遗传算法优化机械臂轨迹规划问题已经成为研究的热点之一。
本文将重点探讨机械臂轨迹规划问题的遗传算法优化方法及其应用。
遗传算法原理与机械臂轨迹规划遗传算法是一种通过模拟生物进化过程进行优化的算法。
它的核心思想是根据适应度函数对候选解进行评估和选择,并通过交叉和变异等操作生成新的候选解。
在机械臂轨迹规划问题中,遗传算法可以通过对机械臂的关节角度或者末端位姿等参数进行优化,从而找到最优的轨迹。
在使用遗传算法进行机械臂轨迹规划时,首先需要定义适应度函数。
适应度函数可以根据具体的需求和问题进行设计,常用的包括机械臂的路径长度、速度、加速度等指标,以及碰撞检测等约束条件。
然后,通过生成初始的候选解种群,并利用适应度函数对种群中的个体进行评估和选择。
接下来,通过交叉和变异操作生成新的个体,并再次进行评估和选择。
迭代若干代之后,遗传算法可以逐渐趋于最优解。
遗传算法优化研究的关键问题机械臂轨迹规划问题的遗传算法优化研究中存在一些关键问题需要解决。
首先是个体编码的选择。
机械臂的关节角度和末端位姿等参数范围大且连续,因此需要选择适合的编码方式。
常用的编码方式包括二进制编码、浮点数编码等。
不同的编码方式对遗传算法的性能和搜索效率有重要影响。
其次是选择合适的遗传算子。
交叉和变异是遗传算法中最为关键的操作,对于机械臂轨迹规划问题的优化具有重要影响。
合适的交叉和变异操作可以有效地维持种群的多样性和避免陷入局部最优解。
第三章机器人轨迹规划在当今科技飞速发展的时代,机器人已经成为了我们生活和工作中不可或缺的一部分。
从工业生产中的自动化装配线,到医疗领域的精准手术机器人,再到家庭服务中的智能清洁机器人,它们的身影无处不在。
而机器人能够如此高效、精准地完成各种任务,其中一个关键的技术就是轨迹规划。
那么,什么是机器人轨迹规划呢?简单来说,轨迹规划就是为机器人确定一条从起始点到目标点的最优路径,同时要满足一系列的约束条件,比如速度、加速度、运动平稳性、避障等等。
这就好比我们在出门旅行前要规划好路线,既要考虑距离最短,又要考虑交通状况、沿途的风景等因素。
机器人轨迹规划可以分为关节空间轨迹规划和笛卡尔空间轨迹规划两种。
关节空间轨迹规划是直接对机器人的关节角度进行规划,它的优点是计算简单,容易实现实时控制。
比如说,一个六自由度的机械臂,我们可以通过规划每个关节的角度变化,来让机械臂完成特定的动作。
笛卡尔空间轨迹规划则是在直角坐标系中对机器人的末端执行器的位置、姿态进行规划。
这种规划方式更直观,更容易理解和描述任务要求。
比如,让机器人的末端执行器沿着一条直线移动,或者绕着一个点旋转。
在进行轨迹规划时,首先要明确任务需求。
这包括机器人的起始位置和姿态、目标位置和姿态,以及中间可能需要经过的路径点。
然后,根据这些信息,选择合适的规划方法和算法。
常见的轨迹规划算法有多项式插值法、样条曲线法、直线和圆弧插补法等。
多项式插值法可以通过给定的起始点和终止点的位置、速度、加速度等条件,构造出一个多项式函数来描述机器人的运动轨迹。
样条曲线法则具有更好的平滑性和灵活性,可以更好地适应复杂的轨迹要求。
直线和圆弧插补法适用于简单的直线和圆弧轨迹。
除了选择合适的算法,还需要考虑机器人的运动学和动力学约束。
运动学约束主要包括关节角度的限制、速度和加速度的限制等。
动力学约束则涉及到机器人的驱动力矩、惯性力等因素。
如果不考虑这些约束,可能会导致机器人运动不稳定,甚至出现故障。
机械臂轨迹规划及避障算法研究近年来,机械臂技术得到了长足的发展和应用。
机械臂的运动轨迹规划和避障算法是实现其灵活性和自主性的关键。
本文将探讨机械臂轨迹规划及避障算法的研究进展。
一、机械臂轨迹规划的重要性机械臂的轨迹规划是为了使机械臂能够按照既定的路径进行精确的运动。
这对许多领域的应用都非常关键,比如工业制造、医疗手术等。
良好的轨迹规划可以提高机械臂的工作效率和精度,减少能源消耗和损耗,提高生产速度和质量。
目前,机械臂轨迹规划主要有两种方法:基于几何和基于搜索。
二、基于几何的机械臂轨迹规划算法基于几何的机械臂轨迹规划算法是根据机械臂的几何结构和关节运动空间进行规划的。
常用的算法有反向运动学和运动插值等。
反向运动学是一种常用的机械臂轨迹规划算法,通过将目标位置和姿态转换为各个关节的角度,实现机械臂的精确定位。
运动插值则是通过定义一系列路径点,然后插值计算机械臂在这些点之间的运动轨迹,达到平滑移动的效果。
然而,基于几何的机械臂轨迹规划算法在面对复杂环境时存在困难,比如存在多个障碍物或者局部特殊约束。
因此,基于搜索的机械臂轨迹规划算法也逐渐引起了人们的注意。
三、基于搜索的机械臂轨迹规划算法基于搜索的机械臂轨迹规划算法常用的有遗传算法、粒子群算法和蚁群算法等。
这些算法通过搜索问题的解空间来寻找最优的运动轨迹。
遗传算法是一种模拟生物进化的方法,通过对候选解进行评估和选择交叉、变异等操作,不断进化出更好的解。
粒子群算法则是模拟鸟群寻找食物的行为,通过个体之间的合作和信息共享来寻找最优解。
蚁群算法则是模拟蚂蚁找食物的行为,通过信息素的释放和感知来寻找路径。
这些基于搜索的机械臂轨迹规划算法可以在复杂环境中较好地解决运动规划问题,但是计算复杂度较高,需要更多的计算资源和时间。
四、机械臂避障算法研究机械臂避障算法主要是解决机械臂在运动过程中如何避开障碍物、规避碰撞的问题。
常用的机械臂避障算法有基于传感器的方法和基于视觉的方法。
基于遗传算法的机械手臂轨迹规划引言机械手臂是现代工业自动化的重要组成部分,广泛应用于各个领域,如汽车制造、电子设备装配等。
而机械手臂的轨迹规划是实现精确操作的关键。
本文将介绍基于遗传算法的机械手臂轨迹规划,并深入探讨其原理、优势和应用。
一、机械手臂轨迹规划的挑战机械手臂轨迹规划的挑战来自于多个方面。
首先,机械手臂是高度非线性的系统,其运动涉及多个关节的协同工作,因此必须考虑各个关节之间的相互制约关系。
其次,机械手臂的操作空间是多维的,遍布整个工作区域,因此需要找到最优轨迹来实现所需的操作任务。
此外,其他因素如避障和快速响应也需要在规划过程中综合考虑。
传统的机械手臂轨迹规划方法通常采用启发式算法,如A*算法和RRT算法。
然而,这些算法在处理高度非线性的问题上存在一定的局限性。
而基于遗传算法的机械手臂轨迹规划则能够克服这些局限性,具有许多优势。
二、基于遗传算法的机械手臂轨迹规划原理遗传算法是一种模拟生物进化过程的优化算法,能够在大规模的解空间中进行全局优化。
其主要原理包括选择、交叉和变异。
在机械手臂轨迹规划中,首先需要将问题抽象成一个适应度函数。
该函数度量了机械手臂轨迹的质量,例如轨迹的长度、速度和避障能力等。
然后,通过随机生成一组个体(即轨迹解),并计算每个个体的适应度值。
根据适应度值,通过选择操作来确定父代个体。
选择操作的基本思想是优先选择适应度高的个体。
接下来,通过交叉操作将父代的染色体(轨迹解)进行组合,产生新的后代个体。
最后,通过变异操作对后代个体的染色体进行微调,增加解的多样性。
通过不断迭代以上步骤,直到达到预设的停止条件为止。
迭代过程中,较优的个体会向下一代传递,从而逐步优化整个轨迹解的质量。
三、基于遗传算法的机械手臂轨迹规划优势相对于传统的方法,基于遗传算法的机械手臂轨迹规划具有以下优势。
1. 全局优化:传统方法易陷入局部最优解,而遗传算法能够在大规模解空间中进行全局优化,找到更优的解。
机械臂控制和路径规划算法机械臂是一种能够模拟人类手臂运动的机械装置,广泛应用于工业自动化、医疗手术等领域。
机械臂控制和路径规划算法是机械臂运动的核心技术,它们决定了机械臂的运动精度和效率。
本文将介绍机械臂控制和路径规划算法的基本原理和常见算法。
一、机械臂控制机械臂控制技术是指通过给定的输入信号控制机械臂的运动。
机械臂控制通常可以分为两个层次:关节空间控制和任务空间控制。
1. 关节空间控制关节空间控制是指在关节空间内对机械臂的每个关节进行控制。
在这种控制模式下,控制器通过计算每个关节的轨迹和速度来实现机械臂的运动。
关节空间控制常用的方法有PID控制、逆运动学控制等。
PID控制是一种常见的闭环控制方法,它通过比较实际输出与期望输出之间的差异来调整控制信号,使得系统能够快速、稳定地达到期望状态。
在机械臂的关节空间控制中,可以通过设置合适的PID参数来实现关节角度的精确控制。
逆运动学控制是一种基于机械臂几何模型和力学性质的控制方法。
通过逆向求解机械臂各关节的角度,可以使机械臂末端执行器(如夹爪)达到指定的位置和姿态。
逆运动学控制适用于需求较高的精确运动任务,如装配、焊接等。
2. 任务空间控制任务空间控制是指在笛卡尔空间内对机械臂末端执行器(如夹爪)进行控制。
在这种控制模式下,控制器通过计算末端执行器的位置和姿态来实现机械臂的运动。
任务空间控制常用的方法有运动学控制、动力学控制等。
运动学控制是通过建立机械臂的正运动学和逆运动学方程来计算末端执行器的位置和姿态。
在机械臂运动过程中,通过调整关节角度实现末端执行器的精确控制。
运动学控制适用于机械臂做精确路径规划和轨迹控制的应用场景。
动力学控制是在运动学控制的基础上考虑机械臂的动力学特性,通过求解机械臂的运动学和动力学方程来实现对末端执行器的控制。
动力学控制适用于对机械臂的力和力矩有较高要求的任务,如抓取和搬运重物等。
二、路径规划算法路径规划算法是指确定机械臂从起始位置移动到目标位置的轨迹或路径。
六自由度机械臂轨迹规划及优化研究一、本文概述理论基础与问题阐述:本文将系统梳理六自由度机械臂的数学模型,包括其笛卡尔坐标系下的运动学逆解与正解、动力学建模,以及关节空间与操作空间之间的转换关系。
在此基础上,明确阐述轨迹规划与优化所面临的关键问题,如奇异位形规避、关节速度与加速度限制、路径平滑性要求、动态负载变化等因素对规划算法设计的影响。
轨迹规划方法:针对上述问题,我们将探讨和比较多种有效的轨迹规划策略。
这包括基于插值的连续路径生成方法(如样条曲线、Bzier曲线),基于优化的全局路径规划算法(如RRT、PRM等),以及考虑机械臂动力学特性的模型预测控制(MPC)方法。
对于每种方法,将详细分析其原理、优势、适用场景及可能存在的局限性,并通过实例演示其在典型任务中的应用效果。
轨迹优化技术:在基本轨迹规划的基础上,本文将进一步探究如何运用先进的优化算法对初始规划结果进行精细化调整,以达到性能最优。
这包括使用二次规划、非线性优化、遗传算法等手段对轨迹的关节角序列、时间参数化、能量消耗等指标进行优化。
还将讨论如何引入避障约束、柔顺控制策略以及自适应调整机制,以增强机械臂在复杂环境和不确定条件下的适应性和鲁棒性。
实验验证与性能评估:本文将通过仿真研究与实际硬件平台上的试验,对所提出的轨迹规划与优化方案进行详细的验证与性能评估。
实验设计将涵盖多种典型应用场景,考察规划算法的计算效率、轨迹跟踪精度、能耗表现以及对意外扰动的响应能力。
实验结果将以定量数据与可视化方式呈现,以便于对比分析和理论验证。
本文致力于构建一套全面且实用的六自由度机械臂轨迹规划与优化框架,为相关领域的研究者和工程技术人员提供理论指导与实践参考,推动六自由度机械臂技术在实际应用中的效能提升与技术创新。
二、六自由度机械臂系统建模在六自由度机械臂的研究与应用中,系统建模是一个关键环节。
本节将重点讨论六自由度机械臂的数学建模,包括其运动学模型和动力学模型。
工业机器人运动轨迹规划与控制技术研究引言工业机器人在现代制造业中扮演着重要的角色,它们的运动轨迹规划与控制技术对提高生产效率和质量至关重要。
本文将探讨工业机器人运动轨迹规划与控制技术的研究进展,并分析其在工业应用中的实际效果。
一、工业机器人运动轨迹规划技术研究1. 轨迹规划原理工业机器人的轨迹规划是指在给定的操作空间中,由机器人自主地生成一系列运动轨迹,以实现所需的任务。
常用的轨迹规划方法包括几何路径规划、时间优化规划和运动学规划等。
几何路径规划方法基于所需任务的几何要求,通过建立机器人与环境的几何模型,计算机图形学算法来生成运动轨迹。
例如,根据目标位置和姿态,利用直线插补和圆弧插补等方法生成机器人末端执行器的运动轨迹。
时间优化规划方法考虑机器人运动的时间效率,以最短的时间完成任务为目标。
它包括速度优化、加速度优化、时间分段等技术。
通过优化运动参数,可以实现机器人的高速稳定运动。
运动学规划方法是根据工业机器人的运动学模型,通过解析或数值计算的方法,计算出机器人各关节的运动轨迹。
该方法适用于六轴以上的工业机器人,可以精确控制机器人的运动姿态。
2. 轨迹规划算法目前,常用的轨迹规划算法包括直线插补、圆弧插补、样条插补和基于优化的算法等。
直线插补算法是最简单和最常见的轨迹规划算法之一。
它通过定义机器人末端执行器的起始点和目标点,根据直线方程来计算机器人的运动轨迹。
直线插补算法简单易实现,且运动轨迹直线性好,适用于直线工件的加工。
圆弧插补算法利用圆弧方程来计算机器人的运动轨迹。
它可以实现圆弧轨迹的精确控制,适用于弯曲工件的加工。
样条插补算法是一种平滑插补算法,通过曲线拟合和优化算法,生成平滑连续的运动轨迹。
它适用于复杂工件的加工,可以实现高精度和高速度的运动控制。
基于优化的算法通过建立目标函数和约束条件的数学模型,利用数学优化算法来求解最优轨迹规划问题。
该方法可以综合考虑多种因素,如工件形状、工件加工时间、机器人运动约束等,实现运动轨迹的最优化控制。
关节空问和工作空问的混合轨迹规划算法研究 Mixed joint space and work space trajectory planning algorithm 宁学涛’ ,黄伟’。。,郑天江’,杨亚威 NING Xue.tao‘。。_,HUANG Wei。一,ZHENG Tian-jiang。,YANG Ya.wei。 (1_中国科学院宁波材料技术与工程研究所,宁波31 52Ol;2.中北大学,太原030000) 摘要:为了实现机器人的高速、高精度控制,必须对机器人进行合理的轨迹规划,同时,轨迹规划也 是实现驱动电机力矩和功率得到充分利用的核心内容。将编写Python语言的轨迹规划程序, 并使用关节空间和工作空间的五次样条函数混合轨迹规划法对Delta两自由度机器人进行轨迹规 划,再利用动力学对轨迹规划结果进行相应的优化。生成的拟合曲线表明,机器人的混合轨迹 规划法充分利用了关节空间和工作空间轨迹规戈0法的优点,并且动力学优化后的结果,对提高 驱动电机的使用效率具有很好的指导性意义,最后通过实验验证了结果的正确性。 关键词:机器人;运动学;动力学;混合空间;轨迹规划 中囝分类号:TP242 文献标识码:A 文章编号:1 009-01 34(201 5)07(下)-0020-05 Doi:1 0.3969/J.issn.1 009-01 34.201 5.07(下).06 .
0引言 轨迹规划对于提高机器人的使用效率,减小工作过 程中的振动具有重要意义。合理的轨迹规划能够使驱动 电机力矩和功率得到的充分的利用,并从软件控制上提 高机器人的整体性能。 华南理工大学的陈伟华等人n】,对机器人的连续路 径进行了工作空间内的轨迹规划,在路径的拐角处采用 关节空间轨迹规划进行过渡,但是,并没有进行相应的 动力学优化。同济大学的李万莉等人【2】,江南大学的凌 家良等人 ,进行了纯关节空间内的轨迹规划,也没有 进行相应的动力学优化。 对于每个运行阶段,机器人都有不同的运动学和动 力学要求,例如,对于本文中所述的Delta两自由度高速 并联工业机器人,在竖直方向物体抓取和释放阶段,要 求机器人末端执行器应尽量减小水平方向的抖动,同时 应尽量减小关节空间所需驱动力矩和功率,并且减小水 平方向的抖动应作为这一阶段的主要矛盾加以解决,即 拥有良好的工作空间性能;在水平转运阶段和中问过渡 阶段,要求减小关节空间驱动力矩和功率,同时应尽量 减小关节空间的输入角速度,即拥有良好的关节空间性 能。由于纯工作空间和纯关节空间轨迹规划得到的拟合 曲线一般具有良好的工作空间或关节空间性能,为了从 理论上提高机器人的性能,本文将对机器人的竖直物体抓 取和释放阶段采用工作空间五次样条函数轨迹规划方法, 对水平转运阶段和中间过渡阶段采用关节空间五次样条 函数轨迹规划方法,最后通过实验验证方法的合理性。 1工作空间关键点的选取 综合,工作空间和关节空间轨迹规划中工作空间 关键点的需求,在工作空间选取了9个工作空间关键 点,如图1所示,其中曲线01、78段为工作空间轨迹规 划段,该阶段是前面所述的物体抓取和释放曲线段,应 具有良好的工作空间性能,即应尽量减小水平方向的抖 动。其余曲线段为关节空间轨迹规划阶段,该阶段要求 机器人具有良好的关节空间驱动力矩和功率,由于该阶 段的关键点对称布置,得到的工作空间拟合曲线没有较 大的抖动。 7 8 1 O 图1工作空间关键点的选取 关键点2、6为工作空间拐弯半径控制点,对该两 点的位置进行调节不仅可以改变拐弯半径,还可以调节 23、34、45、56曲线段竖直方向的抖动;关键点1、7为 工作空间轨迹规划和关节空间轨迹规划的衔接点,在该 两点处应该选择合理的工作空间速度和加速度数值,以 求得到较好的工作空间和关节空间拟合曲线。 现只对其中一个关键点数值选取进行陈述,另一 关键点数值选取与该关键点类似。当速度选择不合理 时,该关键点(时间为0.2s,蓝色曲线和红色曲线衔接
收稿日期:2015-04—05 基盒项目:宁波市国际合作项目 (2014D10008);数控一代机械产品创新应用示范工程(201413AZ04784); 精密驱动控制技术创新团队(2012B82005):宁波市自然科学基金(2014A610084) 作者简介:宁学涛(1989一),男,河北唐山人,硕士研究生,研究方向为高速并联工业机器人。
【20】 第37卷第7期2015—07(下) 处)成为速度拟合曲线的尖点(即从曲线上明显突出的 点),并且该关键点附近的加速度急剧变化、数值较 大,如图2、图3所示,分别为关键点处速度选择较小、 较大时的关节空间左驱动电机拟合曲线。
薏 耋 g
喜 兰
菩 e 圭
害一 一 呈一
暑一
{ 吉
{ 呈
图2关键点处速度较小
图3关键点处速度较大 当加速度选择不合理时,该关键点成为速度曲线的 曲率变化关键点,并且该关键点的加速度出现尖点,如 图4、图5所示,分别为关键点处加速度选择较小、较大 时的关节空间左驱动电机拟合曲线。
I /、 八 。 l: 、 √
7 V V V
. 图4关键点处加速度较小 当关键点处的速度、加速度选择不合理时,还会
图5关键点处加速度较大 出现工作空间位移拟合曲线过冲,速度拟合曲线抖动较 大,加速度拟合曲线峰值较大,所需驱动电机力矩峰值 和功率峰值急剧增加的现象,这里不再赘述。
2混合轨迹规划五次样条函数模型 混合轨迹规划五次样条函数模型是工作空间轨迹 规划和关节空间轨迹规划相结合的数学模型,工作空间 轨迹规划曲线段01、78段使用工作空间轨迹规划数学模 型,工作空间的五次样条函数轨迹规划数学模型如式(1) 所示。 g(f)=g0+口lO—t0)+a2O—to) ,1、 + (,~to) + ( —to) +a5(t—to) J
边界条件如式(2)所示: q(to) qo q(t1)=ql q(to)=Vo 口 )=V1 (2) (f0)=口。 ( )=
通过计算得到五次样条函数系数如式(3)所示:
nl Vo 1. 2 (3)
旁[20h一(8Vl Vo) 一(3ao-aI) 】 1 ●
口4: 1[一30 +(14v ̄+16vo)T+(3口0—2n1) ]
= 1[12h~6(vz+vo)T+( 一 ) 】
其余关节空间轨迹规划曲线段使用关节空间轨迹规 划数学模型,关节空间五次样条函数数学模型如式(4)所 示,其t:0f(x), ( ), ( ), &),/&),分别表示关节 空间内角位移、速度、加速度、加加速度以及加加速度 的一阶导数,x表示每段拟合曲线首尾的时间差。
第37卷第7期2015-07(下) 【21】 /( )=ao+alx+a2 +a3x +a4x +a5x ( )=al+2a2x+3a3X +4a4 +5a5X ,( ) 2a2 6a3 +12a4 20a5 )
,( )=6a3+24a4 十60a5X (4) ,( )=24a4+120as
为了使每段关节空间内关节角位移、速度、加速 度、加加速度拟合曲线连接处连续可导,需要建立合理 的边界条件。Delta两自由度高速并联工业机器人有两个 关节输入量,现只对关节角1的边界条件进行阐述,关 节角2的边界条件与关节角1相同,不同之处在于工作空 间内7个关键点经过运动学逆解得到的关节空间内的7关 键点的数值不同。根据已经给定的关节角1的已知量和 每段拟合曲线的边界条件建立如下方程式。 拟合曲线l独有方程式: (^)=pl A(t2)=P2 (‘): (5)
)=a 拟合曲线1、2共有方程式:
(f。)= ( ) (‘)= (^) 褊: (6) (f。)= ( )
(‘)= ( ) 拟合曲线2独有方程式: (f2)= )=P, (7、
拟合曲线n独有方程式: ( 一。)=p ( )= ( )= (} )=口 (8)
将得到关节空间内从关键点1到关键点7的7个点的 含有36个未知量的36个关于时间的线性方程,对其进行 整理得到矩阵:B=KA。 ● 其中:
l l Kl K2 K3 K4 Ks
1 2Kt 3K2 4 5K4 —1 2 6K1 12 20K3 6 24Kl 60 24 l20K。
【22】 第37卷第7期2015—07(下)
是36×36的时间矩阵; B是36×l的由已知量组成的矩阵; A为待求的方程组的系数; 系数矩阵A=K。。B,通过计算得到了关节角1的拟合 曲线的系数矩阵A,即得到了关节角1从关键点1N关键 点7的拟合曲线,同理可得到关节角1从关键点7N关键 点1的拟合曲线,关节角2的拟合方法与关节角1类似, 不再赘述。
3动力学轨迹规划优化模型 混合轨迹规划的动力学优化模型,结合了工作空间 轨迹规划的动力学优化模型和关节空间轨迹规划的动力 学优化模型,在工作空间轨迹规划01、78曲线段使用工 作空间动力学轨迹优化数学模型进行动力学优化;其余 关节空间轨迹规划曲线段使用关节空间的动力学轨迹优 化数学模型进行动力学优化。 Delta机器人混合空间轨迹规划流程如图6所示,其 中判断1为选取的工作空间关键点处速度、加速度是否
是否符台 \\要求/
竖直抓取 曲线段
工
在工作空间内 进行曲线拟台
工作空间 或关节空间 动力学优化
是 是否符合 \要求/
竺 图6混合轨迹规划流程图
量一 一一