[具身智能-809]：整机运动速度的三个维度和每个单一电机的运动速度的维度，以及他们是如何转化映射的？不同的运动本体与不同类型、不同数量的车轮，转化算法不同

整机三维运动与电机速度的映射转化四种典型底盘对比3. 四轮滑移转向坦克式四驱4 台电机左右侧车轮同步执行器4 台电机左侧两台同速右侧两台同速等效 2 个控制量。整车约束不能横移 \(V_x\equiv0\)有效维度\(V_y、\omega\)。逆运动学左侧全部电机同一目标转速右侧全部电机同一目标转速。4. 阿克曼底盘1 台驱动电机 1 台转向舵机注意两个执行器物理意义不一样驱动电机输出转速1 维转向舵机输出转向角角度位置量不是转速。整车约束不能横移 \(V_x\equiv0\)有效维度\(V_y、\omega\)。映射逻辑整车期望\(V_y、\omega\) → 根据阿克曼几何模型求解驱动轮目标转速、前轮转向角。驱动电机走转速 PID转向舵机走内部位置闭环。这里已经不是单纯 “转速之间矩阵乘法”里面包含阿克曼几何三角函数运算。表格汇总对比表格底盘类型电机数量整车理论维度实际可用运动维度逆运动学输入输出核心特点四轮麦克纳姆4\(V_x,V_y,\omega\)全部 3 维3 维整车→4 维电机转速可横移过驱动矩阵运算两轮差速2\(V_x,V_y,\omega\)\(V_y,\omega\)\(V_x0\)2 维整车→2 维电机转速不能横移最常见教学小车四轮滑移坦克4\(V_x,V_y,\omega\)\(V_y,\omega\)\(V_x0\)2 维整车→左右两组电机转速左右侧车轮同步阿克曼驱动电机 1 转向舵机 1\(V_x,V_y,\omega\)\(V_y,\omega\)\(V_x0\)整车速度→驱动转速 转向角度有转向角几何约束使用三角函数工程链路完整流程以 STM32 运动扩展板为例RDK X5 (ROS2) 下发整车三维速度 \(\boldsymbol\xi [V_x,V_y,\omega]\)STM32 固件根据当前底盘类型选择对应的运动学算法如果是麦克纳姆调用麦克纳姆逆运动学矩阵如果是差速调用差速逆运动学如果阿克曼调用阿克曼几何求解。算法输出每一个电机的目标转速。每一个电机独立转速 PID 闭环输出 PWM驱动电机。编码器读取每台电机真实转速。根据底盘类型调用对应底盘的正运动学算法把多台电机转速换算回整车三维速度作为里程计上传 RDK X5。关键工程要点 ✅上层 RDK X5 的 ROS2 接口统一永远下发 Twist (\(V_x,V_y,\omega\))。 ✅更换底盘上层代码完全不用修改仅仅修改 STM32 底层运动学算法即可。 ❌不同底盘不能混用一套运动学公式麦克纳姆公式直接套到差速小车运动完全错乱。现实缺陷打滑带来映射失效运动学矩阵建立在轮子和地面无滑动的理想假设。一旦轮子打滑电机编码器转速≠轮子对地真实速度。此时逆、正运动学映射全部失真。解决依靠 IMU 测量车体真实角速度补偿里程计误差。和 PID 的关系运动学算法只负责速度量之间的数学映射不做闭环控制。运动学输出电机目标转速之后交给每一路电机独立转速 PID 内环。可选上层 RDK X5 可以做整车外环 PID修正整车三维速度指令再送入运动学。运动学本身没有任何 PID 逻辑它只是数学转换工具。通俗比喻