是 crisp_controllers 中的笛卡尔导纳控制器。它基于 ROS2 control 和 Pinocchio，输出关节力矩指令（effort），实现导纳外环 + 阻抗内环的双层控制结构。与纯阻抗控制器不同，导纳控制器通过 F/T 传感器测量外部力/力矩，驱动一个虚拟质量-弹簧-阻尼系统，生成“让步后的内部参考位姿”，再由阻抗内环跟踪该位姿。其核心目标是让机器人在外力作用下表现出柔顺的导纳

量是否恒定数学原因p˙\dot{p}p˙​✅LERP 是线性函数ωb\omega_bωb​✅指数映射保持生成元不变ωs\omega_sωs​✅绕固定轴旋转不改变轴方向插值方式角速度均匀？无奇异性？结果合法？四元数 SLERP✅✅✅旋转矩阵线性插值❌✅❌（需正交化）欧拉角线性插值❌❌（万向锁）⚠️（一般情况合法）p˙常数ωb常数ωs常数。

是一个基于 ROS2的力矩控制器。通过向每个关节发送力矩命令effort；通过读取关节位置、速度、力矩；使用 Pinocchio 进行正运动学、雅可比和惯性矩阵相关计算；根据外部/目标关节力矩tau_ext_生成力反馈项；支持冗余自由度零空间控制，使机器人可以在不影响末端任务的前提下调整关节构型；将最终关节力矩通过J^T映射为笛卡尔 wrench 并发布。

以QP为例，嵌入式C++与C的浅显区别

matlab状态机stateflow生成C语言代码解析

也就是说这两者本质上都是状态机，他们都是在描述一个事物的发展过程，都是对现实事物发展的一种抽象。状态机是描述一个过程的手段，一般在编程中使用有限状态机（FSM）。Simulink仿真其实就是在模拟事物发展的过程，其实每个模块都是一个状态机。Mealy机与Moore机的区别在于是否有feedthrough。里面的状态分为了离散状态和连续状态。