打印
[STM32F1]

STM32控制假肢

[复制链接]
楼主: goodluck09876
手机看帖
扫描二维码
随时随地手机跟帖
21
goodluck09876|  楼主 | 2019-7-2 12:57 | 只看该作者 |只看大图 回帖奖励 |倒序浏览
    步态周期中,支撑相中的三种状态对行走的作用是非常重要的。其中,控制拓屈是
同一侧脚着地的过程,从后脚跟着地开始,足弓绕躁关节产生踌屈运动,直到同一侧前
脚掌着地。控制背屈是旋转人体的过程,此时另一侧脚跟即将离地,使人体完成了重心
的前移。动力踢屈是升高人体重心的过程,是同一侧脚跟离地到其脚掌完全离地的过程。
摆动相占据步态周期的40%左右,摆动的状态是为了保持平衡,角度的变化是得到一定
的背屈角度,为了下一个支撑相做准备。
    躁关节的角度与力矩是踩关节生物力学特性中最重要的特征参数,这两个参数也是
躁关节控制系统重要的控制对象。踩关节角度与力矩构成的阻抗曲线,可以把踩关节的
刚度与能量变化表示出来,阻抗曲线的斜率对应的是踩关节的刚度,而踩关节阻抗曲线
所围成区域的内部面积代表了在一个步态周期内踩关节输出的净能量,为踩关节假肢结
构的设计提供了重要参数。
    如图2.3所示,该曲线表示的是一位体重为75Kg的正常人体在行走速度为1.25m/s
下水平自由行走的躁关节角度力矩曲线[30-31 ],曲线的四个分界点将整个步态划分成了若
干个子阶段,这四个点分别代表了脚跟着地、脚掌着地、最大背屈、脚尖离地四个步态
姿态,也是步态转变的临界点,对应的将步态分成了控制l}J屈、控制背屈、动力拓屈、
摆动阶段四个步态阶段。1-} 2阶段是控制蹈屈,此阶段主要是角度的变化,力矩比较小,
阻抗较小;2-} 3阶段是控制背屈,此时身体重心现上升后下降,脚踩中的一些肌肉群把
一部分的重力势能转化成弹性势能储存起来,在这个过程中,斜率变大则对应的刚度有
一个增大的过程,在3点对应的时刻,此时躁关节输出的力矩最大为150 Nm;  3-}4阶
段是动力蹈屈,这时脚躁将上一阶段储存的弹性势能释放,同时骨骼肌做功补充额外的
能量将人体向前向上推动,完成迈步动作;4--1阶段是摆动状态,对应的是角度的变化,
力矩为零。

使用特权

评论回复
22
goodluck09876|  楼主 | 2019-7-2 12:57 | 只看该作者
    从上图中还可以看出,躁关节控制拓屈阶段,曲线类似于一根直线,斜率几乎不变,
说明此阶段内,踩关节的刚度几乎不变。从2到3的背屈阶段(CS CD),曲线斜率逐渐
变大,踩关节刚度不断变大,直到踩关节角度达到最大背屈位置,这个过程中,阻抗不
断变大,也是一个能量不断储存的过程,为下一个邸屈前移步态提供能量。从最大背屈
角度3到脚尖离地4这个过程为动力拓屈步态,曲线斜率逐渐下降,踩关节刚度逐渐变
小,能量不断释放,使身体重也前移,其正负的变化只与踩关节顺时针逆时针方向有关,
与数值大小无关,此点也在前面做过说明。从脚尖离地回到脚跟着地,完成空中摆动状
态,进入下一个周期,从图中可看出这个阶段是没有力矩曲线的,这个阶段内足趾不与
地面接触,没有与地面相互力的作用,但是有踩关节的转动。

使用特权

评论回复
23
goodluck09876|  楼主 | 2019-7-2 12:58 | 只看该作者
    传感器系统用于测量假肢控制中需要的反馈信号和反应假肢状态的信号,由于假肢
控制需要角度的反馈和力矩的反馈,所以需要角度传感器和力矩传感器测量跺关节假肢
的角度和力矩,另外假肢的状态需要通过假肢与地面的接触情况进行判定,所以需要在
脚底安装压力传感器。传感器的选型与使用中应遵循以下要求:
    第一,传感器应该具有较高的精度和足够的灵敏度,可以得到准确稳定的信号量,
