机器人技术第七章机器人的轨迹规划.pptx
合集下载
第7章 机器人轨迹规划(2)
Robot planning
8.2机器人轨迹的插值计算
(1)三次多项式插值 例1:要求一个六轴机器人的第一个关节在5秒内从初 始角30º运动到终端角75º,同三次多项式计算在第 1,2,3秒和第4秒时关节的速度。
Robot planning
8.2机器人轨迹的插值计算 (1)三次多项式插值 例2:假设例1中的机械手臂在前面运动的基 础上继续运动,要求在其后的3秒内关节角 到达105º ,画出该运动的位置、速度和加 速度曲线。
(t ) c 2
(t 0) i c 0 (t 0) 0 c1 (t ) c 2
c 0 i c1 0 c 2
1 2 (t ) i c2 t 2
(t ) c2 t (t ) c 2
Robot planning
7.2 关节轨迹的插值 • 关节空间法计算简单、容易。再者,不会 发生机构的奇异性问题。 • 轨迹规划方法一般是在机器人的初始位置 和目标位置之间用多项式函数来“内插” 或“逼近”给定的路径,并产生一系列的 控制点。
Robot planning
7.2.1 三次多项式插值
Robot planning
8.2机器人轨迹的插值计算
(4)用抛物线过渡的线性插值
过渡时间
i f t f tb
终点的抛物线段与起点的抛物线段是对称的,只是其加速度为 负。因此可表示为
(t ) f (t f t ) 2 2t b (t ) (t f t ) tb (t ) tb
Robot planning
8.2机器人轨迹的插值计算 (4)用抛物线过渡的线性插值
第七章_机器人的轨迹规划、生成与控制技术
人工智能系统
逻辑判断装置 学习装置
2
机械工程与汽车学院
耐 心 与 自 学 的 热 情 是 成 功 的 关 键
• 机器人的轨迹规划与生成
• 机器人控制综述 • 机器人控制系统的一般构成
• 机器人传感器
3
机械工程与汽车学院
耐 心 与 自 学 的 热 情 是 成 功 的 关 键
4.1 机器人的轨迹规划 与生成
机械工程与汽车学院
耐 心 与 自 学 的 热 情 是 成 功 的 关 键
1
工业机器人系统 组成
耐 心 与 自 学 的 热 情 是 成 功 的 关 键
机械工程与汽车学院
手部 臂部
执行系统
腕部 机身
工 业 机 器 人
行走机构
驱动系统
各种电、液、气装置 运动控制装置
控制系统
位置检测装置 示教再现装置 触觉、听觉、嗅觉、视觉装置 语音识别装置
(t ) f f
24
机械工程与汽车学院
耐 心 与 自 学 的 热 情 是 成 功 的 关 键
• 第一种情况:确定三次多项式系数的方法 与前所述一致,根据约束条件有下列方程 组, • 第一段: 解得:
0 a0 2 3 a a t a t a t h 0 1 h 2 h 3 h 0 a1 0 a 2a t 3a t 2 1 2 h 3 h
7
机械工程与汽车学院
耐 心 与 自 学 的 热 情 是 成 功 的 关 键
上述例子可以看出,机器人的规划是分层次的, 从高层的任务规划,动作规划到手部轨迹规划和关节 轨迹规划,最后才是底层的控制(见图)。在上述例子 中,我们没有讨论力的问题,实际上,对有些机器人 来说,力的大小也是要控制的,这时,除了手部或关 节的轨迹规划,还要进行手部和关节输出力的规划。 智能化程度越高,规划的层次越多,操作就越简 单。 对工业机器人来说,高层的任务规划和动作规划 一般是依赖人来完成的。而且一般的工业机器人也不 具备力的反馈,所以,工业机器人通常只具有轨迹规 划的和底层的控制功能。
机器人技术机器人的轨迹规划PPT课件
第七章 机器人的轨迹规划
7.1 机器人规划的定义和作用
7.1.1 概述
机器人学中的一个基本问题是为解决某个预定的任务而规划 机器人的动作,然后在机器人执行完成那些动作所需的命令时 控制它。这里,规划的意思就是机器人在行动前确定一系列动 作(作决策),这种动作的确定可用问题求解系统来解决,给定 初始情况后,该系统可达到某一规定的目标。因此,规划就是 指机器人为达到目标而需要的行动过程的描述。
由初始点运动到终止
路径约束
点,所经过的由中间
形态序列构成的空间 路径设定
曲线称为路径。这些
轨迹规划器
形态序列即是曲线上
的“点”。
.
动力学约束
6
规划操作机的轨迹有两种常用的方法:
➢ 第一种方法:要求使用者在沿轨迹选定的位置点上(称为结 节或插值点)显式地给定广义坐标位置、速度和加速度的一组 约束(例如,连续性和光滑程度等)。然后,轨迹规划器从插值 和满足插值点约束的函数中选定参数化轨迹。显然,在这种 方法中,约束的给定和操作机轨迹规划是在关节坐标系中进 行的。
任务规划有三个阶段:建立模型、任务说明和操作机程序综
合。任务的世界模型应含有如下的信息:(1)任务环境中的所有
物体和机器人的几何描述;(2)所有物体的物理描述;(3)所有
连接件的运动学描述,(4) 机器人和传感器特性的描述。在世
界模型中,任务状态模型还必包括全部物体和连接件的布局。
.
5
7.2 机器人轨迹规划的一般性问题
其前二阶时间导数,以便描述操作机的预定运动。在笛卡尔空
间规划中,要规划操作机手部位置、速度和加速度的时间函数,
而相应的关节位置、速度和加速度可根据手部信息导出。
.
7.1 机器人规划的定义和作用
7.1.1 概述
机器人学中的一个基本问题是为解决某个预定的任务而规划 机器人的动作,然后在机器人执行完成那些动作所需的命令时 控制它。这里,规划的意思就是机器人在行动前确定一系列动 作(作决策),这种动作的确定可用问题求解系统来解决,给定 初始情况后,该系统可达到某一规定的目标。因此,规划就是 指机器人为达到目标而需要的行动过程的描述。
由初始点运动到终止
路径约束
点,所经过的由中间
形态序列构成的空间 路径设定
曲线称为路径。这些
轨迹规划器
形态序列即是曲线上
的“点”。
.
动力学约束
6
规划操作机的轨迹有两种常用的方法:
➢ 第一种方法:要求使用者在沿轨迹选定的位置点上(称为结 节或插值点)显式地给定广义坐标位置、速度和加速度的一组 约束(例如,连续性和光滑程度等)。然后,轨迹规划器从插值 和满足插值点约束的函数中选定参数化轨迹。显然,在这种 方法中,约束的给定和操作机轨迹规划是在关节坐标系中进 行的。
任务规划有三个阶段:建立模型、任务说明和操作机程序综
合。任务的世界模型应含有如下的信息:(1)任务环境中的所有
物体和机器人的几何描述;(2)所有物体的物理描述;(3)所有
连接件的运动学描述,(4) 机器人和传感器特性的描述。在世
界模型中,任务状态模型还必包括全部物体和连接件的布局。
.
5
7.2 机器人轨迹规划的一般性问题
其前二阶时间导数,以便描述操作机的预定运动。在笛卡尔空
间规划中,要规划操作机手部位置、速度和加速度的时间函数,
而相应的关节位置、速度和加速度可根据手部信息导出。
.
第七章机器人规划-PPT
CLEAR(C) ON(C,A) ONTABLE(A) ONTABLE(B) HANDEMPTY
目标状态:ON(B,C)∧ON(A,B)
Robot 用F规则求解规划序列 (1)先决条件 (2)删除表 (3)添加表
例 move(x,y,z) 先决条件 CLEAR(x),CLEAR(z),ON(x,y) 删除表 ON(x,y),CLEAR(z) 添加表 ON(x,z),CLEAR(y)
作用: 缺乏规划可能导致不是最佳得问题求解。
规划可用来监控求解过程。如发射火箭。
Robot planning
7、1 机器人规划得作用和任务
1、规划得作用与问题分解途径 (2)问题分解得途径:
途径一:只考虑状态中可能变化了得那些部分。 途径二:把单一得问题分割成为几个子问题。
Robot planning
◆建立模型。 对物体和机器人得几何,运动,物理描述。
◆任务说明。 说明各物体所期望得空间关系。
◆程序综合。
Robot planning
7、5 基于专家系统得机器人规划
2、ROPES机器人规划系统。 Robot Planning Expert Systems (1)系统简化框图。
Robot planning
Robot planning
7、3 STRIPS规划系统
2、STRIPS系统规划过程 例7、1,要求机器人到邻室去取回一个箱子。
Robot planning
7、3 STRIPS规划系统
提供两个操作符: gothru(d,r1,r2) pushthru(b,d,r1,r2)
这个问题得差别表:
Robot planning
Robot planning
7、5 基于专家系统得机器人规划
目标状态:ON(B,C)∧ON(A,B)
Robot 用F规则求解规划序列 (1)先决条件 (2)删除表 (3)添加表
例 move(x,y,z) 先决条件 CLEAR(x),CLEAR(z),ON(x,y) 删除表 ON(x,y),CLEAR(z) 添加表 ON(x,z),CLEAR(y)
作用: 缺乏规划可能导致不是最佳得问题求解。
规划可用来监控求解过程。如发射火箭。
Robot planning
7、1 机器人规划得作用和任务
1、规划得作用与问题分解途径 (2)问题分解得途径:
途径一:只考虑状态中可能变化了得那些部分。 途径二:把单一得问题分割成为几个子问题。
Robot planning
◆建立模型。 对物体和机器人得几何,运动,物理描述。
◆任务说明。 说明各物体所期望得空间关系。
◆程序综合。
Robot planning
7、5 基于专家系统得机器人规划
2、ROPES机器人规划系统。 Robot Planning Expert Systems (1)系统简化框图。
Robot planning
Robot planning
7、3 STRIPS规划系统
2、STRIPS系统规划过程 例7、1,要求机器人到邻室去取回一个箱子。
Robot planning
7、3 STRIPS规划系统
提供两个操作符: gothru(d,r1,r2) pushthru(b,d,r1,r2)
这个问题得差别表:
Robot planning
Robot planning
7、5 基于专家系统得机器人规划
机器人路径规划
那么能否得到不需要指定中间点的速度,同时在整个运行时间内位置、速 度和加速度都是连续的插值函数? 答案是肯定的,方法就是采用样条插值技术。
下面针对关节角轨迹规划问题,给出常用的三次样条插值函数的定义。
在机械臂运行区间[0, tf]上取n+1个时间节点 0=t0 <t1 <t2 <<tn-1 <tn=tf 给出这些点处关节角位置函数的n+1个值(路径点)qi,i=0,1,2,…,n。要求
7-11
到式7-10和式7-11得:
q0 a0
ห้องสมุดไป่ตู้
其解为:
a0 q0
a1 0
a2
3
t
2 f
(q f
-q0 )
a3
2
t
3 f
(q0
-q f
)
满足约束条件的三次多项式:
qf
a0 a1t f
a2t
2 f
a3t
3 f
0 a1
0 a1 2a2t f
3a3t
2 f
1 d0
2
p - pobs d0 else
7-2
其中pobs是障碍物位置,d0表示障碍物的影响范围,h是斥力常数。
根据(7-1)式,机器人受到的引力表示为
Fatt p -Eatt K pgoal - p
7-3
3
障碍点 O Fatt
目标点 G
机器人
位置点 p
移动机器人路径规划
移动机器人路径规划的任务: 已知机器人初始位姿、给定机器人的目标位 姿,在存在障碍的环境中规划一条无碰撞、时间(能量)最优的路径。 若已知环境地图,即已知机器人模型和障碍模型,可采用基于模型的路径规划。
下面针对关节角轨迹规划问题,给出常用的三次样条插值函数的定义。
在机械臂运行区间[0, tf]上取n+1个时间节点 0=t0 <t1 <t2 <<tn-1 <tn=tf 给出这些点处关节角位置函数的n+1个值(路径点)qi,i=0,1,2,…,n。要求
7-11
到式7-10和式7-11得:
q0 a0
ห้องสมุดไป่ตู้
其解为:
a0 q0
a1 0
a2
3
t
2 f
(q f
-q0 )
a3
2
t
3 f
(q0
-q f
)
满足约束条件的三次多项式:
qf
a0 a1t f
a2t
2 f
a3t
3 f
0 a1
0 a1 2a2t f
3a3t
2 f
1 d0
2
p - pobs d0 else
7-2
其中pobs是障碍物位置,d0表示障碍物的影响范围,h是斥力常数。
根据(7-1)式,机器人受到的引力表示为
Fatt p -Eatt K pgoal - p
7-3
3
障碍点 O Fatt
目标点 G
机器人
位置点 p
移动机器人路径规划
移动机器人路径规划的任务: 已知机器人初始位姿、给定机器人的目标位 姿,在存在障碍的环境中规划一条无碰撞、时间(能量)最优的路径。 若已知环境地图,即已知机器人模型和障碍模型,可采用基于模型的路径规划。
机器人轨迹规划
04
基于动力学的方法
牛顿-欧拉方程
描述机器人运动和动态特性的 重要方程之一。
通过分析机器人各部分的加速 度、速度和位置之间的关系, 来预测机器人的运动轨迹。
可以用于实时控制机器人的运 动状态,确保机器人运动的稳 定性和准确性。
拉格朗日方程
另一种描述机器人运动和动态特 性的方程。
基于能量的概念,通过分析机器 人各部分的动能和势能之间的关 系,来预测机器人的运动轨迹。
服务机器人轨迹规划
总结词
服务机器人轨迹规划技术主要用于公共服务、餐饮、旅 游等领域。通过自主导航、避障和路径规划,实现自主 行走和任务执行。
详细描述
服务机器人通常采用轮式结构,具有较好的稳定性和移 动能力。通过对机器人的轮子进行精确控制,可以使其 按照预定的路径进行运动,同时通过避障和路径规划算 法,实现自主导航和任务执行。
具有简洁、易于理解和计算的优 点,适用于复杂机器人的运动规
划。
卡尔曼滤波器
一种用于估计和预测机器人状态的方法。
基于一系列传感器数据,通过建立数学模型对数据进行处理和分析,得到机器人位 置、速度等运动状态的估计值。
具有实时性、精确性和鲁棒性等优点,广泛应用于机器人导航、定位和跟踪等领域 。
05
基于机器学习的方法
医疗机器人轨迹规划
总结词
医疗机器人轨迹规划技术主要用于手术、康复、护理 等领域。通过精确的轨迹规划和运动控制,实现高精 度、高效率的医疗操作。
详细描述
医疗机器人通常采用医用高精度机械臂或手术器械, 具有高精度、高稳定性和高度可控性等特点。通过对 机器人的运动进行精确控制,可以使其按照预定的路 径进行运动,实现高精度、高效率的医疗操作。同时 ,医疗机器人还可以实现远程手术和康复治疗等功能 ,为医疗行业的发展提供了重要的技术支持。
机器人技术基础课件第七章机器人轨迹规划
7.2.3 用抛物线过渡的线性插值
0
1 2
t
2
(t)
0
1 2
ta2
ta
t
ta
f
1 2
(t
t
f
)2
0 t ta ta t t ta t ta t t f
7.2.3 用抛物线过渡的线性插值
7.2.3 用抛物线过渡的线性插值
目前,在机器人运动分析中,面向关节空间的轨迹规划方法被广泛 采用,它还可以把笛卡尔路径点变换为相应的关节坐标,并用低次多 项式内插这些关节点。这种方法的优点是计算较快,而且易于处理机器 人手臂关节的动力学约束。但当取样点落在拟合的光滑多项式曲线上时 ,面向关节空间的轨迹规划方法沿笛卡尔路径的准确性会有所损失。
关节空间的轨迹规划
(7-5)
由上式确定的三次多项式描述了起始点和终止点具有任意给定位 置和速度的运动轨迹。剩下的问题就是如何确定路径点上的期望关 节速度。
7.2.1 三次多项式插值
例:
设机械手的某个关节的起始关节角θ0=150,并且机械手 原来是静止的。要求在3秒钟内平滑地运动到θf=750时停下 来(即要求在终端时速度为零)。规划出满足上述条件的平滑 运动的轨迹,并求出关节角位置、角速度及角加速度随时 间变化的方程。
θ
确定路径点
反解关节值
每个关节运 动时间相同
光滑函数拟 合每个关节
t 某关节的反解值(线性化)
▼关键要使关节轨迹满足约束条件,如各点上的位姿、速度和 加速度要求和连续性要求等,在满足约束条件下选取不同的 插值函数。
7.2.1 三次多项式插值
关节空间的轨迹规划
当已知末端操作器的起始位姿和终止位姿时,由逆 向运动学,即可求出对应于两位姿的各个关节角度。 因此,末端操作器实现两位姿的运动轨迹描述,可在 关节空间中用通过起始点关节角和终止点关节角的一
相关主题
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
机器人轨迹规划属于机器人低层规划,基本上不涉及人工
智能问题,而是在机械手运动学和动力学的基础上,讨论机
器人运动的规划及其方法。所谓轨迹,就是指机器人在运动
过程中的位移、速度和加速度。
轨迹规划问题通常是将轨迹规划器看成“黑箱”,接受表示
路径约束的输入变量,输出为起点和终点之间按时间排列的操
作机中间形态(位姿, 速度和加速度)序列。
2
机器人规划分为高层规划和低层规划。自动规划在机器人 规划中称为高层规划。在无特别说明时,机器人规划都是指 自动规划。自动规划是一种重要的问题求解技术,它从某个 特定的问题状态出发,寻求一系列行为动作,并建立一个操 作序列,直到求得目标状态为止。与一般问题求解相比,自 动规划更注重于问题的求解过程,而不是求解结果。
7
在第一种方法中,约束的给定和操作机轨迹规划在关节坐标 系中进行。由于对操作机手部没有约束,使用者难于跟踪操作 机手部运行的路径。因此,操作机手部可能在没有事先警告的 情况下与障碍物相碰。
在第二种方法中,路径约束在笛卡尔坐标中给定,而关节驱 动器是在关节坐标中受控制的。因此,为了求得一条逼近给定 路径的轨迹,必须用函数近似把笛卡尔坐标中的路径约束变换 为关节坐标中的路径约束,再确定满足关节坐标路径约束的参 数化轨迹。
❖ 轨迹规划既可在关节变量空间中进行,也可在笛卡尔空间进 行。对于关节变量空间的规划,要规划关节变量的时间函数及 其前二阶时间导数,以便描述操作机的预定运动。在笛卡尔空 间规划中,要规划操作机手部位置、速度和加速度的时间函数, 而相应的关节位置、速度和加速度可根据手部信息导出。
8
在笛卡尔空间进行轨迹规划的特点: ➢ 面向笛卡尔空间方法的优点是概念直观,而且沿预定直线路 径可达到相当的准确性。可是由于现代还没有可用笛卡尔坐标 测量操作机手部位置的传感器,所有可用的控制算法都是建立 在关节坐标基础上的。因此,笛卡尔空间路径规划就需要在笛 卡尔坐标和关节之间进行实时变换,这是一个计算量很大的任 务,常常导致较长的控制间隔。 ➢ 由笛卡尔坐标向关节坐标的变换是病态的,因而它不是一一 对应的映射。 ➢ 如果在轨迹规划阶段要考虑操作机的动力学特性,就要以笛 卡尔坐标给定路径约束,同时以关节坐标给定物理约束(例如, 每个关节电机的力和力矩、速度和加速度权限)。这就会使最 后的优化问题具有在两个不同坐标系中的混合约束。
第七章 机器人的轨迹规划
7.1 机器人规划的定义和作用
7.1.1 概述
机器人学中的一个基本问题是为解决某个预定的任务而规划 机器人的动作,然后在机器人执行完成那些动作所需的命令时 控制它。这里,规划的意思就是机器人在行动前确定一系列动 作(作决策),这种动作的确定可用问题求解系统来解决,给定 初始情况后,该系统可达到某一规定的目标。因此,规划就是 指机器人为达到目标而需要的行动过程的描述。
我们在阐述机器人自动规划问题时,机器人一般配备有传 感器和一组能在某个易于理解的现场中完成的基本动作。这 些动作可把该现场从一种状态或布局变换为另一种状态或布 局。例如, “积木世界” 。
3
目标状态
机器人能得到的一个解答是由下面的算符序列组成的:
机器人规划是机器人学的一个重要研究领域,也是人工智能 与机器人学一个令人感兴趣的结合点。
把某些比较复杂的问题分解为一些比较小的问题的想法使 我们应用规划方法求解问题在实际上成为可能。
有两条能够实现这种分解的重要途径:第一条是当从一个 问题状态移动到下一个状态时,无需计算整个新的状态,而 只要考虑状态中可能变化了的那些部分。第二条是把单一的 困难问题分割为几个有希望的、较为容易解决的子问题,这 种分解能够使困难问题的求解变得容易些。
任务规划有三个阶段:建立模型、任务说明和操作机程序综 合。任务的世界模型应含有如下的信息:(1)任务环境中的所有 物体和机器人的几何描述;(2)所有物体的物理描述;(3)所有 连接件的运动学描述,(4) 机器人和传感器特性的描述。在世 界模型中,任务状态模型还必包括全部物体和连接件的布局。
5
7.2 机器人轨迹规划的一般性问题
规划内容可能没有次序,但是一般来说,规划具有某个规划 目标的蕴含排序。例如,早晨起床后的安排。
缺乏规划可能导致不是最佳的问题求解,甚至得不到问题的 求解。
1
许多规划所包的步骤是含糊的,而且需要进一步说明(子 规划)。大多数规划具有很大的子规划结构,规划中的每个 目标可以由达到此目标的比较详细的子规划所代替。因此, 最终得到的规划是某个问题求解算符的线性或分部排序,但 是由算符来实现的目标常常具有分层结构。
4
7.1.2 机器人任务规划的作用
机器人的规划程序只需要给定任务初始状态和最终状态的描 述。这些规划系统一般都不说明为实现一个算符所需的详细的 机器人运动。任务规划程序则把任务级的说明变换成操作机级 的说明。为了进行这种变换,任务规划程序必须包含被操作物 体、任务环境、机器人执行的任务、环境的初始状态和所要求 的最终(目标)状态等描述。任务规划程序的输出就是一个机器 人程序,在指定的初始状态下执行该程序后,就能达到所要求 的最终状态。
由初始点运动到终止
路径约束
点,所经过的由中间
形态序列构成的空间 路径设定
曲线称为路径。这些
轨迹规划器
形态序列即是曲线上ຫໍສະໝຸດ 的“点”。动力学约束
6
规划操作机的轨迹有两种常用的方法: ➢ 第一种方法:要求使用者在沿轨迹选定的位置点上(称为结 节或插值点)显式地给定广义坐标位置、速度和加速度的一组 约束(例如,连续性和光滑程度等)。然后,轨迹规划器从插值 和满足插值点约束的函数中选定参数化轨迹。显然,在这种 方法中,约束的给定和操作机轨迹规划是在关节坐标系中进 行的。 ➢ 第二种方法:使用者以解析函数显式地给定操作机必经之 路径,例如,笛卡尔坐标中的直线路径。然后,轨迹规划器 在关节坐标或笛卡几坐标中确定一条与给定路径近似的轨迹。 在这种方法中,路径约束是在笛卡尔坐标中给定的。
9
在关节变量空间的规划有三个优点: (1) 直接用运动时的受控变量规划轨迹; (2) 轨迹规划可接近实时地进行; (3) 关节轨迹易于规划。