2. 医疗场景空间与坐标系建模

医疗机器人导航与定位的核心任务，可以概括为一句话：把“病灶在影像里的位置”变成“机械臂末端在手术室里应该到达的位置”。这条链路之所以复杂，是因为它跨越了多个彼此独立的物理空间与数字空间。为了让每个空间中的位置都能被唯一、无歧义地描述，工程上引入了一套坐标系体系：世界坐标系、机器人坐标系、患者坐标系、影像坐标系、工具坐标系。理解它们的定义与转换关系，是后续配准、注册、误差分析与安全控制的全部基础。

一、五个坐标系的定义与物理含义

世界坐标系（World Frame，{W}）是手术室的全局参考系，通常固定在手术床基座、地面标记点或光学跟踪系统（如NDI Polaris）的自身坐标系上。它的作用是给手术室内所有设备提供一个公共的“绝对”参照。例如光学定位系统输出的反光球位置，默认就是在世界坐标系下表达的。世界坐标系一旦选定，在整个手术过程中不应移动；若必须移动跟踪设备，则需重新标定。

机器人坐标系（Robot Frame，{R}）是机器人本体的基座坐标系，原点通常位于机械臂底座中心，Z轴沿底座法线向上，X、Y轴按右手定则定义。机器人控制器内部所有关节角、末端位姿的运算，最终都归结到{R}下。机器人正运动学给出的末端位姿 ^R T_E，就是工具末端在机器人坐标系下的表达。

患者坐标系（Patient Frame，{P}）是绑定在患者解剖结构上的坐标系，原点常选在某个骨性标志点或术前粘贴的跟踪标记点（如患者示踪器/动态参考基DRB）上。它的意义在于：患者呼吸、体位微动时，{P}随患者一起运动，从而保证“病灶相对于患者”的位置关系不变。这是动态跟踪能够补偿患者运动的关键。

影像坐标系（Image Frame，{I}）是CT/MRI/CBCT体数据自身的坐标系，原点一般在体数据的第一层、左上角体素处，单位是体素（voxel），需要乘以体素间距（如0.7 mm×0.7 mm×1.0 mm）才能换算为毫米。影像坐标系是医生勾画靶区、规划进针路径的工作空间。

工具坐标系（Tool Frame，{T}）定义在手术器械或机械臂末端执行器上，原点常取在针尖、钻头尖端或工具中心点（TCP），Z轴沿工具轴线指向。工具坐标系决定了“机器人末端到达哪里”与“针尖实际到达哪里”之间的对应关系，是精度链的最后一环。

二、转换关系的数学表达

任意两个坐标系之间的空间关系，都可以用一个4×4齐次变换矩阵 ^A T_B 表示，其含义是“把B坐标系下的点变换到A坐标系”。矩阵由旋转部分 R（3×3）和平移部分 t（3×1）组成：

^A T_B = [ R(3x3)   t(3x1) ]
         [ 0 0 0      1    ]

点变换： p_A = ^A T_B · p_B

导航系统的完整变换链为：^R T_T = ^R T_W · ^W T_P · ^P T_I · ^I T_target · (^T T_tip)⁻¹。其中每一段的来源不同：^P T_I 来自影像与患者的配准（点对点或面配准）；^W T_P 来自光学跟踪系统对患者示踪器的实时测量；^R T_W 来自机器人手眼标定；^T T_tip 来自工具标定。任何一段出错，都会直接反映为末端定位偏差。

三、各转换环节的实现方式与示例参数

影像—患者配准（^P T_I）：常用方法是术前在患者体表粘贴4～6个标记点，在CT中识别其影像坐标，术中再用探针在患者身上依次触碰同名点，得到两组对应点集，用SVD求解刚体变换。示例：某颅脑手术中，6个标记点的配准残差（FRE）为0.62 mm，则 ^P T_I 的平移分量约为 (12.4, -35.8, 88.1) mm，旋转分量接近单位阵（患者体位与影像体位基本一致）。若FRE超过1.5 mm，应重新贴点或检查标记点识别是否正确。

患者—世界跟踪（^W T_P）：光学相机以约30～60 Hz输出患者示踪器上反光球的三维坐标，实时解算 ^W T_P。当患者呼吸导致胸壁起伏时，该矩阵的平移分量会周期性变化，幅度可达3～8 mm。导航软件正是利用这一实时变化，把规划好的靶点从静态影像空间“搬”到动态患者空间。

世界—机器人手眼标定（^R T_W）：将标定板或标定针固定在机械臂末端，让机器人走多个位姿，同时用光学系统测量标定物，求解 AX=XB 方程。示例：某协作臂手眼标定后，^R T_W 的平移为 (820.5, -120.3, 450.0) mm，旋转为绕Z轴约90°。标定残差通常要求小于0.5 mm。

工具标定（^T T_tip）：采用“四点法”或“六点法”，让针尖固定于空间一点，机器人变换多个姿态，反解出针尖在末端法兰坐标系下的位置。示例：某穿刺针标定结果为针尖偏移 (0, 0, 182.6) mm，即针尖沿工具Z轴伸出182.6 mm。

四、工程实践中的关键约定与常见问题

实际调试中，最常见的三类问题：一是配准点选取不当，如标记点共线或集中在同一平面，导致旋转分量病态，表现为远离标记点的区域误差急剧放大；二是患者示踪器松动，^W T_P 看似正常但实际已漂移，可通过在固定解剖点重复触碰来验证；三是工具标定后更换针头而未重新标定，^T T_tip 失效，针尖实际位置与计算位置相差数毫米。