Keyboard shortcuts

Press ← or → to navigate between chapters

Press S or / to search in the book

Press ? to show this help

Press Esc to hide this help

1.5 建模、规划与控制:全书路线图

本节回答一个问题:机器人学究竟研究什么?答案的骨架是三个动词——建模、规划、控制。本节把原书 §1.5 的叙述整理为「问题 → 工具 → 章节」的三列映射表;这张表既是全书十二章的总目录,也是读完第一章必须带走的一页纸。

1.5.1 建模(Modelling)

完成一般性任务需要执行指定动作,而控制系统的正确指令以对机械结构、执行器与传感器特征的精确分析为前提——分析的目的是导出刻画输入 / 输出关系的数学模型。因此,建模是制定运动控制策略的必要前提。

定义 1.5.1 · 运动学、微分运动学与动力学

运动学(kinematics):相对固定参考笛卡儿系描述运动,不考虑引起运动的力和力矩;对机械手,即关节位置与末端执行器位置和方向之间的解析关系。 微分运动学(differential kinematics):通过雅可比矩阵描述关节运动与末端执行器运动在速度层面的解析关系。 动力学(dynamics):将机械手的运动方程描述为作用其上的力和力矩的函数。

三类模型并非三个并列的名词,而是一条逐层加信息的链。以关节变量 q\boldsymbol q、末端位姿 x\boldsymbol x、关节力矩 τ\boldsymbol\tau 为例:

x=f(q)→对时间求导x˙=J(q)q˙→加入力与质量τ=M(q)q¨+h(q,q˙).(1.2) \boldsymbol x=f(\boldsymbol q) \quad\xrightarrow{\text{对时间求导}}\quad \dot{\boldsymbol x}=J(\boldsymbol q)\dot{\boldsymbol q} \quad\xrightarrow{\text{加入力与质量}}\quad \boldsymbol\tau=M(\boldsymbol q)\ddot{\boldsymbol q}+\boldsymbol h(\boldsymbol q,\dot{\boldsymbol q}). \tag{1.2}

第一式只回答「在哪儿」,第二式回答「怎么动」,第三式才回答「要多大力矩」。式 (1.2) 此处只建立层级关系;J,M,hJ,M,\boldsymbol h 的构造与物理意义分别留到第 3、7 章。

建模、规划与控制的变量流 任务位姿经过逆运动学和轨迹规划得到关节参考,控制器根据误差产生力矩,机械手执行后由正运动学得到实际末端位姿并反馈。 任务位姿x_d(t) 逆运动学 + 轨迹规划把任务翻译成参考q_d(t) 反馈控制器根据误差修正命令τ(t) 真实机械手执行器、传动、负载q(t) 正运动学 + 传感x(t)=f(q(t)) 规划控制作用反馈
图 1.6 同一任务沿两条方向流动:规划把期望位姿翻译为关节参考,控制以测量反馈修正执行误差;正、逆运动学因此在同一闭环里相遇。
原理 1.5.A · 正问题与逆问题(新增整理)

运动学研究的两个关键问题方向相反: 正运动学——已知关节变量,求末端执行器的位姿(「给了胳膊的姿势,手在哪?」);它利用线性代数工具,存在系统性、一般性的构造方法。 逆运动学——已知(自然在工作空间中指定的)末端期望位姿,求相应关节变量(「手要到那里,胳膊怎么摆?」);它是把期望运动翻译为关节运动的必经环节,解的存在性与多解性由结构决定(对照 1.2.3 球形腕的两步求解)。 此外,运动学模型对确定静力学关系同样有用:静态平衡位形下关节力 / 力矩与末端力 / 力矩之间的关系。

动力学模型的四大用途(原书列举):结构的机械设计、执行器的选择、控制策略的确定、运动的计算机仿真。

移动机器人的建模另有其特殊性:须先分析车轮带来的运动学约束——约束可积或不可积,直接影响机器人的移动性(对照 1.3.3 的「不能即时横移」)。就模型本身而言,运动学模型本质上是约束容许下瞬时运动的描述,动力学模型则进一步描述运动与广义力的关系;两者均可写成规范化形式,以便规划与控制设计。

课程预告 · 第 2、3、7、11 章

第 2 章运动学(旋转矩阵、欧拉角、四元数、齐次变换、DH 法、正逆运动学);第 3 章微分运动学与静力学(雅可比矩阵、奇异性);第 7 章动力学(拉格朗日 / 牛顿—欧拉方程);第 11 章移动机器人运动学与动力学(非完整约束)。附录 A(线性代数)与 B(刚体力学)随第 2、7 章启用。

1.5.2 规划(Planning)

有了模型,才谈得上替机器人安排动作。规划要回答的是:如何从任务的简明描述出发,生成机器人可以直接执行的参考输入。

定义 1.5.2 · 轨迹规划与运动规划

轨迹规划(trajectory planning):从对期望运动的简明描述出发,生成相关变量(关节或末端执行器)的时间律。描述既可以给在关节空间,也可以给在操作空间——两个空间的概念与换算见 2.10,此处先埋伏笔。机械手的两类任务:材料搬运只需指定抓取 / 放下位置——点对点运动;加工任务中末端须遵循期望轨迹——路径运动。 运动规划(motion planning):工作空间出现障碍物时,规划的运动必须防碰撞以保证安全。对机械手与移动机器人均可采用位形空间(configuration space)概念统一表述;求解本质是算法技术——确定性方法、随机性方法与启发式方法。

