4. 空间映射核心概念
在 VR 机械臂遥操作中，用户手部的运动并不会“自动”变成机械臂末端的运动。中间必须经过一套明确的空间映射过程：先定义坐标系，再确定手部追踪空间与机械臂工作空间，然后通过映射函数把位置与姿态从人体侧转换到机器人侧，最后用尺度变换和位姿对齐保证操作自然、安全、可控。理解这条链路，是后续实现稳定遥操作的根基。
一、坐标系定义：一切映射的起点
空间映射的第一步不是写公式，而是把“谁在哪个坐标系里说话”定义清楚。VR 遥操作通常至少涉及四个坐标系：
- 世界坐标系（World）：VR 场景的绝对参考系，头显、手柄、手部追踪数据最终都统一到该坐标系。
- 头显/用户坐标系（HMD/User）：以用户头部或初始朝向为参考，用于判断“用户面向哪里”。
- 手部追踪坐标系（Hand）：由手部追踪设备或视觉算法输出，描述掌心、指尖、关节的位置与朝向。
- 机械臂基坐标系（Robot Base）：机械臂安装底座的原点，所有关节角和末端位姿都相对它计算。
如果这些坐标系没有统一，常见现象是：手向前推，机械臂却向侧面走；手旋转 90°，机械臂末端姿态完全错乱。因此，映射前必须完成坐标变换链：Hand → World → Robot Base，并明确每个变换的平移向量与旋转矩阵。
二、手部追踪空间与机械臂工作空间
手部追踪空间是用户手部可被稳定追踪的三维区域，通常是一个以头显或传感器为中心的锥形/球形范围。它受限于摄像头视场、遮挡、追踪算法延迟和手部关节可见性。典型的手部追踪空间在用户前方 0.2～0.8 米、左右约 ±0.4 米、上下约 ±0.3 米内较为可靠。
机械臂工作空间则是机械臂末端能够到达的所有位姿集合，由连杆长度、关节限位、奇异点和碰撞约束共同决定。它可能是一个球形、环形或带缺口的复杂体积。两者在尺度、形状和可达性上往往差异巨大：人手移动 30 厘米，机械臂可能需要移动 1 米；人手可以轻松翻转手腕，机械臂腕部却可能接近关节限位。
三、映射函数：从手部位姿到末端位姿
映射函数可以形式化表示为：给定手部位置 p_h 和姿态 R_h，输出机械臂末端目标位置 p_r 和姿态 R_r。最常见的是绝对映射与相对映射。
- 绝对映射：手部在追踪空间中的绝对位置直接对应机械臂工作空间中的绝对位置。优点是直观，缺点是手部微小抖动会直接传到机械臂，且用户必须保持手在追踪范围内。
- 相对映射：以按下扳机或捏合瞬间的手部位姿为参考，之后手部的位移增量映射为机械臂末端的位移增量。优点是抗抖动、可离合、适合大范围操作，是遥操作中最常用的方式。
相对映射的简化公式如下：
Δp_h = p_h(t) - p_h(t0)
ΔR_h = R_h(t) · R_h(t0)^T
p_r(t) = p_r(t0) + S · Δp_h
R_r(t) = ΔR_h · R_r(t0)其中 S 是尺度变换矩阵，t0 是离合参考时刻。该公式说明：机械臂末端的目标位姿由参考位姿加上手部增量变换得到，而不是直接复制手部绝对位姿。
四、尺度变换与位姿对齐
尺度变换解决“手小臂大”的问题。若人手移动 10 厘米，机械臂末端移动 50 厘米，则尺度因子为 5。尺度因子可以各向同性，也可以各轴独立设置。各向同性更自然，各轴独立则适合工作空间形状不规则或需要限制某一方向灵敏度的场景。
位姿对齐解决“方向不一致”的问题。用户手部朝向与机械臂末端工具朝向之间通常存在一个固定旋转偏移 R_offset。对齐的目标是让用户感觉“手往哪转，工具就往哪转”。常见做法是：在离合瞬间记录手部姿态与末端姿态，计算偏移矩阵，之后保持该偏移不变。
R_offset = R_r(t0) · R_h(t0)^T
R_r(t) = R_offset · R_h(t)如果忽略位姿对齐，用户会感到工具“不听话”，尤其在抓取、插入、拧转等精细任务中，操作成功率会显著下降。
五、映射参数与典型取值参考
| 参数 | 含义 | 典型取值/建议 | 影响 |
|---|---|---|---|
| 尺度因子 S | 手部位移到末端位移的比例 | 1.0～5.0，精细任务取小值 | 越大越省力，但精度和稳定性下降 |
| 死区阈值 | 手部抖动过滤范围 | 2～5 mm | 过小抖动明显，过大操作迟钝 |
| 姿态偏移 R_offset | 手部与末端工具的固定旋转差 | 离合时自动计算 | 决定工具朝向是否直观 |
| 离合模式 | 相对映射的参考重置方式 | 扳机/捏合触发 | 影响大范围操作和重复定位 |
| 工作空间限幅 | 末端目标位置的安全边界 | 按机械臂可达范围内缩 5%～10% | 防止奇异点和碰撞 |
六、案例场景：抓取桌面零件
假设用户需要遥操作机械臂抓取桌面上一个零件。手部追踪空间中心在用户胸前，机械臂基座在桌面一侧。操作流程如下：
- 用户按下扳机，系统记录手部参考位姿
p_h(t0), R_h(t0)和末端参考位姿p_r(t0), R_r(t0)。 - 用户手向前移动 8 厘米，尺度因子设为 3，则末端目标向前移动 24 厘米。
- 用户手腕轻微旋转，系统通过
R_offset将旋转传递到末端工具，使夹爪对准零件。 - 用户松开扳机，映射暂停；重新按下时以新位置为参考，避免手部超出追踪范围。
- 接近零件时，系统启用限幅和速度缩放，防止末端撞击桌面。
这个案例说明：映射不是单一公式，而是“坐标系 + 空间 + 函数 + 尺度 + 对齐 + 安全约束”的组合。
七、常见误区与复盘
误区二：只做位置映射，忽略姿态对齐。结果：工具方向与手部方向不一致，精细操作几乎无法完成。
误区三：尺度因子全程固定且过大。结果：接近目标时分辨率不足，容易过冲或碰撞。
误区四：不做工作空间限幅。结果：末端目标超出可达范围，逆解失败或触发奇异点。
复盘时建议按以下清单逐项检查：坐标系是否统一？离合参考是否在按下瞬间正确记录？尺度因子是否可调？姿态偏移是否在离合时更新？限幅和速度缩放是否生效？只有这些环节都明确，空间映射才能从“能动”走向“好用”。
总结来看，空间映射的核心不是某一个公式，而是一条完整链路：坐标系定义 → 手部追踪空间 → 机械臂工作空间 → 映射函数 → 尺度变换 → 位姿对齐 → 安全约束。只有每一环都清晰可控，VR 遥操作才能既自然又可靠。