等速肌力测试系统及其核心控制算法的制作方法
专利名称：等速肌力测试系统及其核心控制算法的制作方法
技术领域：
本发明涉及一种用于人体运动系统康复训练、肌肉功能检查和评价的等速肌力测 试系统及其核心控制算法。
背景技术：
肌肉功能检查和评价是康复医学中最基本、最重要的内容之一。常用的肌肉功能 检查包括等长肌力、等张肌力和等速肌力检查等。由于等速运动技术在肌肉功能测试上具 有很好的准确性、可靠性和可重复性，在肌力训练上具有很好的安全性、高效性和合理性， 故在体育训练及康复医学的临床实践和科学研究中有广泛的应用前景。等速运动，又称可调节抗阻运动或恒定角速度运动，指利用专门设备，根据运动过 程的肌力大小变化，相应调节外加阻力，使整个关节运动依预先设定速度运动，运动过程中 肌肉用力仅使肌张力增高，力矩输出增加。等速运动能依肌力强弱、肌肉长度变化、力臂长 短、疼痛疲惫等状况。提供适合其肌肉本身的最大阻力，且不会超过其负荷的极限。因此， 等速运动具有相当高的效率与安全性。等速运动分为等速向心收缩运动和等速离心收缩运动两种方式，二者的区别在于 肌肉收缩时肌纤维长度变化不同，前者肌纤维缩短，后者变长。表现在等速运动装置上，等 速向心收缩运动时，主动力由肌肉收缩提供，等速装置提供与运动方向相反的阻力；等速离 心收缩运动时，主动力由等速装置提供，肌力与运动方向相反。等速运动需要借助于专门的等速设备来产生，等速技术的发展依赖于等速运动器 械的发展水平，目前国内尚未有自行生产制造成套设备，国内使用的等速仪器主要靠进口， 价格昂贵，只有少数大中城市的医院拥有此类成套设备。极大的限制了等速技术在我国康 复领域的发展。为了推动等速装置的国产化，人们做了一些尝试和努力，研制出了不少等速训练 器材，如中国专利CN86203623U公开的一种“电磁等动力量训练器”、ZL 93200861. 5公开的 一种“电磁控制等动训练器”及ZL 200620018837. X公开的一种“等动爆发力训练仪”，等 等。这些等速器材主要是以肌力训练为目的，无肌力显示和评价模块，适用于等速训练，但 不适用于肌力测试；另外，它们大都利用机械装置原理或电磁阻力装置提供等速训练的阻 力，无法提供产生离心收缩的主动力，因此无法进行等速离心收缩训练，而现代体育科学理 论和实践证实，离心收缩力量训练对改善肌肉素质，提高运动能力有着重要的意义。
发明内容
本发明的第一个目的是推进国内等速技术的发展，提供一种能够进行等速训练和 肌力测试的等速肌力测试系统实现本发明第一个目的的技术方案是一种等速肌力测试系统，包括核心控制模 块、动力产生与输出模块和传感检测模块；所述核心控制模块控制动力产生与输出模块运 动，传感检测模块将检测到的动力产生与输出模块的各种数据传送给核心控制模块；所述动力产生与输出模块包括为肢体进行等速运动提供所需阻力的动力输出轴；所述传感检测 模块包括扭矩传感器、角位移传感器和滤波器；所述扭矩传感器和角速度传感器的输入端 分别连接动力产生与输出模块的动力输出轴的输出端，扭矩传感器和角速度传感器的输出 端分别连接核心控制模块，滤波器连接角速度传感器和核心控制模块。所述传感检测模块的扭矩传感器为动态测量式转矩传感器，用于测量所述动力产 生与输出模块的动力输出轴的转矩；角速度传感器为旋转编码器，用于检测所述动力产生 与输出模块的动力输出轴的角速度；角速度传感器的PWM输出端经滤波器后接入核心控制 模块，用于检测所述动力产生与输出模块的动力输出轴的角位移。所述传感检测模块还包括调理电路；所述调理电路为将所述扭矩传感器、角速度 传感器、滤波器的输出信号调理、变换成便于所述核心控制模块的嵌入式微处理器接收的 信号的电路。所述动力产生与输出模块还包括依次连接的电平转换器、D/A转换器、有刷直流电 机伺服驱动器、有刷直流电机和减速机；所述电平转换器与核心控制模块的输出端连接。所述动力产生与输出模块的D/A转换器为高精度D/A转换器，用于接收所述核心 控制模块的控制数据，转换成模拟电压后输入到有刷直流电机伺服驱动器；所述有刷直流 电机伺服驱动器有电压控制和电流控制两种工作方式，用于控制有刷直流电机按要求运 动；所述减速机为行星齿轮减速机；所述有刷直流电机通过减速机驱动动力输出轴提供肢 体等速运动所需的阻力。所述动力产生与输出模块的有刷直流电机上装配有电磁制动器。所述核心控制模块包括相互电连接的嵌入式微处理器及外围电路，所述嵌入式微 处理器为高速单片机或数字信号处理器，利用所述传感检测模块采集的转矩、角位移、角速 度信息控制所述动力产生与输出模块按要求动作；所述外围电路是使所述嵌入式微处理器 正常工作所必需的元器件及相互连接所构成的电路。还包括与核心控制模块双向电连接的人机交互模块；所述人机交互模块包括PC 机测控界面、输入按钮和状态指示灯；所述PC机测控界面用于在测试和训练前输入被测 人员相关信息、选择测试关节、设定测试角速度、关节运动范围、最大力矩限制信息，在训练 中显示并保存所测肌力、角速度、关节角位移数据和曲线，在训练后对所存数据进行分析处 理，评价所测关节的肌力情况，为医师诊断提供参考；所述输入按钮包括正转极限按钮、反 转极限按钮、暂停按钮、急停按钮、开始按钮和停止按钮，所述正转极限按钮和反转极限按 钮用于训练前设定正转和反转方向的极限位置；所述暂停按钮用于使动力输出轴暂时锁定 或释放，或者在训练和测试中暂时停止训练；所述急停按钮用于在发生异常的情况下切断 动力产生和输出模块的电源，使动力输出轴停止运动；所述开始按钮和停止按钮分别用于 训练的启动和正常停止；所述状态指示灯用于指示所述等速肌力测试系统各模块的工作 状态，包括指示所述动力产生与输出模块的有刷直流电机伺服驱动器状态的伺服状态指示 灯、指示所述PC机测控界面与所述核心控制模块之间通信状态的通信状态指示灯、指示所 述传感检测模块的角速度传感器工作状态的角速度传感器状态指示灯、以及指示扭矩传感 器工作状态的扭矩传感器状态指示灯。所述动力产生与输出模块的有刷直流电机上装配的电磁制动器受所述人机交互 模块的输入按钮的急停按钮和核心控制模块的双重控制。
本发明的第二个目的是提供一种等速肌力测试系统的核心控制算法。实现本发明第二个目的的技术方案是一种等速肌力测试系统的核心控制算法，包 括以下步骤①初始化控制输出量u(k)；②采入角速度设定值wr (k)、本采样周期测量角速度w (k)和上一采样周期测量角 速度w(k-l)，并计算角速度偏差e(k) = w(k)-wr(k)；③判断偏差e(k)是否大于0 ；④如果第③步中e(k)大于0，则判断本采样周期测量角速度w(k)是否比上一采样 周期测量角速度w(k-l)大；若是，则将第②步中求得的角速度偏差e(k)乘以一个正数系数 a作为本次控制量增量AuGO的值，S卩AuGO =a.e(k)；若否，即本采样周期测量角速度 w(k)没有上一采样周期测量角速度w(k-1)大，则将本次控制量增量AuGO置为0 ；⑤如果第③步中e(k)小于0，则判断本次测量角速度w(k)是否比上一采样周期所 测角速度w(k-l)小；若是，则将第②步中求得的偏差e(k)乘以一个正数系数b作为本次控 制量增量Au(k)的值，即Au(k) =b.e(k)；若否，即本采样周期测量角速度w(k)没有比 上一采样周期测量角速度w(k-Ι)小，则将本次控制量增量Au(k)置为0。⑥将第④步或第⑤步中得到的本次控制量增量Au(k)与上次控制量u(k-l)之和 作为本次确定的控制量U(k)输出，即u(k) = Au(k)+U(k-1)；重复② ⑥步，直至训练或测试结束。采用了上述技术方案，本发明具有以下积极的效果(1)本发明所设计的等速肌 力测试系统的动力产生于输出模块的动力输出轴能够提供等速运动所需阻力，传感检测模 块检测动力输出轴的转矩、角速度、角位移，动力输出轴的转矩即肌力，因此本发明的等速 肌力测试系统既能提供等速训练，又能在等速训练中检测肌力、角速度、角位移等重要物理量。(2)本发明的等速肌力测试系统的动力产生与输出模块采用有刷直流电机作为动 力产生元件，使系统工作灵活，调节方便，能够在大范围适用不同人群的肌力测试需求，只 要在动力输出轴上配上不同的附件即能对人体的不同主要关节进行训练。(3)本发明的等速肌力测试系统的动力产生与输出模块采用有刷直流电机还能够 提供“主动抗力”，带着肢体绕动力输出轴做等速离心收缩训练。(4)本发明的等速肌力测试系统采用嵌入式微处理器与有刷直流电机伺服驱动器 相结合的方式来控制有刷直流电机工作，而不是自行设计伺服驱动器，充分利用了成熟有 刷直流电机伺服驱动器的高可靠性和安全性。(5)本发明的等速肌力测试系统的动力产生与输出模块的有刷直流电机上配有电 磁制动器，并受急停按钮和核心控制模块的双重控制，在紧急状态下除动力部分断电外，电 磁制动器立即将电机锁定，从而使动力输出轴锁定，从而确保测试者的安全。(6)本发明的等速肌力测试系统的动力产生与输出模块与其他模块采用隔离独立 供电，避免相互干扰，及有害电压进入操作部分。(7)本发明的等速肌力测试系统，还包括友好的人机交互模块，能显示保存训练或 测试中的肌力、角位移、角速度这些重要物理量，并对测量结果进行分析和评价，为医师提 供参考。
为了使本发明的内容更容易被清楚地理解，下面根据具体实施例并结合附图，对 本发明作进一步详细的说明，其中图1为本发明的等速肌力测试系统的组成框图。图2为本发明的等速肌力测试系统的电路原理示意图。图3为本发明的等速肌力测试系统的核心控制算法流程图。附图中标号为核心控制模块1，嵌入式微处理器11 ；动力产生与输出模块2，动力输出轴21，电平转换器22、D/A转换器23、有刷直流 电机伺服驱动器对、有刷直流电机25，减速机沈；传感检测模块3，扭矩传感器31，角位移传感器32，滤波器33 ；人机交互模块4，PC机测控界面41，输入按钮42，正转极限按钮42_1，反转极限按 钮42-2，暂停按钮42-3，急停按钮42-4，开始按钮42_5，停止按钮42_6，状态指示灯43，伺 服状态指示灯43-1，通信状态指示灯43-2，角速度传感器状态指示灯43-3，扭矩传感器状 态指示灯43-4，通信电平转换电路44。
具体实施例方式(实施例1，等速肌力测试系统)见图1，本实施例的等速肌力测试系统包括核心控制模块1、动力产生与输出模块 2、传感检测模块3和人机交互模块4。核心控制模块1控制动力产生与输出模块2运动，传 感检测模块3将检测到的动力产生与输出模块2的各种数据传送给核心控制模块1，人机交 互模块4与核心控制模块1双向电连接。见图2，核心控制模块1包括相互电连接的嵌入式微处理器11及外围电路。嵌入 式微处理器11的型号为TMS320F2810，利用传感检测模块3采集的转矩、角位移、角速度信 息控制动力产生与输出模块2按要求动作。外围电路是使所述嵌入式微处理器11正常工 作所必需的元器件及相互连接所构成的电路，图中未显示。动力产生与输出模块2包括为肢体进行等速运动提供所需阻力的动力输出轴 21、电平转换器22、D/A转换器23、有刷直流电机伺服驱动器24、有刷直流电机25和减速 机26，电平转换器22与核心控制模块1的输出端连接。其中，电平转换器22采用型号为 74ALVC164245的双8位3V-5V电平转换芯片；D/A转换器23采用型号为DAC811的12位 高精度D/A转换器，其模拟输出电压为-lOf+lOV，用于接收所述核心控制模块1的控制数 据，转换成模拟电压后输入到有刷直流电机伺服驱动器M ；有刷直流电机伺服驱动器M采 用型号为A-M-C 20a20的PWM伺服驱动器，它具有电压/转速控制和电流/转矩控制两种 控制方式，工作电压范围为40V 190V，控制输入电压为-lOf+lOV，用于控制有刷直流电机 25按要求运动；减速机沈为行星齿轮减速机，减速比为30 1 ；有刷直流电机25额定功率 为1. 5kW，额定电压为160V，额定转矩9. 5Nm，额定转速1500r/min，其上装配有电磁制动器 (图中未显示)，有刷直流电机25通过减速机沈驱动动力输出轴21提供肢体等速运动所 需的阻力；电磁制动器受人机交互模块4的输入按钮42的急停按钮42-4和核心控制模块1的双重控制。TMS320F2810的通用I/O 口 GPI0B(TGPI011经74ALVC164245电平转换后接 入DAC811的12位并行数据输入端，DAC811的模拟电压输出端连接到A_M_C 20a20型PWM 伺服驱动器的控制信号输入端，A-M-C 20a20的电机电压输出端与有刷直流电机25的电源 接线端相连，有刷直流电机25的输出轴通过行星齿轮减速机连接到动力输出轴21，将动力 输出。传感检测模块3包括扭矩传感器31、角位移传感器32、滤波器33和调理电路；扭 矩传感器31和角速度传感器32的输入端分别连接动力产生与输出模块2的动力输出轴21 的输出端，扭矩传感器31和角速度传感器32的输出端分别连接核心控制模块1，滤波器33 连接角速度传感器32和核心控制模块1。扭矩传感器31采用型号为TQ-660500的电压输 出型高精度动态扭矩传感器，测量范围为-500NnT+500Nm，对应输出电压为1V-5V，正向满 量程为500Nm，对应输出电压5V，反向满量程为_500Nm，对应输出电压为IV。角位移传感器 32采用型号为AS5145的12位分辨率的磁编码器，它具有正交编码脉冲输出端A相、B相及 原点Index输出，同时还具有绝对编码PWM输出端，PWM输出的占空比0/4096、095/4096 对应着绝对角度(Γ360度。滤波器33为2阶无源RC低通滤波器。磁编码器AS5145的 正交增量输出端A、B及原点INDEX分别连接至TMS320F2810的正交编码脉冲电路QEP的 QEPUQEP2和QEPI1，用于测量动力输出轴的角速度；磁编码器AS5145的PWM输出端经2阶 无源RC低通滤波器调理成0疒3. 3V直流电压后连接至TMS320F2810的A/D转换输入通道 ADCINA0，用于测量动力输出轴的绝对角位移；扭矩传感器TQ-660500的电压信号输出端连 接到TMS320F2810的A/D转换输入通道ADCINA1，用于测量加在动力输出轴上的转矩。调理 电路为将所述扭矩传感器31、角速度传感器32、滤波器33的输出信号调理、变换成便于所 述核心控制模块1的嵌入式微处理器11接收的信号的电路，图中未显示。人机交互模块4与核心控制模块1双向电连接。人机交互模块4包括PC机测控 界面41、输入按钮42、状态指示灯43和通信电平转换电路44 ；PC机测控界面4通过以芯 片MAX3232为核心的通信电平转换电路44与TMS320F2810的串行通信接口 SCIA相连，用 于在测试和训练前输入被测人员相关信息、选择测试关节、设定测试角速度、关节运动范 围、最大力矩限制信息，在训练中显示并保存所测肌力、角速度、关节角位移数据和曲线， 在训练后对所存数据进行分析处理，评价所测关节的肌力情况，为医师诊断提供参考；输 入按钮42包括正转极限按钮42-1、反转极限按钮42-2、暂停按钮42_3、急停按钮42_4、 开始按钮42-5和停止按钮42-6，这6个输入按钮分别与核心控制模块的TMS320F2810的 GPI0A(TGPI0A5相连。正转极限按钮42-1和反转极限按钮42_2用于训练前设定正转和反 转方向的极限位置；暂停按钮42-3用于使动力输出轴暂时锁定或释放，或者在训练和测试 中暂时停止训练；急停按钮42-4用于在发生异常的情况下切断动力产生和输出模块2的 电源，使动力输出轴21停止运动；开始按钮42-5和停止按钮42-6分别用于训练的启动和 正常停止；状态指示灯43用于指示所述等速肌力测试系统各模块的工作状态，包括指示所 述动力产生与输出模块2的有刷直流电机伺服驱动器M状态的伺服状态指示灯43-1、指 示所述PC机测控界面41与所述核心控制模块1之间通信状态的通信状态指示灯43-2、 指示所述传感检测模块3的角速度传感器工作状态的角速度传感器状态指示灯43-3、以 及指示扭矩传感器31工作状态的扭矩传感器状态指示灯43-4，这4个状态指示灯分别与 TMS320F2810 的 GPI0A12 GPI0A15 相连。
(实施例2，等速肌力测试系统的核心控制算法)见图3，等速肌力测试系统的核心控制算法，包括以下步骤①步骤100，初始化控制输出量u (k)； ②步骤101，采入角速度设定值wr (k)、本采样周期测量角速度w (k)和上一采样周 期测量角速度w(k-l)；步骤102，计算角速度偏差e (k) = w (k) -wr (k)；③步骤103，判断偏差e (k)是否大于0 ；④如果第③步中e (k)大于0，则进行步骤104，判断本采样周期测量角速度w (k) 是否比上一采样周期测量角速度w (k-1)大；若是，则进行步骤105，将第②步中求得的角速 度偏差e(k)乘以一个正数系数a作为本次控制量增量Au(k)的值，S卩Au(k) = a. e (k)； 若否，即本采样周期测量角速度w(k)没有上一采样周期测量角速度w(k-l)大，进行步骤 106，将本次控制量增量Au(k)置为0 ；⑤如果第③步中e(k)小于0，则进行步骤107，判断本次测量角速度w(k)是否比 上一采样周期所测角速度w(k-l)小；若是，则进行步骤108，将第②步中求得的偏差e (k) 乘以一个正数系数b作为本次控制量增量Au(k)的值，S卩Au(k) =b.e(k)；若否，即本采 样周期测量角速度w(k)没有比上一采样周期测量角速度w(k-l)小，则进行步骤106，将本 次控制量增量Au(k)置为0;⑥执行完步骤105或步骤106或步骤108后，均进入步骤109，将本次控制量 增量Au(k)与上次控制量U(k-l)之和作为本次确定的控制量u(k)输出，即u(k)= Au(k) +u (k-1)。；重复第② ⑥步，直至训练或测试结束。以上所述的具体实施例，对本发明的目的、技术方案和有益效果进行了进一步详 细说明，所应理解的是，以上所述仅为本发明的具体实施例而已，并不用于限制本发明，凡 在本发明的精神和原则之内，所做的任何修改、等同替换、改进等，均应包含在本发明的保 护范围之内。
权利要求
1.一种等速肌力测试系统，包括核心控制模块(1)、动力产生与输出模块( 和传感检 测模块⑶；所述核心控制模块⑴控制动力产生与输出模块⑵运动，传感检测模块⑶ 将检测到的动力产生与输出模块( 的各种数据传送给核心控制模块(1)；其特征在于所 述动力产生与输出模块( 包括为肢体进行等速运动提供所需阻力的动力输出轴；所 述传感检测模块C3)包括扭矩传感器(31)、角位移传感器(3 和滤波器(3 ；所述扭矩 传感器(31)和角速度传感器(3 的输入端分别连接动力产生与输出模块( 的动力输出 轴的输出端，扭矩传感器(31)和角速度传感器(3 的输出端分别连接核心控制模块(1)，滤波器(33)连接角速度传感器(32)和核心控制模块(I)0
2.根据权利要求1所述的等速肌力测试系统，其特征在于所述传感检测模块(3)的 扭矩传感器(31)为动态测量式转矩传感器，用于测量所述动力产生与输出模块( 的动力 输出轴的转矩；角速度传感器(3 为旋转编码器，用于检测所述动力产生与输出模块(2)的动力输出轴的角速度；角速度传感器(32)的PWM输出端经滤波器(33)后接入 核心控制模块(1)，用于检测所述动力产生与输出模块⑵的动力输出轴的角位移。
3.根据权利要求2所述的等速肌力测试系统，其特征在于所述传感检测模块(3)还 包括调理电路；所述调理电路为将所述扭矩传感器(31)、角速度传感器(32)、滤波器(33) 的输出信号调理、变换成便于所述核心控制模块(1)的嵌入式微处理器(11)接收的信号的 电路。
4.根据权利要求1所述的等速肌力测试系统，其特征在于所述动力产生与输出模块 (2)还包括依次连接的电平转换器0》、D/A转换器(23)、有刷直流电机伺服驱动器(M)、 有刷直流电机0 和减速机06)；所述电平转换器0 与核心控制模块(1)的输出端连接。
5.根据权利要求4所述的等速肌力测试系统，其特征在于所述动力产生与输出模块 (2)的D/A转换器03)为高精度D/A转换器，用于接收所述核心控制模块⑴的控制数据， 转换成模拟电压后输入到有刷直流电机伺服驱动器04)；所述有刷直流电机伺服驱动器 (24)有电压控制和电流控制两种工作方式，用于控制有刷直流电机05)按要求运动；所述 减速机06)为行星齿轮减速机；所述有刷直流电机0 通过减速机06)驱动动力输出轴 (21)提供肢体等速运动所需的阻力。
6.根据权利要求5所述的等速肌力测试系统，其特征在于所述动力产生与输出模块 ⑵的有刷直流电机05)上装配有电磁制动器。
7.根据权利要求1至6之一所述的等速肌力测试系统，其特征在于所述核心控制模 块(1)包括相互电连接的嵌入式微处理器(11)及外围电路，所述嵌入式微处理器(11)为 高速单片机或数字信号处理器，利用所述传感检测模块C3)采集的转矩、角位移、角速度信 息控制所述动力产生与输出模块( 按要求动作；所述外围电路是使所述嵌入式微处理器 (11)正常工作所必需的元器件及相互连接所构成的电路。
8.根据权利要求7所述的等速肌力测试系统，其特征在于还包括与核心控制模块(1) 双向电连接的人机交互模块(4)；所述人机交互模块(4)包括PC机测控界面(41)、输入按 钮0 和状态指示灯；所述PC机测控界面用于在测试和训练前输入被测人员 相关信息、选择测试关节、设定测试角速度、关节运动范围、最大力矩限制信息，在训练中显 示并保存所测肌力、角速度、关节角位移数据和曲线，在训练后对所存数据进行分析处理，评价所测关节的肌力情况，为医师诊断提供参考；所述输入按钮0 包括正转极限按钮 (42-1)、反转极限按钮(42-2)、暂停按钮(42-3)、急停按钮(42_4)、开始按钮(42-5)和停 止按钮(42-6)，所述正转极限按钮02-1)和反转极限按钮G2-2)用于训练前设定正转和 反转方向的极限位置；所述暂停按钮用于使动力输出轴暂时锁定或释放，或者在训 练和测试中暂时停止训练；所述急停按钮G2-4)用于在发生异常的情况下切断动力产生 和输出模块O)的电源，使动力输出轴停止运动；所述开始按钮02- 和停止按钮 (42-6)分别用于训练的启动和正常停止；所述状态指示灯G3)用于指示所述等速肌力测 试系统各模块的工作状态，包括指示所述动力产生与输出模块O)的有刷直流电机伺服驱 动器04)状态的伺服状态指示灯(43-1)、指示所述PC机测控界面与所述核心控制模 块(1)之间通信状态的通信状态指示灯(43-2)、指示所述传感检测模块(3)的角速度传感 器工作状态的角速度传感器状态指示灯(43-3)、以及指示所述传感检测模块(3)的扭矩传 感器(31)工作状态的扭矩传感器状态指示灯03-4)。
9.根据权利要求8所述的等速肌力测试系统，其特征在于所述动力产生与输出模块 ⑵的有刷直流电机05)上装配的电磁制动器受所述人机交互模块⑷的输入按钮G2) 的急停按钮G2-4)和核心控制模块(1)的双重控制。
10.一种等速肌力测试系统的核心控制算法，其特征在于包括以下步骤①初始化控制输出量u(k)；②采入角速度设定值wr(k)、本采样周期测量角速度w (k)和上一采样周期测量角速度 w(k-l)，并计算角速度偏差e(k) = w(k)-wr(k)；③判断偏差e(k)是否大于O；④如果第③步中e(k)大于0，则判断本采样周期测量角速度w(k)是否比上一采样周期 测量角速度w(k-l)大；若是，则将第②步中求得的角速度偏差e(k)乘以一个正数系数a作 为本次控制量增量Au(k)的值，S卩Au(k) =a.e(k)；若否，即本采样周期测量角速度w(k) 没有上一采样周期测量角速度w(k_l)大，则将本次控制量增量置AuGO为0;⑤如果第③步中e(k)小于0，则判断本次测量角速度w(k)是否比上一采样周期所测角 速度w(k-l)小；若是，则将第②步中求得的偏差e(k)乘以一个正数系数b作为本次控制量 增量Au(k)的值，即Au(k) =b.e(k)；若否，即本采样周期测量角速度w(k)没有比上一 采样周期测量角速度w(k-Ι)小，则将本次控制量增量Au(k)置为O。⑥将第④步或第⑤步中得到的本次控制量增量ΔιιΟΟ与上次控制量u(k-l)之和作为 本次确定的控制量u(k)输出，即u(k) = Au(k)+u(k-l)；重复② ⑥步，直至训练或测试结束。
全文摘要
本发明公开了一种等速肌力测试系统，包括核心控制模块、动力产生与输出模块和传感检测模块；核心控制模块控制动力产生与输出模块运动，传感检测模块将检测到的动力产生与输出模块的各种数据传送给核心控制模块；动力产生与输出模块包括为肢体进行等速运动提供所需阻力的动力输出轴；传感检测模块包括扭矩传感器、角位移传感器和滤波器；扭矩传感器和角速度传感器的输入端连接动力输出轴的输出端，输出端分别连接核心控制模块，滤波器连接角速度传感器和核心控制模块。本发明的动力输出轴能够提供等速运动所需阻力，传感检测模块检测动力输出轴的转矩、角速度、角位移，因此本发明能提供等速训练，又能检测肌力、角速度、角位移等重要物理量。
文档编号A61B5/22GK102138801SQ201010301048
公开日2011年8月3日 申请日期2010年2月2日 优先权日2010年2月2日
发明者孔令成, 张志华, 徐林森, 缪琴, 骆敏舟 申请人:常州机械电子工程研究所
技术领域：
本发明涉及一种用于人体运动系统康复训练、肌肉功能检查和评价的等速肌力测 试系统及其核心控制算法。
背景技术：
肌肉功能检查和评价是康复医学中最基本、最重要的内容之一。常用的肌肉功能 检查包括等长肌力、等张肌力和等速肌力检查等。由于等速运动技术在肌肉功能测试上具 有很好的准确性、可靠性和可重复性，在肌力训练上具有很好的安全性、高效性和合理性， 故在体育训练及康复医学的临床实践和科学研究中有广泛的应用前景。等速运动，又称可调节抗阻运动或恒定角速度运动，指利用专门设备，根据运动过 程的肌力大小变化，相应调节外加阻力，使整个关节运动依预先设定速度运动，运动过程中 肌肉用力仅使肌张力增高，力矩输出增加。等速运动能依肌力强弱、肌肉长度变化、力臂长 短、疼痛疲惫等状况。提供适合其肌肉本身的最大阻力，且不会超过其负荷的极限。因此， 等速运动具有相当高的效率与安全性。等速运动分为等速向心收缩运动和等速离心收缩运动两种方式，二者的区别在于 肌肉收缩时肌纤维长度变化不同，前者肌纤维缩短，后者变长。表现在等速运动装置上，等 速向心收缩运动时，主动力由肌肉收缩提供，等速装置提供与运动方向相反的阻力；等速离 心收缩运动时，主动力由等速装置提供，肌力与运动方向相反。等速运动需要借助于专门的等速设备来产生，等速技术的发展依赖于等速运动器 械的发展水平，目前国内尚未有自行生产制造成套设备，国内使用的等速仪器主要靠进口， 价格昂贵，只有少数大中城市的医院拥有此类成套设备。极大的限制了等速技术在我国康 复领域的发展。为了推动等速装置的国产化，人们做了一些尝试和努力，研制出了不少等速训练 器材，如中国专利CN86203623U公开的一种“电磁等动力量训练器”、ZL 93200861. 5公开的 一种“电磁控制等动训练器”及ZL 200620018837. X公开的一种“等动爆发力训练仪”，等 等。这些等速器材主要是以肌力训练为目的，无肌力显示和评价模块，适用于等速训练，但 不适用于肌力测试；另外，它们大都利用机械装置原理或电磁阻力装置提供等速训练的阻 力，无法提供产生离心收缩的主动力，因此无法进行等速离心收缩训练，而现代体育科学理 论和实践证实，离心收缩力量训练对改善肌肉素质，提高运动能力有着重要的意义。
发明内容
本发明的第一个目的是推进国内等速技术的发展，提供一种能够进行等速训练和 肌力测试的等速肌力测试系统实现本发明第一个目的的技术方案是一种等速肌力测试系统，包括核心控制模 块、动力产生与输出模块和传感检测模块；所述核心控制模块控制动力产生与输出模块运 动，传感检测模块将检测到的动力产生与输出模块的各种数据传送给核心控制模块；所述动力产生与输出模块包括为肢体进行等速运动提供所需阻力的动力输出轴；所述传感检测 模块包括扭矩传感器、角位移传感器和滤波器；所述扭矩传感器和角速度传感器的输入端 分别连接动力产生与输出模块的动力输出轴的输出端，扭矩传感器和角速度传感器的输出 端分别连接核心控制模块，滤波器连接角速度传感器和核心控制模块。所述传感检测模块的扭矩传感器为动态测量式转矩传感器，用于测量所述动力产 生与输出模块的动力输出轴的转矩；角速度传感器为旋转编码器，用于检测所述动力产生 与输出模块的动力输出轴的角速度；角速度传感器的PWM输出端经滤波器后接入核心控制 模块，用于检测所述动力产生与输出模块的动力输出轴的角位移。所述传感检测模块还包括调理电路；所述调理电路为将所述扭矩传感器、角速度 传感器、滤波器的输出信号调理、变换成便于所述核心控制模块的嵌入式微处理器接收的 信号的电路。所述动力产生与输出模块还包括依次连接的电平转换器、D/A转换器、有刷直流电 机伺服驱动器、有刷直流电机和减速机；所述电平转换器与核心控制模块的输出端连接。所述动力产生与输出模块的D/A转换器为高精度D/A转换器，用于接收所述核心 控制模块的控制数据，转换成模拟电压后输入到有刷直流电机伺服驱动器；所述有刷直流 电机伺服驱动器有电压控制和电流控制两种工作方式，用于控制有刷直流电机按要求运 动；所述减速机为行星齿轮减速机；所述有刷直流电机通过减速机驱动动力输出轴提供肢 体等速运动所需的阻力。所述动力产生与输出模块的有刷直流电机上装配有电磁制动器。所述核心控制模块包括相互电连接的嵌入式微处理器及外围电路，所述嵌入式微 处理器为高速单片机或数字信号处理器，利用所述传感检测模块采集的转矩、角位移、角速 度信息控制所述动力产生与输出模块按要求动作；所述外围电路是使所述嵌入式微处理器 正常工作所必需的元器件及相互连接所构成的电路。还包括与核心控制模块双向电连接的人机交互模块；所述人机交互模块包括PC 机测控界面、输入按钮和状态指示灯；所述PC机测控界面用于在测试和训练前输入被测 人员相关信息、选择测试关节、设定测试角速度、关节运动范围、最大力矩限制信息，在训练 中显示并保存所测肌力、角速度、关节角位移数据和曲线，在训练后对所存数据进行分析处 理，评价所测关节的肌力情况，为医师诊断提供参考；所述输入按钮包括正转极限按钮、反 转极限按钮、暂停按钮、急停按钮、开始按钮和停止按钮，所述正转极限按钮和反转极限按 钮用于训练前设定正转和反转方向的极限位置；所述暂停按钮用于使动力输出轴暂时锁定 或释放，或者在训练和测试中暂时停止训练；所述急停按钮用于在发生异常的情况下切断 动力产生和输出模块的电源，使动力输出轴停止运动；所述开始按钮和停止按钮分别用于 训练的启动和正常停止；所述状态指示灯用于指示所述等速肌力测试系统各模块的工作 状态，包括指示所述动力产生与输出模块的有刷直流电机伺服驱动器状态的伺服状态指示 灯、指示所述PC机测控界面与所述核心控制模块之间通信状态的通信状态指示灯、指示所 述传感检测模块的角速度传感器工作状态的角速度传感器状态指示灯、以及指示扭矩传感 器工作状态的扭矩传感器状态指示灯。所述动力产生与输出模块的有刷直流电机上装配的电磁制动器受所述人机交互 模块的输入按钮的急停按钮和核心控制模块的双重控制。
本发明的第二个目的是提供一种等速肌力测试系统的核心控制算法。实现本发明第二个目的的技术方案是一种等速肌力测试系统的核心控制算法，包 括以下步骤①初始化控制输出量u(k)；②采入角速度设定值wr (k)、本采样周期测量角速度w (k)和上一采样周期测量角 速度w(k-l)，并计算角速度偏差e(k) = w(k)-wr(k)；③判断偏差e(k)是否大于0 ；④如果第③步中e(k)大于0，则判断本采样周期测量角速度w(k)是否比上一采样 周期测量角速度w(k-l)大；若是，则将第②步中求得的角速度偏差e(k)乘以一个正数系数 a作为本次控制量增量AuGO的值，S卩AuGO =a.e(k)；若否，即本采样周期测量角速度 w(k)没有上一采样周期测量角速度w(k-1)大，则将本次控制量增量AuGO置为0 ；⑤如果第③步中e(k)小于0，则判断本次测量角速度w(k)是否比上一采样周期所 测角速度w(k-l)小；若是，则将第②步中求得的偏差e(k)乘以一个正数系数b作为本次控 制量增量Au(k)的值，即Au(k) =b.e(k)；若否，即本采样周期测量角速度w(k)没有比 上一采样周期测量角速度w(k-Ι)小，则将本次控制量增量Au(k)置为0。⑥将第④步或第⑤步中得到的本次控制量增量Au(k)与上次控制量u(k-l)之和 作为本次确定的控制量U(k)输出，即u(k) = Au(k)+U(k-1)；重复② ⑥步，直至训练或测试结束。采用了上述技术方案，本发明具有以下积极的效果(1)本发明所设计的等速肌 力测试系统的动力产生于输出模块的动力输出轴能够提供等速运动所需阻力，传感检测模 块检测动力输出轴的转矩、角速度、角位移，动力输出轴的转矩即肌力，因此本发明的等速 肌力测试系统既能提供等速训练，又能在等速训练中检测肌力、角速度、角位移等重要物理量。(2)本发明的等速肌力测试系统的动力产生与输出模块采用有刷直流电机作为动 力产生元件，使系统工作灵活，调节方便，能够在大范围适用不同人群的肌力测试需求，只 要在动力输出轴上配上不同的附件即能对人体的不同主要关节进行训练。(3)本发明的等速肌力测试系统的动力产生与输出模块采用有刷直流电机还能够 提供“主动抗力”，带着肢体绕动力输出轴做等速离心收缩训练。(4)本发明的等速肌力测试系统采用嵌入式微处理器与有刷直流电机伺服驱动器 相结合的方式来控制有刷直流电机工作，而不是自行设计伺服驱动器，充分利用了成熟有 刷直流电机伺服驱动器的高可靠性和安全性。(5)本发明的等速肌力测试系统的动力产生与输出模块的有刷直流电机上配有电 磁制动器，并受急停按钮和核心控制模块的双重控制，在紧急状态下除动力部分断电外，电 磁制动器立即将电机锁定，从而使动力输出轴锁定，从而确保测试者的安全。(6)本发明的等速肌力测试系统的动力产生与输出模块与其他模块采用隔离独立 供电，避免相互干扰，及有害电压进入操作部分。(7)本发明的等速肌力测试系统，还包括友好的人机交互模块，能显示保存训练或 测试中的肌力、角位移、角速度这些重要物理量，并对测量结果进行分析和评价，为医师提 供参考。
为了使本发明的内容更容易被清楚地理解，下面根据具体实施例并结合附图，对 本发明作进一步详细的说明，其中图1为本发明的等速肌力测试系统的组成框图。图2为本发明的等速肌力测试系统的电路原理示意图。图3为本发明的等速肌力测试系统的核心控制算法流程图。附图中标号为核心控制模块1，嵌入式微处理器11 ；动力产生与输出模块2，动力输出轴21，电平转换器22、D/A转换器23、有刷直流 电机伺服驱动器对、有刷直流电机25，减速机沈；传感检测模块3，扭矩传感器31，角位移传感器32，滤波器33 ；人机交互模块4，PC机测控界面41，输入按钮42，正转极限按钮42_1，反转极限按 钮42-2，暂停按钮42-3，急停按钮42-4，开始按钮42_5，停止按钮42_6，状态指示灯43，伺 服状态指示灯43-1，通信状态指示灯43-2，角速度传感器状态指示灯43-3，扭矩传感器状 态指示灯43-4，通信电平转换电路44。
具体实施例方式(实施例1，等速肌力测试系统)见图1，本实施例的等速肌力测试系统包括核心控制模块1、动力产生与输出模块 2、传感检测模块3和人机交互模块4。核心控制模块1控制动力产生与输出模块2运动，传 感检测模块3将检测到的动力产生与输出模块2的各种数据传送给核心控制模块1，人机交 互模块4与核心控制模块1双向电连接。见图2，核心控制模块1包括相互电连接的嵌入式微处理器11及外围电路。嵌入 式微处理器11的型号为TMS320F2810，利用传感检测模块3采集的转矩、角位移、角速度信 息控制动力产生与输出模块2按要求动作。外围电路是使所述嵌入式微处理器11正常工 作所必需的元器件及相互连接所构成的电路，图中未显示。动力产生与输出模块2包括为肢体进行等速运动提供所需阻力的动力输出轴 21、电平转换器22、D/A转换器23、有刷直流电机伺服驱动器24、有刷直流电机25和减速 机26，电平转换器22与核心控制模块1的输出端连接。其中，电平转换器22采用型号为 74ALVC164245的双8位3V-5V电平转换芯片；D/A转换器23采用型号为DAC811的12位 高精度D/A转换器，其模拟输出电压为-lOf+lOV，用于接收所述核心控制模块1的控制数 据，转换成模拟电压后输入到有刷直流电机伺服驱动器M ；有刷直流电机伺服驱动器M采 用型号为A-M-C 20a20的PWM伺服驱动器，它具有电压/转速控制和电流/转矩控制两种 控制方式，工作电压范围为40V 190V，控制输入电压为-lOf+lOV，用于控制有刷直流电机 25按要求运动；减速机沈为行星齿轮减速机，减速比为30 1 ；有刷直流电机25额定功率 为1. 5kW，额定电压为160V，额定转矩9. 5Nm，额定转速1500r/min，其上装配有电磁制动器 (图中未显示)，有刷直流电机25通过减速机沈驱动动力输出轴21提供肢体等速运动所 需的阻力；电磁制动器受人机交互模块4的输入按钮42的急停按钮42-4和核心控制模块1的双重控制。TMS320F2810的通用I/O 口 GPI0B(TGPI011经74ALVC164245电平转换后接 入DAC811的12位并行数据输入端，DAC811的模拟电压输出端连接到A_M_C 20a20型PWM 伺服驱动器的控制信号输入端，A-M-C 20a20的电机电压输出端与有刷直流电机25的电源 接线端相连，有刷直流电机25的输出轴通过行星齿轮减速机连接到动力输出轴21，将动力 输出。传感检测模块3包括扭矩传感器31、角位移传感器32、滤波器33和调理电路；扭 矩传感器31和角速度传感器32的输入端分别连接动力产生与输出模块2的动力输出轴21 的输出端，扭矩传感器31和角速度传感器32的输出端分别连接核心控制模块1，滤波器33 连接角速度传感器32和核心控制模块1。扭矩传感器31采用型号为TQ-660500的电压输 出型高精度动态扭矩传感器，测量范围为-500NnT+500Nm，对应输出电压为1V-5V，正向满 量程为500Nm，对应输出电压5V，反向满量程为_500Nm，对应输出电压为IV。角位移传感器 32采用型号为AS5145的12位分辨率的磁编码器，它具有正交编码脉冲输出端A相、B相及 原点Index输出，同时还具有绝对编码PWM输出端，PWM输出的占空比0/4096、095/4096 对应着绝对角度(Γ360度。滤波器33为2阶无源RC低通滤波器。磁编码器AS5145的 正交增量输出端A、B及原点INDEX分别连接至TMS320F2810的正交编码脉冲电路QEP的 QEPUQEP2和QEPI1，用于测量动力输出轴的角速度；磁编码器AS5145的PWM输出端经2阶 无源RC低通滤波器调理成0疒3. 3V直流电压后连接至TMS320F2810的A/D转换输入通道 ADCINA0，用于测量动力输出轴的绝对角位移；扭矩传感器TQ-660500的电压信号输出端连 接到TMS320F2810的A/D转换输入通道ADCINA1，用于测量加在动力输出轴上的转矩。调理 电路为将所述扭矩传感器31、角速度传感器32、滤波器33的输出信号调理、变换成便于所 述核心控制模块1的嵌入式微处理器11接收的信号的电路，图中未显示。人机交互模块4与核心控制模块1双向电连接。人机交互模块4包括PC机测控 界面41、输入按钮42、状态指示灯43和通信电平转换电路44 ；PC机测控界面4通过以芯 片MAX3232为核心的通信电平转换电路44与TMS320F2810的串行通信接口 SCIA相连，用 于在测试和训练前输入被测人员相关信息、选择测试关节、设定测试角速度、关节运动范 围、最大力矩限制信息，在训练中显示并保存所测肌力、角速度、关节角位移数据和曲线， 在训练后对所存数据进行分析处理，评价所测关节的肌力情况，为医师诊断提供参考；输 入按钮42包括正转极限按钮42-1、反转极限按钮42-2、暂停按钮42_3、急停按钮42_4、 开始按钮42-5和停止按钮42-6，这6个输入按钮分别与核心控制模块的TMS320F2810的 GPI0A(TGPI0A5相连。正转极限按钮42-1和反转极限按钮42_2用于训练前设定正转和反 转方向的极限位置；暂停按钮42-3用于使动力输出轴暂时锁定或释放，或者在训练和测试 中暂时停止训练；急停按钮42-4用于在发生异常的情况下切断动力产生和输出模块2的 电源，使动力输出轴21停止运动；开始按钮42-5和停止按钮42-6分别用于训练的启动和 正常停止；状态指示灯43用于指示所述等速肌力测试系统各模块的工作状态，包括指示所 述动力产生与输出模块2的有刷直流电机伺服驱动器M状态的伺服状态指示灯43-1、指 示所述PC机测控界面41与所述核心控制模块1之间通信状态的通信状态指示灯43-2、 指示所述传感检测模块3的角速度传感器工作状态的角速度传感器状态指示灯43-3、以 及指示扭矩传感器31工作状态的扭矩传感器状态指示灯43-4，这4个状态指示灯分别与 TMS320F2810 的 GPI0A12 GPI0A15 相连。
(实施例2，等速肌力测试系统的核心控制算法)见图3，等速肌力测试系统的核心控制算法，包括以下步骤①步骤100，初始化控制输出量u (k)； ②步骤101，采入角速度设定值wr (k)、本采样周期测量角速度w (k)和上一采样周 期测量角速度w(k-l)；步骤102，计算角速度偏差e (k) = w (k) -wr (k)；③步骤103，判断偏差e (k)是否大于0 ；④如果第③步中e (k)大于0，则进行步骤104，判断本采样周期测量角速度w (k) 是否比上一采样周期测量角速度w (k-1)大；若是，则进行步骤105，将第②步中求得的角速 度偏差e(k)乘以一个正数系数a作为本次控制量增量Au(k)的值，S卩Au(k) = a. e (k)； 若否，即本采样周期测量角速度w(k)没有上一采样周期测量角速度w(k-l)大，进行步骤 106，将本次控制量增量Au(k)置为0 ；⑤如果第③步中e(k)小于0，则进行步骤107，判断本次测量角速度w(k)是否比 上一采样周期所测角速度w(k-l)小；若是，则进行步骤108，将第②步中求得的偏差e (k) 乘以一个正数系数b作为本次控制量增量Au(k)的值，S卩Au(k) =b.e(k)；若否，即本采 样周期测量角速度w(k)没有比上一采样周期测量角速度w(k-l)小，则进行步骤106，将本 次控制量增量Au(k)置为0;⑥执行完步骤105或步骤106或步骤108后，均进入步骤109，将本次控制量 增量Au(k)与上次控制量U(k-l)之和作为本次确定的控制量u(k)输出，即u(k)= Au(k) +u (k-1)。；重复第② ⑥步，直至训练或测试结束。以上所述的具体实施例，对本发明的目的、技术方案和有益效果进行了进一步详 细说明，所应理解的是，以上所述仅为本发明的具体实施例而已，并不用于限制本发明，凡 在本发明的精神和原则之内，所做的任何修改、等同替换、改进等，均应包含在本发明的保 护范围之内。
权利要求
1.一种等速肌力测试系统，包括核心控制模块(1)、动力产生与输出模块( 和传感检 测模块⑶；所述核心控制模块⑴控制动力产生与输出模块⑵运动，传感检测模块⑶ 将检测到的动力产生与输出模块( 的各种数据传送给核心控制模块(1)；其特征在于所 述动力产生与输出模块( 包括为肢体进行等速运动提供所需阻力的动力输出轴；所 述传感检测模块C3)包括扭矩传感器(31)、角位移传感器(3 和滤波器(3 ；所述扭矩 传感器(31)和角速度传感器(3 的输入端分别连接动力产生与输出模块( 的动力输出 轴的输出端，扭矩传感器(31)和角速度传感器(3 的输出端分别连接核心控制模块(1)，滤波器(33)连接角速度传感器(32)和核心控制模块(I)0
2.根据权利要求1所述的等速肌力测试系统，其特征在于所述传感检测模块(3)的 扭矩传感器(31)为动态测量式转矩传感器，用于测量所述动力产生与输出模块( 的动力 输出轴的转矩；角速度传感器(3 为旋转编码器，用于检测所述动力产生与输出模块(2)的动力输出轴的角速度；角速度传感器(32)的PWM输出端经滤波器(33)后接入 核心控制模块(1)，用于检测所述动力产生与输出模块⑵的动力输出轴的角位移。
3.根据权利要求2所述的等速肌力测试系统，其特征在于所述传感检测模块(3)还 包括调理电路；所述调理电路为将所述扭矩传感器(31)、角速度传感器(32)、滤波器(33) 的输出信号调理、变换成便于所述核心控制模块(1)的嵌入式微处理器(11)接收的信号的 电路。
4.根据权利要求1所述的等速肌力测试系统，其特征在于所述动力产生与输出模块 (2)还包括依次连接的电平转换器0》、D/A转换器(23)、有刷直流电机伺服驱动器(M)、 有刷直流电机0 和减速机06)；所述电平转换器0 与核心控制模块(1)的输出端连接。
5.根据权利要求4所述的等速肌力测试系统，其特征在于所述动力产生与输出模块 (2)的D/A转换器03)为高精度D/A转换器，用于接收所述核心控制模块⑴的控制数据， 转换成模拟电压后输入到有刷直流电机伺服驱动器04)；所述有刷直流电机伺服驱动器 (24)有电压控制和电流控制两种工作方式，用于控制有刷直流电机05)按要求运动；所述 减速机06)为行星齿轮减速机；所述有刷直流电机0 通过减速机06)驱动动力输出轴 (21)提供肢体等速运动所需的阻力。
6.根据权利要求5所述的等速肌力测试系统，其特征在于所述动力产生与输出模块 ⑵的有刷直流电机05)上装配有电磁制动器。
7.根据权利要求1至6之一所述的等速肌力测试系统，其特征在于所述核心控制模 块(1)包括相互电连接的嵌入式微处理器(11)及外围电路，所述嵌入式微处理器(11)为 高速单片机或数字信号处理器，利用所述传感检测模块C3)采集的转矩、角位移、角速度信 息控制所述动力产生与输出模块( 按要求动作；所述外围电路是使所述嵌入式微处理器 (11)正常工作所必需的元器件及相互连接所构成的电路。
8.根据权利要求7所述的等速肌力测试系统，其特征在于还包括与核心控制模块(1) 双向电连接的人机交互模块(4)；所述人机交互模块(4)包括PC机测控界面(41)、输入按 钮0 和状态指示灯；所述PC机测控界面用于在测试和训练前输入被测人员 相关信息、选择测试关节、设定测试角速度、关节运动范围、最大力矩限制信息，在训练中显 示并保存所测肌力、角速度、关节角位移数据和曲线，在训练后对所存数据进行分析处理，评价所测关节的肌力情况，为医师诊断提供参考；所述输入按钮0 包括正转极限按钮 (42-1)、反转极限按钮(42-2)、暂停按钮(42-3)、急停按钮(42_4)、开始按钮(42-5)和停 止按钮(42-6)，所述正转极限按钮02-1)和反转极限按钮G2-2)用于训练前设定正转和 反转方向的极限位置；所述暂停按钮用于使动力输出轴暂时锁定或释放，或者在训 练和测试中暂时停止训练；所述急停按钮G2-4)用于在发生异常的情况下切断动力产生 和输出模块O)的电源，使动力输出轴停止运动；所述开始按钮02- 和停止按钮 (42-6)分别用于训练的启动和正常停止；所述状态指示灯G3)用于指示所述等速肌力测 试系统各模块的工作状态，包括指示所述动力产生与输出模块O)的有刷直流电机伺服驱 动器04)状态的伺服状态指示灯(43-1)、指示所述PC机测控界面与所述核心控制模 块(1)之间通信状态的通信状态指示灯(43-2)、指示所述传感检测模块(3)的角速度传感 器工作状态的角速度传感器状态指示灯(43-3)、以及指示所述传感检测模块(3)的扭矩传 感器(31)工作状态的扭矩传感器状态指示灯03-4)。
9.根据权利要求8所述的等速肌力测试系统，其特征在于所述动力产生与输出模块 ⑵的有刷直流电机05)上装配的电磁制动器受所述人机交互模块⑷的输入按钮G2) 的急停按钮G2-4)和核心控制模块(1)的双重控制。
10.一种等速肌力测试系统的核心控制算法，其特征在于包括以下步骤①初始化控制输出量u(k)；②采入角速度设定值wr(k)、本采样周期测量角速度w (k)和上一采样周期测量角速度 w(k-l)，并计算角速度偏差e(k) = w(k)-wr(k)；③判断偏差e(k)是否大于O；④如果第③步中e(k)大于0，则判断本采样周期测量角速度w(k)是否比上一采样周期 测量角速度w(k-l)大；若是，则将第②步中求得的角速度偏差e(k)乘以一个正数系数a作 为本次控制量增量Au(k)的值，S卩Au(k) =a.e(k)；若否，即本采样周期测量角速度w(k) 没有上一采样周期测量角速度w(k_l)大，则将本次控制量增量置AuGO为0;⑤如果第③步中e(k)小于0，则判断本次测量角速度w(k)是否比上一采样周期所测角 速度w(k-l)小；若是，则将第②步中求得的偏差e(k)乘以一个正数系数b作为本次控制量 增量Au(k)的值，即Au(k) =b.e(k)；若否，即本采样周期测量角速度w(k)没有比上一 采样周期测量角速度w(k-Ι)小，则将本次控制量增量Au(k)置为O。⑥将第④步或第⑤步中得到的本次控制量增量ΔιιΟΟ与上次控制量u(k-l)之和作为 本次确定的控制量u(k)输出，即u(k) = Au(k)+u(k-l)；重复② ⑥步，直至训练或测试结束。
全文摘要
本发明公开了一种等速肌力测试系统，包括核心控制模块、动力产生与输出模块和传感检测模块；核心控制模块控制动力产生与输出模块运动，传感检测模块将检测到的动力产生与输出模块的各种数据传送给核心控制模块；动力产生与输出模块包括为肢体进行等速运动提供所需阻力的动力输出轴；传感检测模块包括扭矩传感器、角位移传感器和滤波器；扭矩传感器和角速度传感器的输入端连接动力输出轴的输出端，输出端分别连接核心控制模块，滤波器连接角速度传感器和核心控制模块。本发明的动力输出轴能够提供等速运动所需阻力，传感检测模块检测动力输出轴的转矩、角速度、角位移，因此本发明能提供等速训练，又能检测肌力、角速度、角位移等重要物理量。
文档编号A61B5/22GK102138801SQ201010301048
公开日2011年8月3日 申请日期2010年2月2日 优先权日2010年2月2日
发明者孔令成, 张志华, 徐林森, 缪琴, 骆敏舟 申请人:常州机械电子工程研究所
最新回复(0)