简介:3-SPS/S踝关节并联式康复机器人设计是一篇来自《中国工程机械学报》2020年第3期的学术论文PDF,面向康复机器人、并联机构及医疗康复交叉领域的研究者与工程师。针对传统踝关节康复训练方式单一、训练时间不足等问题,文章提出一种3自由度转动的并联康复机器人,涵盖被动、主动和智能语音三种训练模式。内容系统介绍了3-SPS/S并联机构的机械结构,包括动平台、静平台、驱动杆支链和支撑杆,并开展运动学分析,推导位置、速度等参数;同时设计系统软件,搭建实验平台并进行多次测试,验证了方案的可靠性与安全性。论文附有中英文摘要、关键词和参考文献,适合作为课题调研、机器人机构设计或康复工程研究的参考文献。资源包仅1个PDF文件,大小3.96MB,已有123人学习浏览。此外,文中涉及机器学习、深度学习在康复数据分析和训练策略优化中的应用,对智能康复设备研发具有参考价值。 做踝关节康复机器人设计,最难的不是把电机转起来,而是想清楚“这个机构凭什么能贴合人体脚踝的运动规律”。前阵子我完整梳理了一版3-SPS/S并联式踝关节康复机器人的设计方案,从构型选型到运动学解算,再到样机调试踩坑,整个过程走下来感触很深。这篇就把这套设计的关键思路和实操细节整理出来,给正在做同类康复器械或者对并联机构感兴趣的朋友一个参考。

1. 需求倒推:为什么踝关节康复要选并联机构

1.1 踝关节的真实运动需求

踝关节是人体承重最大、受伤率也极高的关节之一。它不是一个简单的单轴铰链,而是由胫骨、腓骨和距骨构成的复合关节,运动学上通常抽象为三个转动自由度:跖屈/背屈、内翻/外翻、内收/外展。实际康复训练中,这三个自由度并不是独立出现的,更多时候是复合运动,比如跖屈伴随内翻,背屈伴随外展,这就对康复设备提出了多自由度耦合运动的要求。

康复医学上还有一个关键指标叫“持续被动运动”,也就是CPM(Continuous Passive Motion)。临床研究表明,术后早期进行持续的、可控范围的被动活动,能有效防止关节粘连、促进滑液分泌和软骨修复。这就要求康复机器人必须具备平稳、连续、可重复的运动轨迹输出能力,而且运动范围要精确可控,不能超出患者的安全界限。

1.2 串联机构在这里的先天短板

早期踝关节康复设备大量采用串联机构,比如多关节串联机械臂或者简单的单轴转动平台。串联机构的特点是每个关节都叠加在前一个关节的末端,导致越靠近基座的关节承受的负载越大,累积误差也越大。具体到踝关节康复场景,一个直接的问题就是:如果想实现脚踝的复合转动,串联臂的关节越多,整机的刚度就越差,运动末端的抖动就越明显,这对需要精细控制的康复训练来说是非常不利的。

另外一个问题是串联机构的驱动电机通常集中安装在关节处,导致运动部分惯量大,启动和换向时会有明显的冲击感。康复训练中患者本身就是受伤状态,这种冲击感会引发肌肉痉挛的反射,完全违背了康复设备应该“柔和、平顺”的基本原则。

1.3 并联机构的核心优势

并联机构恰恰在刚度、精度和动态响应上有着天然优势。它的特点是多个运动链同时连接静平台和动平台,负载被分散到多个支链上,结构刚度高、末端惯量小、误差不累积。3-SPS/S构型正是并联机构中既经典又适合踝关节康复的构型之一,三条SPS支链(球副-移动副-球副)提供驱动,中间一条S型或SPS型约束支链限制多余的自由度,最终让动平台实现三转动自由度。

这就像你用三根绳子同时拉一个圆盘,圆盘只能在空间中转动、不能平移,三根绳子的长度变化决定了圆盘的姿态。相比串联臂“一节一节推过去”的运动方式,并联结构更像“同时发力、协同控制”,动态响应更快、运动更平稳,对康复训练这种需要低冲击、高重复精度的场景尤为合适。

2. 构型方案的博弈:3-SPS/S凭什么胜出

2.1 几种常用踝关节康复构型的对比

在设计初期,我对比过几类主流方案:并联6自由度Stewart平台、3-RSS构型、2-UPS/U构型以及3-SPS/S构型。这里把对比结果整理成一个表格,方便直观感受各种方案的差异。

