医用机器人复习讲义：概念、公式与计算

本讲义围绕医用机器人课程的核心知识组织，包括工程力学基础、机器人运动学、机器人动力学、运动控制、力控制以及综合题训练。讲义侧重解释公式来源、物理含义和计算步骤，帮助把课件知识转化为可答题的推导与分析能力。

从计算基础开始进入综合题训练

概念题计算题标准解题模板图文讲义

考试常见路径：先算运动，再算力矩，最后说明控制器如何让误差收敛。

讲义范围

概念框架

每章先说明核心问题：要求解什么量、为什么需要这些模型、公式中的变量分别代表什么。

公式推导

重要公式配有来源说明，例如由求导、积分、虚功、能量或动力学方程得到，而不是只给结论。

M(q)\ddot q+C(q,\dot q)\dot q+g(q)=\tau

例题解析

例题按“识别题型、选择公式、代入计算、解释结果”的顺序展开，重点训练计算题和综合题。

符号约定

为了让整份讲义可以独立阅读，先统一最常见的符号。不同教材可能会把同一个物理量写成不同字母，但本讲义尽量保持下面这套约定：普通质点运动用 \(s,v,a\)，机器人关节运动用 \(q,\dot q,\ddot q\)，末端任务空间变量用 \(x,\dot x\)，力和力矩用 \(F,\tau\)。看到上方有点的量，例如 \(\dot q\)，都表示对时间求一阶导；两个点的 \(\ddot q\) 表示再对时间求一次导。

符号	含义	常见单位/说明
\(s,v,a\)	质点位置、速度、加速度	\(v=ds/dt,\ a=dv/dt\)。
\(q,\dot q,\ddot q\)	关节位置、关节速度、关节加速度	转动关节常用 rad、rad/s、rad/s²；移动关节用 m、m/s、m/s²。
\(x,\dot x\)	末端任务空间位置/位姿及速度	可表示末端点位置，也可扩展为位姿向量。
\(R,T,p\)	旋转矩阵、齐次变换、平移向量	\(T=\begin{bmatrix}R&p\\0&1\end{bmatrix}\)。
\(J(q)\)	Jacobian 矩阵	由正运动学对 \(q\) 求偏导得到，连接 \(\dot x=J\dot q\) 和 \(\tau=J^TF\)。
\(M,C,g,\tau\)	惯性矩阵、速度耦合项、重力项、关节力矩	组成机器人动力学方程。
\(e,\dot e,\ddot e\)	误差、误差速度、误差加速度	例如 \(e=q_d-q\)，\(\dot e=\dot q_d-\dot q\)。
\(s\)	Laplace 域复变量	不要和位移 \(s\) 混淆；看上下文判断。

核心公式速查

下面这些公式是整份讲义的骨架。复习时不要只背等号右边，而要同时记住它在解决什么问题：运动学公式回答“位置和速度怎么来”，动力学公式回答“运动需要多少力矩”，控制公式回答“误差如何被修正”，力控制公式回答“接触力和运动如何关联”。

主题	核心公式	它在干什么
基础运动学	\(v=ds/dt,\ a=dv/dt,\ a\,ds=v\,dv\)	把位置、速度、加速度通过求导和积分联系起来。
2R 正运动学	\(x=l_1\cos q_1+l_2\cos(q_1+q_2)\)	把关节角转换为末端位置。
Jacobian	\(\dot x=J(q)\dot q,\ \tau=J^T(q)F\)	同一个矩阵连接速度映射和力映射。
机器人动力学	\(M(q)\ddot q+C(q,\dot q)\dot q+g(q)=\tau\)	说明关节力矩要支付惯性、速度耦合和重力三部分。
PID	\(u=K_pe+K_i\int e\,dt+K_d\dot e\)	用当前误差、历史误差和误差变化率生成控制量。
计算力矩控制	\(\tau=Mv+C\dot q+g\)	先设计理想加速度 \(v\)，再用动力学模型换成真实力矩。
阻抗控制	\(F_d=M_d\ddot e+B_d\dot e+K_de\)	把运动误差转换为期望接触力。
导纳控制	\(M_d\ddot x_d+B_d\dot x_d+K_dx_d=F_{ext}\)	把外部力转换为期望运动响应。

章节结构

1. 数学力学基础
直线/曲线运动、牛顿定律、功能、动量。 2. 机器人运动学
自由度、齐次变换、DH、正逆运动学、Jacobian。 3. 机器人动力学
静力映射、拉格朗日、Newton-Euler、正/逆动力学。 4. 运动控制
Laplace、传递函数、PID、关节/任务空间、计算力矩控制。 5. 力控制
阻抗、导纳、直接力控、混合力/位置控制与康复力场案例。 6. 综合题库
概念题和计算题混合训练，答案可展开。

答题方法

先识别题型。 是运动学、动力学、控制还是力控？题目给的是位置、速度、力还是期望轨迹？

列核心公式。 不要直接代数乱算，先写出该题的主方程。

统一单位。 角度先转弧度，毫米转米，力矩单位写成 N·m。

给出物理解释。 概念题看逻辑，计算题最后一句说明正负号、方向或控制效果。

独立复习路径

如果只看这份讲义，建议按下面的顺序推进。第一遍先读每章开头和公式解释，目标是知道每个公式在算什么；第二遍做每章例题，目标是能从题干判断该用哪个模型；第三遍做综合题库，目标是把运动学、动力学和控制串起来。遇到不会的题，不要直接看最终数值，先回到对应章节找“公式来源”和“变量含义”，确认自己没有把位置、速度、力和力矩混在一起。

第一轮：建立概念。 阅读讲义范围、符号约定和核心公式速查，再按章节顺序浏览每个公式的解释。

第二轮：完成例题。 每道例题先遮住解析，自己写出主公式和代入步骤，再核对解析过程。

第三轮：做综合题。 从综合题库训练跨章节题型，例如正运动学接 Jacobian，再接静力映射或控制律。

第四轮：查漏补缺。 对照本章掌握度勾选项，未掌握的内容回到正文重新读公式含义和例题解释。

本章掌握度

我能说明本讲义的主要章节与复习范围。我会先理解公式含义，再进行代入计算。我能用符号表和公式速查定位陌生公式。我会按力学基础、运动学、动力学、控制、力控制的顺序复习。