D · 基座、机械臂与末端探头
基座围绕世界Y轴偏航，机械臂绕自身肩部的局部Z轴俯仰，探头跟随机械臂运动。重点是“父矩阵 × 局部矩阵”。
初始化中…
试验顺序：先只改变基座角度，确认所有部件跟随；再只改变肩部角度，确认基座不变而探头随动。
坐标层级
M_base=T(basePos)·Ry(yaw)是基座位姿，不带几何缩放。M_shoulder=M_base·T(0,h,0)·Rz(pitch)是肩部关节位姿。- 臂段绘制矩阵和末端部件矩阵分别由关节位姿计算；避免把臂段的非均匀缩放传给末端部件。