构型类型 自由度能力 结构复杂度 运动空间与踝关节匹配度 成本与维护 适用场景评估
6-SPS Stewart平台 6自由度(含平移) 高,6条驱动链 平移自由度冗余,控制复杂 高 过度设计,康复场景用不上那么多自由度
3-RSS 3转动 中等 转动范围较大,但奇异位形多 中等 可行,但运动学解算复杂
2-UPS/U 2转动1移动 中等 含一个移动自由度,与踝关节运动不匹配 中等 不太适合纯转动康复需求
3-SPS/S 3转动 中低 天然匹配踝关节三转动自由度 较低 针对性强,控制简单,性价比高

对比下来能明显看出,3-SPS/S构型的核心优势正是“少即是多”。它不追求多余的自由度,而是精确匹配踝关节的三个转动自由度,把中间那条约束链当成“定海神针”,把动平台的运动约束在一个可控的转动空间内,这既简化了控制算法,也提高了安全性。

2.2 3-SPS/S的约束逻辑与自由度分析

3-SPS/S构型中,三条SPS支链的移动副是主动驱动,球副提供三个方向的转动自由度。中间那条约束支链(通常是S型或SPS型)是整个机构设计的点睛之笔,它不承担驱动任务,而是专门用来约束动平台的移动自由度。

从螺旋理论的角度来理解,三条SPS支链本身并没有完全约束动平台的所有自由度,它们只是提供驱动力和部分约束。中间约束链的存在把动平台的三个平移自由度完全限制住,最终使得机构获得“纯三转动”的运动特性。

这里有一个关键设计细节:约束链本身也带有被动自由度,安装时如果不注意它的轴线布局,很容易产生“过约束”或者“欠约束”的情况。过约束会导致机构卡死或驱动负载异常增大,欠约束则会导致平台晃动、运动不精确。我在初版设计时就因为约束链的安装角度偏差,导致样机在特定姿态下出现了明显的卡顿,后来通过调整约束链的轴线方向才解决。

2.3 运动学建模的核心思路

运动学建模是整个设计中最烧脑也最基础的部分,分为位置逆解和位置正解两部分。位置逆解是“已知动平台姿态,求三条驱动杆的长度”,这个相对直观,通过空间向量运算就能解出。位置正解是“已知三根杆的长度,求动平台的姿态”,这个在并联机构中是个难点,因为会涉及到非线性方程组的求解。

我的实现思路是这样的:在静平台上建立基座坐标系{B},在动平台上建立工具坐标系{P},动平台姿态用欧拉角描述。每条SPS支链的球副中心点在两个坐标系中的坐标是已知的,杆长向量就等于两端球副中心点之间的空间向量,其模长就是该支链的当前长度。动平台姿态变化时,工具坐标系中的球副坐标要经过旋转矩阵变换到基座坐标系中,再与静平台球副坐标做差求模。

位置正解我没有追求解析解,而是用了牛顿-拉夫逊迭代法,以位置逆解模型为基础做数值求解。虽然迭代法会有一定的计算耗时,但在现代嵌入式平台上微秒级就能收敛,完全满足实时控制的需求。

3. 关键参数设计与计算要点

3.1 工作空间与杆长参数的联动设计

踝关节康复的运动范围有明确的临床参考值:跖屈约0°到45°,背屈约0°到20°,内翻约0°到35°,外翻约0°到25°。由于踝关节的复合运动通常是三个自由度耦合出现,设计中需要把这些范围合成一个三维转动空间,目标工作空间可以近似为一个锥角约45°至50°的锥形区域。

杆长的设计要和工作空间联动。初始杆长决定了动平台的中位姿态,而杆长的伸缩范围决定了动平台能转动的极限角度。以我设计的样机为例,初始杆长设定为250mm,驱动杆的有效行程为±40mm,经过运动学仿真验证,在这个参数下动平台在三个转动方向上均能达到临床要求的运动范围,且留有一定的安全余量。

这里有一个容易忽略的点:球铰的活动角度是有限的,通常标准球铰的活动范围在±25°到±30°之间。当动平台转动到极限位置时,杆端球铰的实际偏转角度很可能会超过球铰的允许范围,导致机构“卡死”或者球铰损坏。所以工作空间设计不能只看杆长,还要把球铰的允许偏角纳入约束条件,必要时选用大角度球铰或万向铰。

3.2 驱动方式选型与安全设计

驱动方式我对比过伺服电机+滚珠丝杠、电动推杆、气动肌肉三种方案,最终选了伺服电机+滚珠丝杠。核心原因是康复训练对运动控制精度和速度平稳性要求高,伺服电机在闭环控制下能提供精确的位置和力矩控制,滚珠丝杠则保证了传动的稳定性和自锁性。

驱动选型的计算并不复杂,关键在于踝关节康复力矩的估算。正常行走时踝关节峰值力矩约为1.5N·m/kg体重,康复训练时的目标力矩通常是日常活动的20%至50%。对于一个70kg的患者,康复训练所需的峰值力矩约在21N·m到52N·m之间,考虑传动效率和动态裕量,驱动单元的额定输出力矩至少需要设计到60N·m以上。

