机器人导航中的kinematics

不用担心！我把上面的内容重新整理，确保公式能在CSDN等Markdown编辑器中正确显示。

# 机器人导航中的Kinematics（运动学）原理

## 核心概念：运动学是什么？

在机器人导航中，**运动学**研究的是机器人的运动（位置、速度）与执行机构的动作（轮子转速、转向角）之间的数学关系，**而不考虑**产生这些运动的力或力矩。

简单来说，它回答两个关键问题：
1. **正运动学**：给定机器人的轮子转速或转向角，计算它会如何移动（位置、朝向的变化）
2. **逆运动学**：给定一个期望的运动（例如"向前10厘米，左转5度"），计算机器人的轮子或关节需要执行什么动作来实现它

---

## 机器人导航中的两大主要运动学模型

根据移动方式，地面移动机器人主要分为两大类，对应两种不同的运动学模型：

### 1. 差速驱动模型（Differential Drive）
这是最常见、最简单的模型。机器人有两个独立的驱动轮（通常位于同一轴线上），通过控制两个轮子的速度差来实现移动和转向。

**结构**：
- 两个驱动轮（左轮、右轮）
- 一个或多个从动轮（万向轮）保持平衡

**控制变量**：
- `v_l`：左轮线速度
- `v_r`：右轮线速度

**机器人运动描述**：
- `v`：机器人中心的线速度
- `ω`：机器人绕其中心旋转的角速度

#### 正运动学（从轮速到机器人运动）：
```
v = (v_r + v_l) / 2
ω = (v_r - v_l) / L
```
其中 **L** 是两个驱动轮之间的轴距。
**核心思想**：速度差（`v_r - v_l`）导致转弯

#### 逆运动学（从期望的 `v, ω` 到所需轮速）：
```
v_r = v + (L × ω) / 2
v_l = v - (L × ω) / 2
```
**举例**：要原地旋转（`v = 0`），只需让两个轮子以大小相