打卡学习 week8 | 机器人学导论
前情回顾
在上周以简单的物体取放任务为例,学习了通过坐标系转换求解出操作臂的逆运动方程。SOLVE函数是逆运动学函数,对于计算{W}相对于{B}的位置的SOLVE函数这样表示: W B T ^{B}_{W}T WBT= S B T ^{B}_{S}T SBT T S T ^{S}_{T}T TST T W T − 1 ^{W}_{T}T^{-1} TWT−1,求解步骤分为三步:1.定义DH 坐标系;2.找出 C W T ^{W}_{C}T CWT,再进一步找出 6 0 T ^{0}_{6}T 60T;3.找出 θ 1 θ_1 θ1— θ 6 θ_6 θ6。
机械臂轨迹规划
轨迹:机械臂的位置、速度、加速度对时间的经历。
可进一步定义为{T}相对{G}的状态历程。
这是一条理想状态下的平滑曲线
有起点,中间点和终点。
Joint-Space 下的轨迹规划
步骤:
1.定义{T}相对于{G}的初始点,中间点和结束点,
T
G
T
i
^{G}_{T}T_i
TGTi,将
T
G
T
i
^{G}_{T}T_i
TGTi以6个参数方式来表达:
2.逆运动学转换:将机械臂末端点状态转换到Joint状态:
G
X
T
^{G}X_{T}
GXT→
θ
i
θ_i
θi
3.对所有Joint规划理想平滑轨迹
4.顺向运动学转换:将joint状态转换到机械臂末端点状态,检查所设想轨迹的可行性。
用图表将其直观化:
笛卡尔坐标系下的轨迹规划
步骤:
1.定义{T}相对于{G}的初始点、中间点和结束点,
T
G
T
i
^{G}_{T}T_i
TGTi,将
T
G
T
i
^{G}_{T}T_i
TGTi以6个参数方式来表达:
2.将所有机械臂末端状态规划理想平滑轨道;
3.将规划好机械臂末端点状态的轨迹点转换到Joint状态:
G
X
T
^{G}X_{T}
GXT→
θ
i
θ_i
θi;
3.检查joint状态在Joint-space下轨迹的可行性。
这种方法的特点有:
1.具有较为直观的轨迹;
2.但是计算量更大。
使用图标更为直观的展示:
轨迹规划的方法
一,三次多项式(Cubic Polynomials)
原则
轨迹:不同轨迹区段[
t
i
t_i
ti
t
i
+
1
t_i+1
ti+1]以不同参数的函数来规划;
需要定义各函数的边界条件(包含位置和速度 θ(
t
i
t_i
ti),θ(
t
i
+
1
t_i+1
ti+1),θ.(
t
i
t_i
ti),θ.(
t
i
+
1
t_i+1
ti+1),有4个条件)
以三次多项式来规划轨迹。
求解三次多项式
通式
θ(
t
˜
\~t
t˜)=
a
0
a_0
a0+
a
1
a_1
a1
t
˜
\~t
t˜+
a
2
a_2
a2
t
˜
\~t
t˜^2+
a
3
a_3
a3
t
˜
\~t
t˜^3
(有4个未知量
a
0
a_0
a0~
a
3
a_3
a3)
对每一个区段:t∈[
t
i
t_i
ti,
t
i
+
1
t_i+1
ti+1]
边界条件
联立方程式 ① ② ③ ④
以矩阵的方式运算
所以
———————————————————————————————————
本次学习到此结束
———————————————————————————————————
2023.11.19(补2023.11.12)