一种助力外骨骼控制方法、控制系统和计算机设备
文献发布时间:2023-06-19 11:03:41
技术领域
本发明涉及可穿戴机器人领域,具体涉及一种助力外骨骼控制方法、控制系统和计算机设备。
背景技术
随着社会老龄化程度的加剧,用于老年人日常辅助的服务机器人得到越来越多的应用。其中,可穿戴式助力外骨骼设备是通过穿戴于身体外部的机器人装置为穿戴者肢体提供助力,以辅助穿戴者更方便地完成日常生活。此外,由于偏瘫、中风等疾病因素引起行动障碍患者,在康复过程中也需要依靠此类自动化的辅助设备进行训练。
目前外骨骼技术及相关产品智能化程度较低,难以适应复杂的日常生活场景,如在不规则步态或上下楼梯等多场景下,外骨骼仍需要手动参与调节,影响穿戴者日常体验。因此,作为外骨骼技术的核心之一的外骨骼的控制系统及方法一直在不断的更新改进。
但现有技术中,助力外骨骼的控制技术一般采用以下几种方式:
1、助力外骨骼的控制技术主要以位置控制为主,即以外骨骼以预先规划和编程好的轨迹运动,该技术通常按按照意图识别、步态识别、运动控制的顺序进行。这种方式穿戴者需要按迁就外骨骼设定好的轨迹,行动缓慢、效率低。而且对于有行动能力的穿戴者来说,严重限制了其自主运动的自由。
2、采用扭矩控制技术的外骨骼相对于位置控制更加灵活。外骨骼扭矩控制技术通常需要利用传感器检测信息输出相应辅助扭矩,常采用模式识别技术进行行走场景区分,但这种方式无法保证百分之百识别准确,一旦出现误识别情形,可能对穿戴者造成伤害。
3、依靠穿戴于足底的压力传感器或者力敏电阻检测步态事件,但该技术问题也存在问题:足底传感器只能检测下肢处于支撑相(脚与地面接触)的信号,在摆动相(脚离地)无法检测步态事件;足底力传感器易损坏,而且需要根据初戴者体型配置相应的鞋垫,穿戴体验差。
发明内容
本发明提供一种助力外骨骼控制方法、控制系统和计算机设备,以解决现有技术中外骨骼使用需要进行场景区分、步态事件识别不足和穿戴体验差的问题。
一种助力外骨骼控制方法,包括:
检测并记录各时间节点的实时关节角度;
根据前后时间节点的所述实时关节角度计算得到变化角度;
根据所述变化角度生成辅助扭矩值;
根据所述辅助扭矩值实时输出扭矩指令;
根据所述扭矩指令驱动相应关节。
进一步地,所述关节角度包括髋关节角度,所述髋关节角度包括左髋关节角度、右腿髋关节角度。
进一步地,所述检测并记录各时间节点的实时关节角度之前,包括:
检测并记录所述关节角度的初始数据,所述初始数据为用户在穿戴好助力外骨骼物理本体后保持双腿站立静止状态的数据。
进一步地,所述检测并记录各时间节点的实时关节角度之前,包括:
确定是否接收到启动助力模式指令;
若接收到所述启动助力模式指令,则进入所述助力模式,根据前后节点的所述变化角度生成所述辅助扭矩值;若未接收到所述启动助力模式指令,则控制扭矩始终为零。
进一步地,所述根据所述变化角度计算得到辅助扭矩值,包括:
通过将所述变化角度进行平滑处理,获得平滑角度值;
根据所述平滑角度值以及设定好的规则确定助力系数;
根据所述平滑角度值、所述助力系数以及舒适参数计算输出所述辅助扭矩值,所述舒适参数为用户根据助力的舒适程度调整的参数。
进一步地,所述通过将所述变化角度进行平滑处理,获得平滑角度值,包括:
将T时刻及其之前的N个节点时刻的所述实时关节角度进行均值滤波处理,以获得平滑角度值;
所述均值滤波处理公式为:θ
进一步地,所述根据所述平滑角度值以及设定好的规则确定助力系数,包括:
若
若
进一步地,所述根据所述平滑角度值、所述助力系数以及舒适参数计算输出所述辅助扭矩值,包括:
根据如下公式计算所述辅助扭矩值:
τ
τ
所述Δt为所述舒适参数,所述θ
一种助力外骨骼控制系统,包括:
检测模块,用于检测并记录各时间节点的实时关节角度;
生成模块,用于根据前后时间节点的所述实时关节角度计算得到变化角度,并根据所述变化角度生成辅助扭矩值;
输出模块,用于根据所述辅助扭矩值实时输出扭矩指令;
驱动模块,用于根据所述扭矩指令驱动相应关节。
一种计算机设备,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现上述助力外骨骼控制方法的步骤。
上述助力外骨骼控制方法、系统、计算机设备及存储介质,通过检测、记录各节点的实时关节角度,根据前后节点的实时关节角度计算得到变化角度,然后生成辅助扭矩值及扭矩指令,并根据扭矩指令的辅助扭矩值驱动相应关节。本发明采用无模式识别的扭矩控制方法,不需要进行人体意图识别、场景分类、步态规划等环节,避免了因意图识别、场景分类等误识别引起的潜在不安全因素,且传感器使用简单,仅需要测量关节的运动角度,测控系统可靠性好,信息处理量小,避免了使用压力鞋垫等耗材,节约了成本。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对本发明实施例的描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1是本发明一实施例中助力外骨骼控制方法的流程示意图;
图2是本发明一实施例中助力外骨骼控制方法步骤S30的实现流程示意图;
图3是本发明一实施例中助力外骨骼控制系统示意图;
图4是本发明一实施例中计算机设备的示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明实施例提供的助力外骨骼控制方法,应用客户使用的外骨骼中,外骨骼对用户实时的关节角度的数据进行测量、记录,根据计算出辅助扭矩以驱动关节,并将数据传输至客户端,客户端通过网络与外骨骼进行通信。客户端可以但不限于各种个人计算机、笔记本电脑、智能手机、平板电脑和便携式可穿戴设备。
在一实施例中,如图1所示,提供一种助力外骨骼控制方法,该方法应用在图1中的外骨骼,包括如下步骤:
S10:检测并记录各时间节点的实时关节角度。
在运动时,根据姿势的变化产生不同的关节角度,在不同的时间点,外骨骼通过传感器对某一关节的关节角度进行实时检测和记录,可获得不同的关节角度。具体的,该某一关节为下肢的关节,行走时,下肢关节在腿抬起时或腿落下时,形成不同的角度。
由于髋关节的关节角度较好检测且数据较少,本实施例中测量并记录的关节角度为髋关节角度,包括左、右髋关节角度。在其他实施例中,还可以检测和记录其他下肢关节的角度,如脚踝关节角度、膝关节角度。
S20:根据前后时间节点的实时关节角度计算得到变化角度。
检测并记录的不同时间点的关节角度,并对前后时间点不同的关节角度进行计算,得到关节的变化角度。例如,在T
S30:根据变化角度生成辅助扭矩值。
按照一定的规则,根据实时计算出的左、右髋关节变化角度来生成不同时间节点的辅助扭矩值τ(t)。例如,辅助扭矩值τ(t)的计算方式为:助力系数乘以左右髋关节变化角度的sin值之差,在其他实施例中,还可以采用其它规则生成辅助扭矩值,在此不再赘述。
S40:根据辅助扭矩值实时输出扭矩指令。
在计算得到辅助扭矩值τ(t),根据生成的辅助扭矩值τ(t)实时输出扭矩指令,以便后续外骨骼根据扭矩指令来驱动髋关节运动。
S50:根据扭矩指令驱动相应关节。
根据实时输出的扭矩指令来驱动髋关节,驱使外骨骼左右腿运动。
本实施例中,通过检测、记录各节点的实时关节角度,根据前后节点的实时关节角度计算得到变化角度,然后生成辅助扭矩值及扭矩指令,并根据扭矩指令的辅助扭矩值驱动相应关节。本发明采用无模式识别的扭矩控制方法,不需要进行人体意图识别、场景分类、步态规划等环节,避免了因意图识别、场景分类等误识别引起的潜在不安全因素,且传感器使用简单,仅需要测量关节的运动角度,测控系统可靠性好,信息处理量小,避免了使用压力鞋垫等耗材,节约了成本。
而采用测量髋关节角度的方式,只需要测量髋关节的角度变化趋势,就可以确定腿的运动方式,比脚踝关节和膝关节的关节角度好检测且数据较少,减少了数据检测量和计算量,节约了成本,提高了用户的穿戴体验。
在一实施例中,在检测并记录各时间节点的实时关节角度之前,即步骤S10之前,包括:检测并记录关节角度的初始数据,初始数据为用户在穿戴好助力外骨骼物理本体后保持双腿站立静止状态的数据。
用户在穿戴好助力外骨骼物理本体后,保持双腿站立静止状态,启动外骨骼电源,使外骨骼系统上电,此时,系统中记录的数据可能是上一次使用时留下的数据,如果不对该数据进行清除,会对后续变化角度的计算产生影响,进而影响到辅助扭矩地准确性。因此,在上电后,需要对系统进行初始化,即对上一次留下的数据进行清除,并通过传感器对清除后的髋关节角度进行检测并记录,获得在保持双腿站立静止状态下的髋关节的初始数据。
本实施例中,通过对外骨骼系统的初始化,清除了上一次留下的数据,并获得了保持双腿站立静止状态下的髋关节的初始数据,消除了上一次的使用数据对计算结果的影响,提高了数据的准确性。
在一实施例中,在检测并记录各时间节点的实时关节角度之前,即步骤S10之前,包括:
确定是否接收到启动助力模式指令;
若接收到启动助力模式指令,则进入助力模式,根据前后节点的变化角度生成辅助扭矩值;若未接收到启动助力模式指令,则控制扭矩始终为零。
在检测并记录各时间节点的实时关节角度之前,或者在检测并记录关节角度的初始数据之后,检测并记录各时间节点的实时关节角度之前,用户可以通过客户端向外骨骼发送是否启动助力模式的指令。如果外骨骼接收到客户端发送的启动助力模式指令,则外骨骼进入助力模式,对髋关节角度进行实时的检测记录,并计算出实时的变化角度,再根据实时的变化角度生成辅助扭矩值,以驱动髋关节运动;如果外骨骼未接收到客户端发送的启动助力模式指令,则外骨骼不启动助力模式,随后外骨骼输出的扭矩始终为零。
本实施例中,用户通过客户端向外骨骼发送是否启动助力模式的指令,来选择是否进入模式,增加了用户使用外骨骼的选择性,提高了用户的使用体验。
在一实施例中,如图2所示,步骤S30中,即根据所述变化角度计算得到辅助扭矩值,具体包括如下步骤:
S301:通过将变化角度进行平滑处理,获得平滑角度值。
通过对髋关节的某时间点的变化角度θ(t)进行平滑处理,获得进行平滑处理后的平滑角度值θ
S302:根据平滑角度值以及设定好的规则确定助力系数。
根据获得的平滑角度值和设定好的规则来确定不同髋关节的助力系数。例如,在不同姿态中,髋关节的助力系数不同,当平滑角度值θ
S303:根据平滑角度值、助力系数以及舒适参数计算输出辅助扭矩值,舒适参数为用户根据助力的舒适程度调整的参数。
根据输出的辅助扭矩值来驱动髋关节关节运动,即便在对变化角度进行平滑处理后,髋关节动作已经尽量平缓了,但每个人对动作的舒适感体验不一样,有些用户喜欢幅度大一些的动作,有些用户喜欢幅度小一些的动作,所以还提供了一个可供用户调试的舒适参数,以使用户获得流畅舒适的外骨骼使用体验。
本实施例中,用户通过对关节变化角度进行平滑处理,根据获得的平滑角度值及特定规则确定助力系数,并在此基础上增加了舒适参数以生成辅助扭3适感和使用体验。
进一步地,步骤S301中,采用均值滤波的方式对髋关节的变化角度进行平滑处理,以得到平滑角度值,包括:
将T时刻及T时刻之前的N个节点时刻的实时关节角度进行均值滤波处理,以获得平滑角度值;
均值滤波处理公式为:θ
例如,T时刻(8:00:04)的实时髋关节角度为50°,之前4个节点时刻的实时关节角度分别为:8:00:03时的髋关节角度为36°、8:00:02时的髋关节角度为23°、8:00:01时的髋关节角度为11°、在8:00:00时的髋关节角度为0°,则在8:00:04时髋关节的变化角度为11°、在8:00:03时髋关节的变化角度为12°、在8:00:02时髋关节的变化角度为13°、在8:00:01时髋关节的变化角度为14°,那么此时,T时刻(8:00:04)的髋关节平滑角度为:(11°+12°+13°+14°)/4=12.5°。
本实施中,采用均值滤波的方式对关节的变化角度进行平滑处理,方法简单且波动小,减少了关节变化角度的可能出现的误差,提高了髋关节变化角度的平缓性。在其他实施例中,还可以采用其他平滑处理方式,如中值滤波方式。
进一步地,步骤S302中,根据平滑角度值以及设定好的规则确定助力系数,包括:
若
若
具体地,当
本实施例中,通过设定初始助力值k、根据实际需要修改的助力值k
本实施例中,通过根据设定初始助力值、根据实际需要修改的助力值和重力补偿系数来确定助力系数,在其他实施例中,可采用其他方法来确定助力系数,在此不再赘述。
进一步地,步骤S303中,根据所述平滑角度值、助力系数以及舒适参数计算输出辅助扭矩值,包括:
根据如下公式计算所述辅助扭矩值:
τ
τ
其中,Δt为舒适参数,θ
例如,初始助力系数k为1与助力值k
本实施例中,通过根据可设置并修改的舒适参数来对关节角度变化小,使关节动作更平缓,进一步提高了运动时的舒适性和平稳性。
在其他实施例中,可采用其他方法来计算辅助扭矩值,在此不再赘述。
应理解,上述实施例中各步骤的序号的大小并不意味着执行顺序的先后,各过程的执行顺序应以其功能和内在逻辑确定,而不应对本发明实施例的实施过程构成任何限定。
在一实施例中,提供一种助力外骨骼控制系统,该助力外骨骼控制系统与上述实施例中助力外骨骼控制方法一一对应。如图3所示,该助力外骨骼控制系统包括检测模块401、生成模块402、输出模块403和驱动模块404。各功能模块详细说明如下:
401:检测模块,用于检测并记录各时间节点的实时关节角度。
402:生成模块,用于根据前后时间节点的实时关节角度计算得到变化角度,并根据变化角度生成辅助扭矩值。
403:输出模块,用于根据辅助扭矩值实时输出扭矩指令。
404:驱动模块,用于根据扭矩指令驱动相应关节。
关于助力外骨骼控制系统的具体限定可以参见上文中对助力外骨骼控制方法的限定,在此不再赘述。上述助力外骨骼控制系统中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的处理器中,也可以以软件形式存储于计算机设备中的存储器中,以便于处理器调用执行以上各个模块对应的操作。
在一个实施例中,提供了一种计算机设备,如图4所示。该计算机设备包括通过系统总线连接的存储器401、处理器402和收发器403,存储器401、处理器402和收发器403通过总线404连接。其中,该计算机设备的处理器402用于提供计算和控制能力。该计算机设备的收发器403用于收发数据/指令,该计算机设备的存储器401包括非易失性存储介质、内存储器。该非易失性存储介质存储有操作系统和计算机程序。该内存储器401为非易失性存储介质中的操作系统和计算机程序的运行提供环境。示例性的,该计算机设备采用嵌入式系统,该计算机程序被处理器402执行时以实现上述的助力外骨骼控制方法。
在一个实施例中,提供了一种计算机可读存储介质,其上存储有计算机程序,计算机程序被处理器执行时实现上述实施例所述的助力外骨骼控制方法。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一非易失性计算机可读取存储介质中,该计算机程序在执行时,可包括如上述各方法的实施例的流程。其中,本申请所提供的各实施例中所使用的对存储器、存储、数据库或其它介质的任何引用,均可包括非易失性和/或易失性存储器。非易失性存储器可包括只读存储器(ROM)、可编程ROM(PROM)、电可编程ROM(EPROM)、电可擦除可编程ROM(EEPROM)或闪存。易失性存储器可包括随机存取存储器RAM或者外部高速缓冲存储器。作为说明而非局限,RAM以多种形式可得,诸如静态RAM(SRAM)、动态RAM(DRAM)、同步DRAMSDRAM、双数据率SDRAM(DDRSDRAM)、增强型SDRAM(ESDRAM)、同步链路(Synchlink)DRAM(SLDRAM)、存储器总线(Rambus)直接RAM(RDRAM)、直接存储器总线动态RAM(DRDRAM)、以及存储器总线动态RAM(RDRAM)等。
所属领域的技术人员可以清楚地了解到,为了描述的方便和简洁,仅以上述各功能单元、模块的划分进行举例说明,实际应用中,可以根据需要而将上述功能分配由不同的功能单元、模块完成,即将所述装置的内部结构划分成不同的功能单元或模块,以完成以上描述的全部或者部分功能。
以上所述实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围,均应包含在本发明的保护范围之内。
- 一种助力外骨骼控制方法、控制系统和计算机设备
- 一种下肢助力外骨骼机器人的步态控制方法和控制系统