机器人入行指南
强化训练/手写实现

训练 4 / 4

手写实现

12 道白板题,给接口与判分点

手写不是为了背代码,是为了暴露「你以为你会」的地方。每题都标了判分点——面试官看的正是这几处,而不是你能不能跑通。

共 12 题。点开看答案前,先自己说一遍。

给接口函数签名与约束手写实现不看答案跑用例边界与异常讲清复杂度为什么这么写手写不是为了背代码,是为了暴露「你以为你会」的地方

几何与状态估计 4

实现 4×4 变换矩阵求逆(旋转 + 平移)。

判分:用 Rᵀ 与 −Rᵀt,而不是通用高斯消元;先断言旋转块正交。

对应知识点:线性代数与刚体旋转表示 A1

实现标量卡尔曼滤波。

判分:预测/更新两步清晰;K = P/(P+R);协方差更新用 (1−K)P 而不是 P−KRK。

对应知识点:状态估计(卡尔曼滤波族) B7

实现四元数归一化与 slerp。

判分:点积为负时取反(走最短路径);夹角接近 0 时退化为线性插值避免除零。

对应知识点:线性代数与刚体旋转表示 A1

实现 2 连杆逆解(含肘上/肘下)。

判分:给出两组解;arccos 入参做定义域钳位;说明奇异(伸直)时无解或解不唯一。

对应知识点:正逆运动学与雅可比 B2

控制与滤波 3

实现 PID(带抗积分饱和与微分先行)。

判分:输出限幅 + 积分钳位;微分作用于测量值而非设定值;说明为什么。

对应知识点:经典控制(PID / 频域 / 稳定性) B5

实现固定周期定时线程。

判分:用绝对时间(clock_nanosleep TIMER_ABSTIME);超时后补偿而不是累加漂移;说明优先级与内存预分配。

对应知识点:实时系统与 PREEMPT_RT D4

实现滑动平均与一阶低通,并对比。

判分:能说清相位滞后与噪声抑制的取舍;给出截止频率与 α 的关系。

对应知识点:信号与系统(频域 / 滤波) A5

嵌入式与总线 3

实现 CAN 帧解析(ID 过滤 + 信号位域提取)。

判分:位域跨字节的提取、大小端、有符号扩展;越界与超时处理。

对应知识点:现场总线:CAN / RS485 / CAN FD E18

实现一次完整的 I2C 寄存器读。

判分:起始 → 地址+W → 寄存器 → 重复起始 → 地址+R → 数据 → NACK → 停止;每步有超时与错误返回。

对应知识点:板内三件套:UART / I2C / SPI E16

实现单生产者单消费者无锁环形缓冲。

判分:原子索引、正确的内存序、满与空的区分(留一个空位或独立计数)。

对应知识点:现代 C++ D1

规划与架构 2

在栅格上实现 A*(或 Dijkstra)。

判分:启发函数一致(不高估);节点重复入队时比较 g 值;能说清为什么 A* 比 Dijkstra 快。

对应知识点:轨迹规划 B4

实现一个系统状态机(启动/就绪/运行/故障/复位)。

判分:非法转移被拒绝而不是静默忽略;故障锁存需要显式复位;有超时保护。

对应知识点:机器人软件架构 D8