机器人的速度控制运动模型
假设没有噪声,控制时间间隔为 t
(, , )
时间间隔内机器人速度和角速度保
持不变,则机器人绕着半径为r的
(′, ′, ′)
圆周运动
r
v
机器人的速度控制运动模型
(, , )
(′, ′, ′)
æ x ' ö æ x - wv sin(q ) + wv sin(q + wDt)
2
根据条件 , 1 和对终止速度1 的要求
= = 3
1 = 1 = 3 + 4 1 − + 5 1 −
ሶ 1 = 1 = 4 + 25 1 −
如果要求轨迹对称
即 =
0 + 1
0 + 1
, = =
ç
÷ ç
ç y ' ÷ = ç y + wv cos(q ) - wv cos(q + wDt)
ç q ' ÷ çç
q + wDt
è
ø è
ö
÷
÷
÷
÷
ø
不同的速度指令 (v,w)会得到不同的运动半径,同样的时
间间隔到达不同的终止位置。有些位置是安全的,有些
会与障碍物发生碰撞
可以让机器人停止不与障碍物相碰的可行速度集合
边界约束
中间位置
匀速起点位置 (给定)
匀速起点位置处与前面轨迹的路径连续性
匀速起点位置处与前面轨迹的速度连续性
匀速起点位置处与前面轨迹的加速度连续性
减速位置 (给定)
减速位置处与前面轨迹的路径连续性