根据控制需求,需要检测的物理量包括脚底与地面的接触情况,踩关节的实时角度,踩
关节的力矩等对应的传感器。脚底与地面的接触情况应采用压力传感器,并且要求压力
传感器体积小,重量轻,因为只需要一个接触或者不接触的判断,所以要求传感器体积
较小,精确度较低,对是否接触的信号比较敏感。在传感器的线性范围内,传感器的灵
敏度应该足够高[[33],人体行走过程中,踩关节角度的控制应该误差在士0.5“之间,因
此要求角度的灵敏度应该高于此值,另外还要注意传感器本身要有一定的信噪比,要尽
量减少外部噪音的干扰。
    第二,传感器应具有足够的线性范围满足控制的需求,传感器的线形范围是指输出
与输入成正比的范围[34]。传感器测量范围应该要满足需求的测量范围,包括踩关节运动
的角度范围与力矩需求的范围,其中人体的踩关节运动范围应该在60“左右,力矩的测
量范围要在200Nm之内。在测量范围以内要求传感器的灵敏度为定值,由于人体踩关
节的运动时周期性的,所以线性范围内的往复误差不能过大,要保证一定的测量精度。

使用特权

评论回复
24
goodluck09876|  楼主 | 2019-7-2 12:58 | 只看该作者
    第三,传感器的输出信号在需要的频率范围以内要不失真。人体的运动周期频率为
l OHz}3s}以内,因此要求传感器的响应时间不能过长,应该在0.02s以下。另外,传感器
应具有足够的稳定性,尤其是足底的传感器,尤其足底的传感器要经常被人体踩压,这
种周期性的采用可能会影响判断人体与地面的接触情况,所以采用的压力传感器要有足
够时间内的稳定性,另外也需要考虑合理的安装结构,保证足底的压力传感器在使用了
一段时间后,相同压力下的传感器反应出的物理量变化不大。

使用特权

评论回复
25
goodluck09876|  楼主 | 2019-7-2 12:59 | 只看该作者
    假肢的运动控制中既有力矩的控制,也有位置的控制。伺服系统具有稳定性好、精
度高、动态响应快、抗干扰能力强等特点,采用伺服系统,可以使输出快速而且准确[[36-37]0
因此在本系统中的伺服系统应该具有以下几个特点:第一,功率放大器,躁关节假肢的
最大输出功率为200W,所以功率放大器应不低于这个指标,另外由于人体运动的主动
J性,功率放大器应具有逆变的功能。第二,控制器,由于控制器要安装在假肢上,所以
控制器的体积和重量都应该较小一些。控制器一方面作为信号采集处理器,对输入的物
理信号进行分析处理,具有多通道模数转换的功能,并且具有较高的采样频率以达到信
号的采集;另一方面作为电机控制器,控制器还是可以实现算法的编程,执行高水平算
法,可以把算法的结果转换成脉宽调制波形输出,从而实现电机的控制。第四,电机的
要求,电机的尺寸与重量应与人体足部相匹配,应选择能量密度较高的电机,极限输出
功率应大于人体的最大功率需求。
    为了实现动力跺关节假肢机构与穿戴者肢体的运动控制,拟研制的主被动踩关节假
肢机构需要对人体所在的步态进行判断,根据不同的步态输出不同的动作。这就需要建
立一种合理的控制算法,第一层算法需要处理各个传感器的信息,包括脚底与路面的接
触情况,躁关节的角度,与跺关节的力矩,根据这些信息,判断人体所处的状态,选择
要执行的动作;第二层算法,就是将要执行的动作完成好,达到假肢与人体的柔顺祸合,
要执行的动作包括力矩伺服控制模块和角度伺服控制模块组成,该层算法可以输出人体
需要的力矩与角度,是人体走路变得更加柔顺舒适。该状态机亦需具有良好可拓展性,
以便在今后添加其他运动模式,如上下楼梯等。通过以上分析可以得到,跺关节假系统
的结构如下图2.4所示:

使用特权

评论回复
26
goodluck09876|  楼主 | 2019-7-2 13:00 | 只看该作者
    机械系统与穿戴者通过物理祸合协同运动,传感器系统将机械系统目前的状态,包
括转角、转矩和假肢与地面的接触情况反馈到控制器,控制器通过控制算法实现控制输
出,将控制指令发给伺服驱动器,从而驱动机械结构的运动,最终实现人体的行走。

使用特权

评论回复
27
goodluck09876|  楼主 | 2019-7-2 13:00 | 只看该作者
    踩关节假肢样机的机械结构要具有人体踩关节的特性,既具有被动式假肢能量储存
的被动性,也应该具有能力补偿的主动性。整体结构要与人体跺关节与足弓的重量体积
类似,并可以提供蹈屈背屈自由度。为满足踩关节的阻抗需求,将采用弹性执行器,从
而使人体行走时的步态更加柔顺。本文结合已有的研究基础,通过对机构优化与改进,
研制出了新一代假肢试验样机。

使用特权

评论回复
28
goodluck09876|  楼主 | 2019-7-2 13:00 | 只看该作者
    踩关节假肢样机的设计目标是输出一个矢状平面上的自由度,满足}7屈背屈运动,