安全设计方面,我在每一条驱动支路上都加装了串联的力矩传感器,并在软件层面设置了双重保护:第一重是力矩软限位,当检测到阻力异常升高时系统立即停止运动;第二重是机械硬限位,在丝杠两端加装行程开关和机械挡块,即使软件失控也能把动平台的运动范围限制在安全区间内。这套“软硬结合”的安全策略在整个调试过程中非常关键,康复设备的安全性永远要放在第一位。

3.3 结构刚度的静力学分析

并联机构虽然整体刚度优于串联机构,但具体刚度值取决于结构参数和材料选择。我使用有限元分析软件对动平台、连接法兰和基座进行了静力学分析,重点考察在极限负载工况下的变形量。分析结果显示,采用铝合金6061-T6材质的动平台在60N·m负载下最大变形量为0.13mm,满足康复设备末端变形量小于0.5mm的设计指标。

这里有一点值得提醒:康复设备的结构刚度不宜设计得“过刚”。人在受伤状态下,脚踝与设备之间需要有一定的柔性缓冲,如果结构完全刚性,外部冲击会直接传导到患者脚踝上,反而造成二次伤害。所以我在踏板与动平台之间专门设计了一层聚氨酯弹性垫片,兼顾了精度和安全性。

4. 控制系统的层级设计与康复策略实现

4.1 控制架构:上位机-下位机-执行层

控制系统的整体架构分为三层:上位机、下位机和执行层。上位机是一台安装了Qt开发的人机交互界面的工业电脑,负责康复方案配置、运动轨迹规划、数据存储和实时状态显示。下位机是运动控制卡,负责接收上位机的轨迹指令,做插补运算后输出脉冲/模拟量给伺服驱动器。执行层是伺服电机和驱动器,按指令完成精确的位置或力矩控制。

三个层级之间通过EtherCAT工业以太网总线通信,周期为1ms。这个通信周期对于康复训练来说已经足够了,既保证了控制的实时性,也避免了频繁中断导致的系统不稳定。

4.2 三种康复训练模式的实现思路

康复训练的核心策略我设计为三种基本模式:被动模式、主动辅助模式和主动抗阻模式。

被动模式对应CPM训练,上位机预设运动轨迹(比如正弦波形式的跖屈-背屈往复运动),控制卡按轨迹执行位置控制,患者完全放松脚踝,由设备带动活动。这个模式的关键是速度曲线要平滑,加速度不能突变。

主动辅助模式引入力矩传感器,设备检测患者主动发力方向和大小,当患者主动发力时,设备沿着发力方向提供辅助力矩,帮助患者完成动作。这就好比有人扶着你骑车,你蹬得多快,他就跟着多快,而不是死板地按固定转速转。

主动抗阻模式则相反,设备施加与患者主动发力方向相反的阻力矩,让患者克服阻力完成训练,这个模式用于肌力恢复中后期。阻力的设定可以按百分比调节,比如从20%的峰值力矩开始逐渐增加。

4.3 阻抗控制算法的工程实现

为了让设备在主动模式下体现出“柔顺”的交互手感,控制上不能只用单纯的位置控制或力矩控制,而是要用阻抗控制。阻抗控制的核心思想是:不直接控制运动轨迹,而是控制“设备末端运动偏差与接触力之间的关系”,相当于让设备表现成一个“虚拟弹簧-阻尼系统”。

具体实现中,我采用的是基于位置内环的阻抗控制:内环是位置控制,保证运动精度;外环是阻抗控制,根据力矩传感器检测到的交互力矩,计算出位置修正量,叠加到内环的期望轨迹上。通俗地说,就是设备本来要走到A点,但患者用力推了一下,系统计算出应该顺着这个力退到A'点,退让的幅度取决于设定的虚拟刚度和阻尼系数。

调试阻抗参数时有一个经验值可以参考:虚拟刚度初设为200N/m,虚拟阻尼初设为10N·s/m,然后根据患者的反馈逐步调整。刚度太大会显得设备“硬邦邦”的,不柔顺;刚度太小则缺乏支撑感,患者感觉不到设备的助力。

5. 样机调试中的问题与避坑实录

5.1 球铰间隙带来的精度问题

第一次样机组装完成后,空载运行测试中就发现了一个问题:动平台在换向时有明显的“旷量”,位置误差达到了正负2毫米。排查后发现,根源在球铰间隙。标准球铰为了保证转动灵活性,内部滚珠和球壳之间必然存在一定的间隙,多个球铰的间隙叠加起来,反映到动平台上就是明显的误差。

