MATLAB - 移动机器人运动学方程

kuan_li_lyg

已于 2024-01-30 14:16:06 修改

阅读量1.6k

点赞数 15

分类专栏： MATLAB 机器人与控制系统应用文章标签： matlab 开发语言机器人自动驾驶 ROS 机器人控制移动机器人建模

于 2024-01-18 06:00:00 首次发布

本文链接：https://blog.csdn.net/weixin_46300916/article/details/135591619

版权

MATLAB 机器人与控制系统应用专栏收录该内容

57 篇文章 42 订阅

订阅专栏

本文详细介绍了移动机器人中的四种主要运动模型：独轮车、自行车、差动驱动和阿克曼模型，阐述了它们的状态变量、控制输入以及相应的运动方程，有助于理解并应用在机器人路径规划和控制中。

摘要由CSDN通过智能技术生成

系列文章目录

前言

详细了解移动机器人运动学方程，包括独轮车、自行车、差动驱动和阿克曼模型。本主题涵盖了每种运动模型的变量和特定方程 [1]。有关使用这些模型模拟不同移动机器人的示例，请参阅模拟移动机器人的不同运动模型。

一、变量概述

机器人状态用三元素向量表示： [x y θ]。

对于给定的机器人状态

x: 以米为单位的全局车辆 x 位置
y: 全局车辆的 y 位置，以米为单位
θ: 全局车辆航向，单位为弧度

对于阿克曼运动学，状态还包括转向角：

ψ: 车辆转向角，单位为弧度

独轮车、自行车和差速驱动模型共享一个通用控制输入，该输入接受以下内容：

v: 车辆速度，单位为米/秒
ω: 车辆角速度，单位为弧度/秒

运动学方程中的其他变量包括

r: 车轮半径，单位米
: 车轮速度（弧度/秒
d: 轨道宽度（米
l: 轮距（米
ψ: 车辆转向角，单位为弧度

二、独轮车运动学

独轮车运动学方程使用 unicycleKinematics 对象对围绕中心轴转动的单个滚动车轮进行建模。

单车模型状态为 [x y θ]。

2.1 变量

x: 以米为单位的全局车辆 x 位置
y: 全局车辆的 y 位置，以米为单位
θ: 全局车辆航向，单位为弧度
: 车轮速度（米/秒
r: 车轮半径（米
v: 车速（米/秒
ω: 车辆航向角速度（弧度/秒

2.2 运动方程

根据 VehicleInputs 的名-值参数，您可以只输入车轮速度，也可以输入车辆速度和航向角速度。输入的这种变化会影响方程。

车轮速度方程

eq?%5Cbegin%7Bbmatrix%7D%5Cdot%7Bx%7D%5C%5C%5Cdot%7By%7D%5C%5C%5Cdot%7B%5Ctheta%7D%5Cend%7Bbmatrix%7D%3D%5Cbegin%7Bbmatrix%7Dr%5Ccos%28%5Ctheta%29%260%5C%5Cr%5Csin%28%5Ctheta%29%260%5C%5C0%261%5Cend%7Bbmatrix%7D%5Cbegin%7Bbmatrix%7D%5Cdot%7B%5Cphi%7D%5C%5C%5Comega%5Cend%7Bbmatrix%7D

车速和转向率方程（广义）

当一般化输入为速度 v=r eq?%5Cdot%7B%5Cphi%20%7D 和车辆航向角速度 ω 时，方程简化为

eq?%5Cbegin%7Bbmatrix%7D%5Cdot%7Bx%7D%5C%5C%5Cdot%7By%7D%5C%5C%5Cdot%7B%5Ctheta%7D%5Cend%7Bbmatrix%7D%3D%5Cbegin%7Bbmatrix%7D%5Ccos%28%5Ctheta%29%260%5C%5C%5Csin%28%5Ctheta%29%260%5C%5C0%261%5Cend%7Bbmatrix%7D%5Cbegin%7Bbmatrix%7D%5Cnu%5C%5C%5Comega%5Cend%7Bbmatrix%7D

三、自行车运动学

自行车运动学方程模拟的是一种类似汽车的车辆，它使用 bicycleKinematics 对象将前转向角作为控制输入。

自行车模型状态为 [x y θ]。

3.1 变量

x: 以米为单位的全局车辆 x 位置
y: 全局车辆 y 位置，以米为单位
θ: 全局车辆航向，单位为弧度
l: 轮距，单位米
ψ: 车辆转向角，单位为弧度
v: 车辆速度（米/秒
ω: 车辆航向角速度（弧度/秒

3.2 运动方程