所以只要使用一个电机作为动力即可。为了使假肢整体构型中结构紧凑,重量轻化,在
传动系统的设计中,选择了同步带轮加滚珠丝杠的模式,而不是质量较高的减速器。另
外外壳材料的选择中都应该以轻量化为目标,采用了铝制构架。在能量储存元件与弹性
的选择上也都应该尽可能的轻便,在原有的研究基础上[[38-39),优化的躁关节假肢整体结
构如图3.1所示。

使用特权

评论回复
29
goodluck09876|  楼主 | 2019-7-2 13:00 | 只看该作者
    从图中可以得知踩关节假肢机构主要由电机,同步带轮传动带、滚珠丝杆、串联弹
簧、并联弹簧、足部和机架组成。其运动形式如下:直流伺服电机转动通过同步带轮减
速后传动到滚珠丝杠,滚珠丝杠转动带动丝杠上的螺母,螺母上下运动会带动螺母上的
串联弹簧一起上下运动,从而产生足部绕机架的旋转,这就是拓屈背屈运动。在力矩的
传递中,电机输出转矩带动滚珠丝杠传动,推动串联弹簧产生绕躁关节的转矩组成了串
联弹簧执行器。其中电机相对于机架也会有一定的旋转,否则会产生运动的干涉。

使用特权

评论回复
30
goodluck09876|  楼主 | 2019-7-2 13:01 | 只看该作者

使用特权

评论回复
31
goodluck09876|  楼主 | 2019-7-2 13:02 | 只看该作者
    小腿连接杆处处的设计是为了和连接人体的套筒的连接,另外在正常人穿戴试验中
也是为了连接在人体上的穿戴设备。在假肢前侧的并联弹簧设计成Q型,这样的形状是
用于串联弹簧挤压时能量的储存。该并联弹簧上端与机架固定,下端连接一个滚轴,滚
轴两段装有两个滚动轴承,S2型并联弹簧与足趾之间呈现不连接式的单向挤压,使得并
联弹簧就只在拓屈时才会挤压,而在背屈时并联弹簧与足底并未接触,从而不会影响踩
关节的运动。串联弹簧采用L型设计,串联弹簧的一端连接在关注丝杆的螺母,另一端
连接在足趾上,当滚珠丝杠转动时,丝杆螺母带动串联弹簧,串联弹簧带动足趾上下运
动,同时并联弹簧由于力矩的作用,会产生形变,从而形成了串联弹簧执行器。并联踩
关节假肢采用了串联弹簧执行器与并联弹簧组合驱动,其中串联弹簧执行器在拓屈与背
屈的旋转刚度值不同以满足人体行走踩关节不同位置的阻抗,而并联弹簧的作用是类似
人体前移背屈时的储能构件。弹性脚板的设计,也为了人体在控制拓屈触底时有一定的
缓冲和储能作用,使人体行走更加的舒适。

使用特权

评论回复
32
goodluck09876|  楼主 | 2019-7-2 13:02 | 只看该作者

使用特权

评论回复
33
goodluck09876|  楼主 | 2019-7-2 13:05 | 只看该作者

使用特权

评论回复
34
goodluck09876|  楼主 | 2019-7-2 13:06 | 只看该作者

使用特权

评论回复
35
goodluck09876|  楼主 | 2019-7-2 13:06 | 只看该作者

使用特权

评论回复
36
goodluck09876|  楼主 | 2019-7-2 13:17 | 只看该作者

使用特权

评论回复
37
goodluck09876|  楼主 | 2019-7-2 13:38 | 只看该作者

使用特权

评论回复
38
goodluck09876|  楼主 | 2019-7-2 14:02 | 只看该作者

使用特权

评论回复
39
goodluck09876|  楼主 | 2019-7-2 14:03 | 只看该作者

使用特权

评论回复
40
goodluck09876|  楼主 | 2019-7-2 14:03 | 只看该作者
    使用串联弹簧执行器和并联弹簧共同驱动的机械机构设计,满足了踩关节假肢的运
动灵活性和承载能力,然而,踩关节假肢不仅仅需要其与穿戴者有相近的运动学特性,
还需使假肢根据人体运动不同阶段输出不同的运动,满足人体躁关节需要的角度和力
矩。因此,需要进一步的研究踩关节假肢的控制方法。
    主被动踩关节假肢的控制是根据采集假肢的实时状态,判断人体此时需要的运动方
式,控制电机驱动假肢输出合适的运动。假肢的控制是一个典型的伺服控制系统,包括
角度的伺服控制和力矩的伺服控制。通过对步态的划分和分析,采用了有限状态机进行
运动阶段的判断,然后采用角度控制和力矩控制结合的控制方案,为了更好的配合人体
的运动,提高假肢的响应速度和控制精度,底层控制器采用了模糊PID控制方法。

使用特权

评论回复
发新帖 我要提问
您需要登录后才可以回帖 登录 | 注册

本版积分规则