移动机器人的运动规划比机械手更复杂:轨迹生成中必须考虑车轮的运动学约束(非全向底盘不能瞬时任意方向移动)。第 11 章将从移动机器人运动学模型中的特殊微分结构给出解法。

课程预告 · 第 4、12 章

第 4 章机械手轨迹规划(多项式插值、样条等时间律生成);第 12 章运动规划(位形空间、搜索与随机算法);附录 E(图上搜索算法)随第 12 章启用。

1.5.3 控制(Control)

规划给出的是「期望」,而真实的机械手不会恰好照做。控制要回答的是:如何让实际运动尽量逼近期望。控制相关内容可按四个层面阅读——1 执行器与传感器、2 控制系统体系、3 运动控制是主干,4 交互与移动控制是两个专门化方向:

1. 执行器与传感器(第 5 章):实现运动与获取反馈的物理基础。

2. 控制系统体系(第 6 章):硬件与软件架构,实现控制律与人机接口。

3. 运动控制(第 8 章):让机械结构跟踪规划轨迹。

原理 1.5.B · 反馈不可替代(新增整理)

机械手是连杆相互牵连的系统——一个连杆的运动通常影响其他连杆,运动方程因此包含耦合动态;理想化的笛卡儿机构可能近似解耦,实际设计仍会受负载、摩擦与传动影响。而动力学模型本身也不能完全描述真实结构,因此「算准了再开环执行」不可行:必须闭合反馈回路,根据 e(t)=qd(t)−q(t)\boldsymbol e(t)=\boldsymbol q_d(t)-\boldsymbol q(t) 持续修正命令 τ(t)\boldsymbol\tau(t),以满足轨迹执行精度。——这是 1.1.3「控制系统服从与人体功能控制相同的反馈原理」的技术版陈述。

4. 交互控制与移动机器人控制:

  • 力控制(第 9 章):任务要求机器人与环境接触时,控制须参考外部传感器的力交换数据;
  • 视觉控制(第 10 章):参考照相机检测到的目标位置;
  • 移动机器人控制(第 11 章):与机械手有本质区别——可用控制输入数远少于位形变量数(受非完整约束,1.3.3 式 (1.1) 的伏笔在此兑现),由此跟踪问题(沿轨迹运动)与调节问题(到达指定位形)的控制器结构不可避免地不同;此外,本体传感器无法直接输出位形,因此还必须研究定位方法。
课程预告 · 附录 C

附录 C 是反馈控制基本原理(传递函数、稳定性、PID)的复习——没有这些背景的读者应在进入第 8 章前先读。

1.5.4 全书章节映射表

把前三节的讨论收拢成一张表:每一行给出一个主题、对应章节与一句话内容,最后一列提示需要的前置附录。

主题章一句话内容前置附录
结构第 5 章执行器与传感器的功能特征—
建模第 2 章运动学:姿态表示、DH 法、正逆运动学附录 A 线性代数
第 3 章微分运动学与静力学:雅可比
第 7 章动力学:运动方程附录 B 刚体力学
第 11 章(建模半)移动机器人运动学 / 动力学(约束)附录 D 微分几何
规划第 4 章机械手轨迹规划(时间律)—
第 11 章(规划半)含运动学约束的轨迹生成
第 12 章运动规划(位形空间、避障)附录 E 图搜索
控制第 6 章控制系统硬 / 软件体系—
第 8 章运动控制技术附录 C 反馈控制
第 9 章力控制
第 10 章视觉控制
怎么用这张表
  1. 学习地图:每学完一章回来给对应行打勾,并补一句自己的「一句话内容」;
  2. 拆任务:任何机器人任务先拆成「建模 → 规划 → 控制」三段,再对号入座(例:『沿直线从 A 到 B 并避开工件』=第 2 章逆运动学 + 第 4 章轨迹规划 + 第 12 章避障 + 第 8 章运动控制);
  3. 附录预警:附录 A–E 各挂在对应章节前,弱项可提前补。

1.5 小结与常见错误

  • 一条主线:建模(运动学 / 微分运动学 / 动力学——刻画系统)→ 规划(轨迹 / 运动——生成参考输入)→ 控制(反馈回路——保证执行),三段首尾相接,正是 1.1.3 所说「智能联系」的工程实现。
  • 两个方向:正问题(由因求果,构造性)与逆问题(由果求因,面向任务)——运动学如此,控制亦然(跟踪 = 逆动力学问题的影子)。
  • 一个不可替代物:反馈(原理 1.5.B)——模型永远不完全,闭环永远必要。
常见错误清单 · 自查四条
  1. 把运动学与动力学混谈——运动学不含力,动力学才是力与运动的关系(定义 1.5.1);
  2. 以为规划只是「找路径」——轨迹规划生成的是时间律(何时在何处),运动规划解决避障,两回事(定义 1.5.2);
  3. 以为模型够准就能开环控制——模型不能完全描述真实结构,反馈不可省略(原理 1.5.B);
  4. 把移动机器人当机械手的平移版——控制输入数 < 变量数,跟踪与调节的控制器结构不同(1.5.3)。