[发明专利]一种多关节等速训练控制方法及系统

说明书

本发明公开了一种多关节等速训练控制方法及系统，它属于多关节等速训练装置技术领域，包括以下步骤：S1：获取转动臂的目标转速；S2：获取转动臂的第一转动角度，获取驱动组件的第一输出扭矩，获取转动臂的第一实时转速；S3：根据第一实时转速和第一转动角度，计算转动臂的第二转动角度；S4：根据第一实时转速、第一转动角度和第一输出扭矩，计算驱动组件的第二输出扭矩和转动臂的第二实时转速；S5：驱动组件以第二输出扭矩驱动转动臂以第二实时转速转动；本发明可以实时的计算并调整驱动组件的输出扭矩，从而可以精准的控制转动臂的转动角度、速度及扭矩，保证转动臂可以带动用户的关节等速运动，保证用户的康复训练效果。

技术领域

本发明涉及多关节等速训练装置技术领域，具体涉及一种多关节等速训练控制方法及系统。

背景技术

等速运动是指在关节运动过程中运动速度恒定而阻力可变，在运动过程中，肌肉用力仅使肌肉力量增加、力矩输出增加，而不改变运动过程中角速度的大小，即运动速度恒定。等速运动是在关节活动的整个范围内，肌肉都能承受最大负荷的一种运动模式，最初主要用于肌肉功能评价和运动损伤后的肌力训练，近年来，随着研究的不断展开，该技术逐渐应用于康复医学领域。

现有的关节训练的主要方式是由肌肉收缩引起的肢体围绕其关节某一轴进行角速度不变的旋转，肌纤维长度缩短或被拉伸，引起明显的关节活动，是一种动力性收缩，类似于等张收缩。而在等速运动中，等速仪器所提供的是一种顺应性阻力，阻力大小随肌肉收缩张力的大小而变化，类似等长收缩。因此，等速运动更适用于康复或测试时的恢复和加强肌肉力量。

在等速训练的过程中，需要将用户的肢体固定在转动臂上，跟随转动臂可以做等速的摆动，通常情况下，用户的肢体摆动至不同的位置处时，对转动臂的作用力的大小和方向是不同的，即用户的肢体对转动臂的作用力为动态力，因此，为了保证转动臂可以持续并精准的等速摆动，就需要根据用户肢体对转动臂的动态力实时的调整驱动组件的扭矩；现有的多关节等速训练控制设备均需要配置扭矩传感器来检测驱动组件的输出扭矩，这会限制多关节等速训练控制设备的结构和设计空间，增大了多关节等速训练控制设备的体积和复杂度；同时，现有的多关节等速训练控制设备对于变化的动态力难以精准的调整驱动组件的扭矩，会使得转动臂的摆动难以精准的等速运动，给用户的康复训练带来困难。

发明内容

对于现有技术中所存在的问题，本发明提供的一种多关节等速训练控制方法及系统，可以实时的计算并调整驱动组件的输出扭矩，从而可以精准的控制转动臂的转动角度、速度及扭矩，保证转动臂可以带动用户的关节等速运动，保证用户的康复训练效果。

为了实现上述目的，本发明采用的技术方案如下：

一方面，本发明提供了一种多关节等速训练控制方法及系统，包括以下步骤：

S1：获取转动臂的目标转速；

S2：在时刻，获取转动臂的第一转动角度，获取驱动组件对转动臂的第一输出扭矩，获取转动臂的第一实时转速；

S3：根据所述第一实时转速和所述第一转动角度，计算在时刻时，所述转动臂的第二转动角度；

S4：根据所述第一实时转速、所述第一转动角度和所述第一输出扭矩，计算在时刻时，驱动组件对转动臂的第二输出扭矩和所述转动臂的第二实时转速；

S5：在时刻时，驱动组件以第二输出扭矩驱动所述转动臂以所述第二实时转速转动；

S6：令=，并重复步骤S2-S5。

作为一种优选的技术方案，在步骤S2中，通过角度传感器获取所述转动臂的所述第一转动角度；通过扭矩传感器获取所述驱动组件对所述转动臂施加的所述第一输出扭矩；通过转速传感器获取所述转动臂的所述第一实时转速。

作为一种优选的技术方案，在步骤S3中，所述第二转动角度的计算公式为：

；