Page 35 - 《中国医疗器械杂志》2026年第2期
P. 35

Chinese Journal of Medical Instrumentation                                         2026年 第50卷 第2期

                                                     医   疗   机   器   人



                  实验平台的控制系统主要包括上位机PC、主                              (2)针对任意位姿下的骨折状态,对骨折复
              控制器、传感器组合、电机驱动器、电磁阀组等模                            位机器人的关节轨迹采用五次非均匀B样条曲线进
              块。主控制器选用意法半导体(STMicroelectronics)                 行规划。
              生产的STM32F103ZET6作为主控芯片;通过Keil                         (3)按照临床复位操作控制关节工作的启停
              uVision5集成开发环境,将控制算法、路径规划逻                        时间,原则为:①开始时刻,由于绕股骨周向的旋
              辑、电机及电磁阀驱动指令、传感器信号采集等相                            转和沿股骨轴向的牵引互不干涉,牵引机构和绕股
              关嵌入式代码编译后,烧录至该主控芯片中。系统                            骨周向旋转机构同步工作;②第50 s时,即骨折断
              运行后,主控制器将驱动信号发送给各电机驱动器                            端过牵后,柔性夹持装置的侧位气囊开始工作;
              和电磁阀,从而控制电机的运动和软体驱动器的充                            ③第75 s时,柔性夹持装置的正位气囊开始工作。
              放气动作。                                                 (4)复位完成后,保持机器人各驱动器的输
                  传感器组合构成机器人状态监测系统。检测旋                          出量,以维持骨折远端位姿。
              转关节角度采用维特智能科技有限公司JY901S                               机器人关节位置跟踪曲线对比如图10所示,机
              型号的IMU传感器和电机内部的光电编码器,可实                           器人末端x轴相对位姿如图11所示。由图10可知,
              现旋转自由度的位置闭环;激光位移传感器检测直线                           在相同肌肉收缩力的3次复位实验中,机器人各关
              位移,采用KEYENCE公司的IL-300,用作移动                        节能按照预定的复位顺序运行,并最终跟踪所规划
              自 由 度 的 位 置 闭 环 ; 气 压 信 号 采 集 模 块 选 择             的轨迹;在100 s时,各关节达到指定的复位位
              MCP-H10系列表压型气压传感器;拉力传感器选                          置,随后保持复位状态直至实验结束。值得注意的
              择ZNLBS-I-100KG型号,用于采集沿股骨干轴向                       是,每次实验的人为因素和曲线规划的差异,即过
              的牵引力。                                             牵距离不完全一样,导致牵拉力峰值有所区别。
                  在状态监测系统中,绕股骨周向旋转机构的电                             280          目标值 实际值  15           目标值 实际值
                                                                              138 N                  138 N
                                                                  270         139 N      10          139 N
              机编码器信息作为角度反馈信号;外上踝处的IMU                                         137 N      5           137 N
              传感器作为末端姿态信息,其y轴和z轴姿态作为柔                             位移/mm  260            角度/(°)  0
                                                                  250
                                                                                         −5
              性夹持装置位置控制的参考信号,x轴姿态作为相                              240                   −10
              对参考角度;牵引机构处固定的位移传感器作为关                              230 0  20  40  60  80  100  120  −15 0  20  40  60  80  100  120
                                                                            时间/s                  时间/s
              节控制的反馈信号,外支撑架位移传感器作为末端                                    (a) 关节3跟踪曲线           (b) 关节4跟踪曲线
                                                                     (a) Tracking curve of joint 3  (b) Tracking curve of joint 4
              沿x轴的相对参考信息。
                                                                  120           目标值 实际值  96           目标值 实际值
                  另外,股骨断端的正向和侧向移位由骨髓腔中                                        138 N                  138 N
                                                                  110         139 N      94          139 N
              置入的内窥镜进行可视化监控,内窥镜与PC终端                              100         137 N      92          137 N
              直连,复位完成后通过内窥镜图像计算正位和侧位                              角度/(°)  90            角度/(°)  90
              误差。                                                  80                    88
               3.2    股骨干骨折复位模拟实验                                  70 0  20  40  时间/s  80  100  120  86 0  20  40  时间/s  80  100  120
                                                                             60
                                                                                                   60
                                                                                              (d) 关节6跟踪曲线
                                                                        (c) 关节5跟踪曲线
               3.2.1    实验步骤                                         (c) Tracking curve of joint 5  (d) Tracking curve of joint 6
                  机器人的电机位置控制易于实现,难点是气动                                图10   相同肌肉收缩力下关节位置跟踪对比图
              柔性驱动技术。该技术用于断端复位,是一种软接                             Fig.10  Comparison of joint position tracking under the same muscle
                                                                                  contraction force
              触(气囊和人工肌肉间接驱动骨折断端)的操作方                               25                    60
                                                                  20              目标值                 目标值
                                                                                  实际值138 N
                                                                                                      实际值138 N
              式。由于柔性驱动单元具有明显的非线性特征,因                              15              实际值139 N  50        实际值139 N
                                                                  10              实际值137 N  40        实际值137 N
              此在控制系统设计中需重点考虑。借鉴外科医生临                              角度/(°)  5 0            位移/mm  30
                                                                  −5
              床复位操作方法,本文将自动牵引旋转复位装置的                              −10                    20
                                                                  −15                    10
              牵引机构设为自动控制,而另外两个方向的定位则                              −20
                                                                  −25
                                                                   0  20  40  60  80  100  120  0  20  40  60  80  100  120
              在实验前预先调整。                                                     时间/s                  时间/s
                                                                        (a) 绕x轴相对角度           (b) 沿x轴相对位移
                  开展骨折复位模拟实验前,根据临床复位手术                                (a) Relative angle around  (b) Relative displacement along
              方法规划实验操作步骤,详述如下。                                            the x-axis             the x-axis
                  (1)手动完成骨折复位,记录复位状态下的                                    图11   机器人末端x轴位姿变化情况
                                                                Fig.11  Variation of the end-effector's position and orientation along the
              传感器信息,随后将骨折远端恢复至任意状态。                                                  x-axis
                                                             149
   30   31   32   33   34   35   36   37   38   39   40