解决办法是在软件层面做运动学标定:让设备按照网格路径运动,通过外部测量仪器(光学定位系统)记录实际末端位置与理论位置之间的偏差,建立一个误差补偿表,在控制中实时补偿。这套标定流程对康复设备来说非常实用,可以把间隙误差从正负2毫米压低到正负0.3毫米以内。

5.2 过约束与装配应力的问题

3-SPS/S机构在装配时如果三条支链的长度不一致,或者底座安装面不平整,会导致机构在初始状态下就存在内应力。这种内应力在运动时会表现为某个方向的驱动杆负载异常增大,甚至出现抖动。

要解决这个问题,首先在机械加工阶段要严格控制安装面的平面度误差,装配时使用专用对中工装,确保三根支链的初始位置在理论位置的误差允许范围内。每次装配完成后要做一次完整的运动学标定,确认三根驱动杆的初始长度偏差在正负0.05毫米以内,才能进入调试环节。

5.3 力传感器数据滤波的取舍

力传感器在康复设备中用来检测患者交互力,但原始信号中混有高频噪声和机械振动成分。直接使用原始信号会导致控制量波动,严重时系统会啸叫或者震荡。我在控制回路中加入了二阶巴特沃斯低通滤波器,截止频率设定为20Hz。

滤波宽度的取舍很讲究:截止频率太高,噪声滤不干净;太低,又会滤掉真实力的快速变化成分,导致设备响应迟钝。以踝关节康复为场景,人脚踝主动用力的频率通常在0.5Hz到2Hz之间,冲击性力的频率也不超过5Hz,所以20Hz的截止频率既保留了有效力信号,又滤掉了大部分机械噪声,实测下来的控制平稳性提升非常明显。

5.4 康复训练中的力上限策略

最后分享一个临床上反馈回来很有价值的经验,就是康复训练力矩上限的渐变策略。受伤初期的患者,其耐受极限远低于正常值,如果设备设定一个固定的力矩上限,既可能不够灵敏,也可能在患者出现疼痛时来不及保护。

最终的方案是:力矩上限不固定,而是根据患者一段时间内的运动能力和疼痛反馈动态调整。比如,设备每完成一个训练周期,自动评估该周期的最大主动力矩和最大被动耐受力矩,以这个数据的80%作为下一周期的新上限,并设置一个整体硬上限来兜底。这种“阶梯式增量”的策略既保证了训练强度循序渐进,也给患者持续带来康复信心。

6. 从样机到产品的几个易错点提醒

6.1 电气走线与运动干涉

并联机构运动时,动平台上的线缆随动平台摆动,如果走线不合理,很容易出现线缆被拉断或者卡进运动副的问题。我见过不少样机在这个问题上栽跟头,轻则控制系统突然失灵,重则线缆被绞进丝杠直接烧毁电机。

建议采用螺旋电缆或者拖链方式布线,并在动平台和基座之间预留足够的运动余量。所有线缆要沿静平台方向固定,不允许悬空摆动,尤其不能靠近驱动杆的运动平面。试运行前务必做全行程的干涉检查,确保各姿态下线缆都不会与其他零件接触。

6.2 球铰的润滑与磨损

球铰是3-SPS/S机构中维护频率最高的零件,频繁转动下润滑脂容易干涸,导致转动阻力增大、精度下降。建议每500小时运行时间给球铰补充一次润滑脂,选择宽温域的锂基脂。如果使用环境粉尘较大,还要考虑加装防尘罩,否则球铰寿命会大幅缩短。

6.3 紧急停止按钮的布局

康复设备涉及医疗安全,急停按钮不能只安装在控制柜上。我的设计最终在操作面板、设备基座靠近患者侧、以及手持遥控器三个位置都安装了急停按钮,任何一个按钮按下,系统都会以最快速度切断伺服电机的动力输出,同时刹车使动平台停在当前位置。这个细节在临床试用中非常重要,有时候治疗师正站在患者对侧,如果只有控制柜上有急停,手根本够不到。

这套3-SPS/S踝关节康复机器人的设计,从构型分析到样机落地,最深的体会就是:并联机构不是越复杂越好,而是越贴合需求越好。3-SPS/S的构型给两自由度以上的康复训练提供了一个精度、成本、安全三者平衡得很好的方案。后面对这套样机,我打算在轨迹规划算法上引入自适应学习能力,根据患者每一次训练的回馈数据自动优化下一次的运动参数,让设备真正“懂”患者的康复节奏。

本文还有配套的精品资源,点击获取 menu-r.4af5f7ec.gif

Logo

DAMO开发者矩阵,由阿里巴巴达摩院和中国互联网协会联合发起,致力于探讨最前沿的技术趋势与应用成果,搭建高质量的交流与分享平台,推动技术创新与产业应用链接,围绕“人工智能与新型计算”构建开放共享的开发者生态。

更多推荐