根据 VehicleInputs 的名-值参数，您可以将车速输入为转向角或航向角速度。输入的这种变化会影响方程。

转向角方程

$eq?%5Cbegin%7Bbmatrix%7D%5Cdot%7Bx%7D%5C%5C%5Cdot%7By%7D%5C%5C%5Cdot%7B%5Ctheta%7D%5Cend%7Bbmatrix%7D%3D%5Cbegin%7Bbmatrix%7Dcos%28%5Ctheta%29%260%5C%5Csin%28%5Ctheta%29%260%5C%5C%5Cfrac%7B%5Ctan%28%5Cpsi%29%7Dl%261%5Cend%7Bbmatrix%7D%5Cbegin%7Bbmatrix%7D%5Cnu%5C%5C%5Comega%5Cend%7Bbmatrix%7D$

车速与航向率公式（通用格式）

在这种广义格式中，航向率 ω 与转向角 ψ 的关系式为 $eq?%5Comega%3D%5Cfrac%7B%5Cnu%7D%7Bl%7D%5Cmathrm%7Btan%7D%5Cpsi$ . 然后，ODE 简化为

四、差动驱动运动学

差速驱动运动学方程使用差速驱动运动学对象对车辆进行建模，其中左右两侧的车轮可以独立旋转。

差分驱动模型状态为 [x y θ]。

4.1 变量

x: 全局车辆 x 位置，以米为单位
y: 全局车辆 y 位置，以米为单位
θ: 全局车辆航向，单位为弧度
: 左轮速度（米/秒
: 右轮速度（米/秒
r: 车轮半径（米
d: 轨道宽度（米
v: 车速（米/秒
ω: 车辆航向角速度（弧度/秒

4.2 运动方程

根据 VehicleInputs 的名-值参数，您可以将车轮速度输入为转向角或航向角速度。这种输入变化会影响方程。

车轮速度方程

2d%5Cend%7Bbmatrix%7D%5Cbegin%7Bbmatrix%7D%5Cdot%7B%5Cphi%7D_L%5C%5C%5Cdot%7B%5Cphi%7D_R%5Cend%7Bbmatrix%7D

车速和转向率公式（通用格式）

在广义格式中，输入为速度 $eq?%5Cnu%3D%5Cfrac%7Br%7D%7B2%7D%5Cleft%28%5Cdot%7B%5Cphi%7DR+%5Cdot%7B%5Cphi%7D_%7BL%7D%5Cright%29$ 和车辆航向角速度 $eq?%5Comega%3D%5Cfrac%7Br%7D%7B2d%7D%28%5Cdot%7B%5Cphi%7DR-%5Cdot%7B%5Cphi%7DL%29$ 。 ODE 简化为：

五、阿克曼运动学

阿克曼运动学方程使用阿克曼运动学对象对带有阿克曼转向机构的汽车模型进行建模。该方程根据轨道宽度调整车轴轮胎的位置，使轮胎沿着同心圆运动。在数学上，这意味着输入必须是转向航向角速度 eq?%5Cdot%7B%5Cpsi%20%7D 没有通用格式。

阿克曼模型的状态是 [x y θ ψ]。

5.1 变量

x: 以米为单位的全局车辆 x 位置
y: 全局车辆的 y 位置，以米为单位
θ: 全局车辆航向，单位为弧度
ψ: 车辆转向角，单位为弧度
l: 轮距（米
v: 车辆速度（米/秒

5.2 运动学方程

对于阿克曼运动学模型，ODE 为

l%260%5C%5C0%261%5Cend%7Bbmatrix%7D%5Cbegin%7Bbmatrix%7D%5Cnu%5C%5C%5Cdot%7B%5Cpsi%7D%5Cend%7Bbmatrix%7D

参考资料

[1] Lynch, Kevin M., and Frank C. Park. Modern Robotics: Mechanics, Planning, and Control. Cambridge University Press, 2017.

kuan_li_lyg

关注

15
点赞
踩
33

收藏

觉得还不错? 一键收藏
0
评论
MATLAB - 移动机器人运动学方程

机器人状态用三元素向量表示： [x y θ]。对于给定的机器人状态x: 以米为单位的全局车辆 x 位置y: 全局车辆的 y 位置，以米为单位θ: 全局车辆航向，单位为弧度ψ: 车辆转向角，单位为弧度v: 车辆速度，单位为米/秒ω: 车辆角速度，单位为弧度/秒运动学方程中的其他变量包括r: 车轮半径，单位米: 车轮速度（弧度/秒d: 轨道宽度（米l: 轮距（米ψ: 车辆转向角，单位为弧度。
复制链接

扫一扫

专栏目录