CN110916969B - 一种利用减重车腰撑调节辅助下肢机器人重心转移的装置及控制方法 - Google Patents

Abstract

本发明涉及一种利用减重车腰撑调节辅助下肢机器人重心转移的装置及控制方法，包括：用于连接外骨骼机器人的腰撑组件；使腰撑组件上下移动以主动调整外骨骼机器人重心的升降动力机构；通过驱动升降动力机构以控制腰撑组件运动路径的控制器；控制器包括运动路径控制模块。本发明与现有技术相比，具有以下优点：根据人步行过程中的实际重心变化情况，通过减重车的腰撑电机主动拟合重心变化运动，提高了外骨骼机器人重心转移的柔顺程度，同时避免了可能会发生的电机堵转、机械卡死等问题。

Description

一种利用减重车腰撑调节辅助下肢机器人重心转移的装置及 控制方法

技术领域

本发明涉及一种利用减重车腰撑调节辅助下肢机器人重心转移的装置及控制方法。

背景技术

在临床上的各种患者(如脑卒中、脊髓损伤、骨折术后等引起的下肢运动功能障碍的恢复期患者)的下肢康复期，需要辅助设备进行减重支撑的辅助设备。目前在临床上没有太多的训练设备，而且康复需求不断扩大，然而专业康复人员缺乏；一对一模式人力成本高且耗时费力。为解决这些康复训练过程中出现的问题，急需安全、定量、有效及可进行重复训练的新技术。

康复减重步行训练车(下简称减重车)是通过减重支持帮助下肢运动功能障碍的患者进行步行训练的系统。在临床患者的康复中期，当患者下肢恢复一定的运动能力，可以落地进行辅助步行训练时，可以利用减重车的腰撑装置和悬吊装置给患者提供减重支撑，帮助患者双腿落地，模拟正常承重步态进行主动或被动训练。在这个过程中，由于腰撑固定在患者的胯部，在患者行走时若不进行重心调整，则可能会导致下肢机器人电机堵转或机械卡死，从而中断行走，无法进行持续的行走康复训练。因此，有必要设计一种利用减重车腰撑调节辅助下肢机器人重心转移的装置。

发明内容

针对现有技术存在的不足，本发明提供一种利用减重车腰撑调节辅助下肢机器人重心转移的装置及控制方法，在下肢机器人和患者行走时进行重心调整，防止下肢机器人电机堵转或机械卡死。

为实现上述目的，本发明采用的技术方案包括：一种利用减重车腰撑调节辅助下肢机器人重心转移的装置，其特征在于，包括：

用于连接外骨骼机器人的腰撑组件；

使腰撑组件上下移动以主动调整外骨骼机器人重心的升降动力机构；

通过驱动升降动力机构以控制腰撑组件运动路径的控制器；

控制器包括运动路径控制模块，运动路径控制模块中，

腰撑组件的运动路径方程为：

式中：

f(t)为腰撑组件起伏的高度，单位为m；t代表时间，范围为[0,T]，T为步态周期，σ为路径方程参数，μ＝T/2，σ＝40，K的取值范围[3-10]。

进一步地，腰撑组件包括被动减重机构，所述的被动减重机构包括：预紧力产生机构；与预紧力产生机构连接，且通过支点传递预紧力的支撑连接杆；与支撑连接杆连接的机器人安装板；腰撑组件向上或向下移动时，预紧力产生机构缩短或伸长。

优选的，所述的腰撑组件包括安装宽度调节机构、与升降动力机构连接的腰撑固定板、与腰撑固定板直接或间接地滑动连接的两个机器人安装板，安装宽度调节机构通过使两个机器人安装板向相反的方向横向滑动以放宽或收紧两个机器人安装板之间的距离。

优选的，升降动力机构为伺服电缸或伺服电机-丝杆螺母机构。

更具体地，升降动力机构包括伺服电机、第一丝杆、第一螺帽、腰撑连接座，第一螺帽位于第一丝杠上且与第一丝杆螺纹连接，当伺服电机驱动第一丝杆旋转时第一螺帽直线移动；第一螺帽通过腰撑连接座连接腰撑固定板，第一螺帽、腰撑连接座、腰撑固定板同步运动；控制器通过驱动伺服电机以控制腰撑组件运动路径。

优选的，所述的预紧力产生机构包括由上向下依次连接的固定连接座、导向杆、导向管、调节螺母和运动连接座；缓冲弹簧套接在导向杆和导向管的外周，同时限位在调节螺母和固定连接座之间，且所述的运动连接座的下部与支撑连接杆的受力端连接。

优选的，安装宽度调节机构为丝杆组件；丝杆组件包括滑座、滑轨、第二丝杆、第二螺帽、手轮、丝杆连接座；滑轨横向设置于腰撑固定板，第二丝杆为左右旋螺纹丝杠，第二丝杠的旋转使得两个第二螺帽直线运动且运动方向相反；腰撑固定板的两端与连接板连接，第二丝杆穿过两个连接板且第二丝杆的至少一端位于连接板之外且该端部连接手轮；被动减重机构的固定安装板的侧面连接滑座，滑座可在腰撑固定板的滑轨上滑动；固定安装板的正面连接丝杆连接座，丝杆连接座与第二螺母固定连接，当第二螺母直线运动时丝杆连接座、固定安装板、滑座一起滑动。

本发明还提供一种利用减重车腰撑调节辅助下肢机器人重心转移的控制方法，控制器通过驱动升降动力机构以控制腰撑组件的上下运动路径，腰撑组件的运动路径方程为：

式中：

f(t)为腰撑组件起伏的高度，单位为m；t代表时间，范围为[0,T]，T为步态周期，σ为路径方程参数，μ＝T/2，σ＝40，K的取值范围[3-10]。

本发明与现有技术相比，具有以下优点：

根据人步行过程中的实际重心变化情况，通过减重车的腰撑电机主动拟合重心变化运动，提高了外骨骼机器人重心转移的柔顺程度，同时避免了可能会发生的电机堵转、机械卡死等问题。

附图说明

图1为人体行走过程中下肢部分重心变化图(一个步态周期T)；

图2为本发明的实施方式的原理图；

图3为主动辅助重心转移机构正视图；

图4为主动辅助重心转移机构后侧视图；

图5为腰撑组件示意图；

图6为外骨骼机器人与减重车腰撑组件连接示意图；

图7为被动减重机构示意图；

图8为腰撑组件与减重车的连接示意图

图9-10为底盘驱动装置示意图；

其中，1伺服电机，2联轴器，3丝杆固定座，4第一螺帽，6腰撑连接座，7第一丝杆，8第一丝杆滑座，9腰撑固定板，10腰撑组件，11固定连接座，12导向杆，13缓冲弹簧，14导向管，15调节螺母，16运动连接座，17单耳连接座，18固定安装板，19固定支座，20平衡杆，21平衡板，22机器人安装板，23支撑座，24支撑连接杆，25腰撑组件，26滑座，27滑轨，28第二丝杆，29第二螺帽，30手轮，31外骨骼机器人，32插销，33车体下部横杆，34丝杆连接座，35连接板。

具体实施方式

下面结合附图和具体实施方式，进一步阐明本发明，应理解这些实施方式仅用于说明本发明而不用于限制本发明的范围，在阅读了本发明之后，本领域技术人员对本发明的各种等价形式的修改均落于本申请所附权利要求所限定的范围。

根据图2-7，一种利用减重车腰撑调节辅助下肢机器人重心转移的装置，包括：

用于连接外骨骼机器人的腰撑组件；使腰撑组件上下移动以主动调整外骨骼机器人重心的升降动力机构；通过驱动升降动力机构以控制腰撑组件运动路径的控制器；控制器包括运动路径控制模块，运动路径控制模块中，腰撑组件的运动路径方程为：

式中：

f(t)为腰撑组件起伏的高度，单位为m；t代表时间，范围为[0,T]，T为步态周期，σ为路径方程参数，μ＝T/2，σ＝40；K的取值范围[3-10]，根据不同患者的体型调节。

本发明中只需要确定路径方程，然后将距离(即腰撑组件起伏的高度)发送给电机执行，控制腰撑电机的起伏运动。

例如:控制器从下肢机器人接收到CAN数据帧[618 01 01 4A 01 14 1E 02],控制器解析数据，得到步长330mm，周期T＝3s，由此可得轨迹方程中的μ＝T/2＝1.5，轨迹方程中另外一参数K取值K＝4，也就是腰撑起伏高度为4cm。

具体实施例为：

1.控制系统选用树莓派作为控制器，腰撑电机(即升降动力机构的伺服电机)选择直流伺服电机；

2.当控制器接收到行走动作信号后，开始控制驱动电机(即控制减重车直线行驶的电机，该电机与减重车驱动轮连接)运动，带动减重车跟随下肢机器人和患者构成的整体同步行走(见详细的控制系统)；

3.在步骤2的同时，控制器控制腰撑伺服电机，按照规划好的曲线同步运动，规划路径方程为：

式中：

f(t)为腰撑组件起伏的高度，单位为m；t代表时间，范围为[0,T]，T为步态周期，σ为路径方程参数，μ＝T/2，σ＝40；K的取值范围[3-10]，根据不同患者的体型调节。

4.在患者开始起步的动作中，腰撑电机动作配合患者完成重心从最高点向下调整；

5.在患者作跨步运动的过程中，腰撑电机动作配合患者完成全周期重心转移调整。

6.对腰撑伺服电机进行最大最小行程软限位保护；

7.当患者停止步行训练，腰撑电机保持停机状态。

减重车(即康复减重步行训练车，上部设有减重悬吊装置，减重悬吊装置为现有技术)、下肢机器人(下肢康复机器人)相互连接，具体地，下肢机器人通过插销32(也可以为其它紧固装置)与腰撑组件端部的机器人安装板连接以实现快速拆装，具体地，下肢机器人左、右髋关节上方的侧板上设有销孔44，插销32穿过销孔44和机器人安装板22上的销孔以实现下肢机器人、机器人安装板的相互固定，即下肢机器人和腰撑组件的连接处位于下肢机器人左、右髋关节上方(图6)。

通过插销(可拆卸紧固装置)将腰撑固定板固定于扶手组件的扶手安装板38a上，而扶手安装板固定于车体滑块43上，车体两侧的车体滑块43可沿着竖向的车体两侧滑轨40滑动，在主动辅助重心转移机构带动下，腰撑固定板、腰撑组件、下肢机器人、扶手安装板、车体滑块一起上下起伏(图8)。

优选的，升降动力机构可为伺服电缸或丝杆螺母机构。

具体的，升降动力机构包括伺服电机1、第一丝杆7(其为滚珠丝杆)、第一螺帽4、腰撑连接座6等，第一螺帽4位于第一丝杠上且与第一丝杆螺纹连接，在第一丝杆旋转时第一螺帽上下移动；第一螺帽通过腰撑连接座连接腰撑固定板9，第一螺帽、腰撑连接座、腰撑固定板同步运动；腰撑固定板与机器人安装板通过直接或间接方式固定，从而机器人安装板也与第一螺帽、腰撑连接座、腰撑固定板同步运动。

以上技术方案中，腰撑组件通过丝杆连接一个伺服电机，在患者行走训练过程中通过控制伺服电机的速度和加速度以拟合人体重心变化运动实现外骨骼机器人和患者的整体的重心转移，从而保证了行走过程不会存在中断或者机械卡死的问题。同时由于这种辅助运动设计更符合人体行进物理运动规律，会给患者的康复训练过程提供更加舒适的体感。

优选的，腰撑组件包括被动减重机构，所述的被动减重机构包括：预紧力产生机构；与预紧力产生机构连接，且通过支点传递预紧力的支撑连接杆；与支撑连接杆连接的机器人安装板；腰撑组件向上或向下移动时，预紧力产生机构缩短或伸长。

优选的，所述的腰撑组件包括安装宽度调节机构、与升降动力机构连接的腰撑固定板、与腰撑固定板直接或间接地滑动连接的两个机器人安装板，安装宽度调节机构通过使两个机器人安装板向相反的方向横向滑动以放宽或收紧两个机器人安装板之间的距离。

在一个实施例中，所述的预紧力产生机构包括由上向下依次连接的固定连接座、导向杆、导向管、调节螺母和运动连接座；缓冲弹簧套接在导向杆和导向管的外周，同时限位在调节螺母和固定连接座之间，且所述的运动连接座的下部与支撑连接杆的受力端连接。

根据图3-8，一种辅助重心转移的康复减重步行训练车，包括训练车车体、腰撑组件10(包含被动减重机构、丝杆组件、腰撑固定板)、主动辅助重心转移机构。主动辅助重心转移机构位于训练车车体顶部或上部，为使腰撑组件实现上下升降的升降动力机构，例如伺服电机+丝杆螺母机构，也可以为伺服电缸等。

主动辅助重心转移机构包括伺服电机1、第一丝杆7(其为滚珠丝杆)、第一螺帽4、腰撑连接座6等，第一螺帽4位于第一丝杠上且与第一丝杆螺纹连接，在第一丝杆旋转时第一螺帽上下移动；第一螺帽通过腰撑连接座连接腰撑固定板9，第一螺帽、腰撑连接座、腰撑固定板同步运动。由于腰撑固定板连接丝杆组件，且腰撑固定板通过滑座连接被动减重机构的固定安装板，因此，当丝杆螺帽组件带动腰撑固定板上下移动时整个腰撑组件跟随腰撑固定板一起上下移动。腰撑连接座位于两个被动减重机构之间，且腰撑连接座与任意一个被动减重机构之间的距离相同(图4)。

伺服电机1通过联轴器2连接丝杆固定座3，丝杆固定座3用于固定第一丝杆7的一端，第一丝杆7的另一端固定于第一丝杆滑座8中，第一丝杆滑座可在车体下部横杆33的滑动槽中滑动，滑动是指滚珠丝杆旋转过程中丝杆端部的滑动(其为现有技术)。

如图5所示，腰撑组件10包含被动减重机构25、丝杆组件，被动减重机构如图7所示，被动减重机构为2个；丝杆组件包括滑座26、滑轨27、第二丝杆28、第二螺帽29、手轮30、丝杆连接座34。

其中滑轨为两个，横向平行设置于腰撑固定板的上下两端，腰撑固定板沿训练车车体左右延伸且基本水平设置，使用时腰撑固定板的高度对准待康复人体(即患者)腰部。第二丝杆为左右旋螺纹丝杠，有两个第二螺帽，第二丝杠的旋转使得两个第二螺帽直线运动且运动方向相反，使两个被动减重机构呈左右对称同时向内或向外滑动(两者运动方向相反)，向外指向靠近丝杆端部的方向移动，向内则反之。

腰撑固定板的两端与连接板35连接，连接板基本垂直于腰撑固定板，第二丝杆穿过两个连接板35且第二丝杆的至少一端位于连接板之外且该端部连接手轮。被动减重机构的固定安装板的侧面连接滑座，滑座可在腰撑固定板的滑轨上滑动；固定安装板18的正面连接丝杆连接座34，丝杆连接座34与第二螺母固定连接，当第二螺母直线运动时带动丝杆连接座、固定安装板、滑座一起横向滑动，而由于固定安装板是被动减重机构的一部分，因此被动减重机构也滑动，使得两个机器人安装板之间的距离可调整，适用于不同体型的待康复人体。

腰撑组件主要由腰撑固定板，两根滑轨、四个滑座、两套被动减重机构(被动减重机构内部包含缓冲弹簧)、两个第二螺帽、第二丝杆以及手轮等构成。其中两套被动减重机构呈左右对称固定于四个滑座上，同时其内部通过第二螺帽与第二丝杆螺纹连接，当转动手轮带动第二丝杆旋转时，因第二丝杆为左右螺丝丝杆，被动减重机构会呈左右对称同时向内或向外滑动以适应不同体态的患者。腰撑组件的机器人安装板与外骨骼机器人31通过左右两侧各两个快插销32进行连接以实现快速拆装，具体见图6。

被动减重机构如图7所示，固定连接座11的下部连接一导向杆12，为了保证后续缓冲弹簧的压缩形变情况以及受力强度，在导向杆12的下部连接更大直径的导向管14，而在导向管14的下部则连接有调节螺母15，调节螺母15的下部连接运动连接座16，而在调节螺母15和固定连接座11之间的导向杆12和导向管14的外周还套接有缓冲弹簧13，以上结构形成预紧力产生机构。固定连接座11固定不动，运动连接座跟随腰撑固定板9、固定安装板18一起移动。导向杆插入导向管中，运动连接座16的上下运动过程中，由于固定连接座始终不动，与固定连接座固定连接的导向杆也固定不动，导向杆伸入导向管内的那部分导向杆长度发生变化。

运动连接座16的下部与支撑连接杆24的其中一端连接，支撑连接杆24的这一端成为受力端，支撑连接杆24的中部与支撑座23连接，支撑座23形成支撑连接杆24的力的支点，支撑连接杆24的另一端则与其中一个固定支座19连接，该固定支座19设置在平衡板21的下端，平衡板21与机器人安装板22平行设置且固定连接，平衡板21的上端同时连接另一固定支座19，两个固定支座19、平衡板21和机器人安装板22共同通过螺栓连接为一个整体。

平衡板21上端的固定支座同时连接平衡杆20，平衡杆20的另一端连接第三个固定支座19，第三个固定支座19同时与固定安装板18的上端连接，固定安装板18平行平衡板21设置，且安装板18的下端与支撑座23连接，此时，三个固定支座19和一支撑座23形成四个连接点，而支撑连接杆24、平衡板21、平衡杆20和固定安装板18则为四条边，以上结构共同形成四点支撑机构。

固定安装板18上端在第三个固定支座19的背面还连接单耳连接座17，单耳连接座17同时与固定连接座11连接(例如铰接等活动连接方式，即单耳连接座跟随整个腰撑组件运动，实际上，整个腰撑组件中除了固定连接座、导向杆以外，其余结构均在升降动力机构作用下上下移动)，同时，固定安装板18还与训练车的腰撑固定板9滑动连接，在康复训练中，外骨骼机器人和训练车通常配合使用，在本实施例中，机器人安装板22为一L型板，其与外骨骼机器人固定连接。

工作原理：缓冲弹簧始终处于压缩状态(具有预紧力，可通过调节调节螺母位置或在组装被动减重机构时使调节螺母处于导向管的特定位置(比如下部)而实现)，缓冲弹簧13压缩产生预紧力作用在与调节螺母15相连接的运动连接座16上；运动连接座16将力传给支撑连接杆24；支撑连接杆24以支撑座23为力支点将力传给固定支座19；固定支座19与平衡板21、机器人安装板22通过螺栓连接为一个整体；最终缓冲弹簧13的预紧力通过机器人安装板22作用在外骨骼机器人上(缓冲弹簧给机器人安装板提供向上的作用力)，以抵消外骨骼机器人自身重力。

而平衡杆20、支撑连接杆24、固定支座19、支撑座23组成的四点支撑杆机构，保证了机器人安装板22始终处在水平位置并做上下运动；缓冲弹簧13在外骨骼机器人行走过程中抵消主动辅助重心转移机构上下移动对外骨骼机器人和患者的冲击力，并在外骨骼机器人行走过程中，给予外骨骼机器人一定的起重助力。

实际上，缓冲弹簧始终处于压缩状态，区别仅在于压缩的程度不同。

训练车开始工作时(例如患者穿戴上外骨骼机器人后行走，行走模式为被动模式即完全由外骨骼机器人带动患者行走；或者主动模式即由患者自己带动外骨骼机器人一起行走)，伺服电机-丝杆螺母结构带动腰撑连接座6、腰撑固定板9、腰撑组件10一起上下移动(腰撑组件在最下端与最上端之间来回移动)。

当伺服电机-丝杆螺母结构使腰撑组件10向上移动时，腰撑固定板9、固定安装板18、运动连接座16向上移动，而固定连接座11固定不动，缓冲弹簧13被进一步压缩，向运动连接座16施加向下的回弹力，通过杠杆结构给予另一侧的机器人安装板向上的缓冲作用力，即弹簧在腰撑组件10上行过程中提供向上的缓和助力，可以减少主动辅助重心转移机构带来的冲击力，使得整个腰撑组件的上行过程更为柔顺。

当伺服电机-丝杆螺母结构使腰撑组件10向下移动时，腰撑固定板9、固定安装板18、运动连接座16向下移动，而固定连接座11固定不动，缓冲弹簧逐渐回弹伸长，此时缓冲弹簧仍处于压缩状态，给予另一侧的机器人安装板向上的缓冲作用力，可以抵消主动辅助重心转移机构带来的冲击力，使得整个腰撑组件的下行过程更为平缓柔顺。

减重车的底盘驱动装置包括左右对称设置的两组驱动组件，所述的驱动组件包括作为支点的铰链轴3’、用于安装铰链轴的连接板10’、分别固定于连接板上的铰链轴两侧的动力驱动机构以及前轮组件；动力驱动机构的重量大于前轮组件的重量，使动力驱动机构的驱动轮5’始终与地面接触(图9-10)。

两组驱动组件左右对称设置。以上结构中，铰链轴作为支点，动力驱动机构、前轮组件通过铰链轴构成类似跷跷板结构，前轮组件构成跷跷板的一端，动力驱动机构构成跷跷板的另一端。因动力驱动机构一端重量大于前轮组件一端，当动力驱动机构遇到凸起或者凹坑时，在重力作用下驱动轮将始终保持与地面接触状态，从而避免悬空或打滑。

在以上的底盘驱动装置基础上，还可以作如下改进。所述的驱动轮设置于训练车中前部，两组驱动组件的两个驱动轮的中心连线(沿左右方向延伸)与训练车站立位置(待康复人体站立于该位置，待康复人体即患者)的中心连线(沿左右方向延伸，以患者双腿平齐站立于训练车站立位置时患者两腿中心的连线为患者中心连线)重合，使训练车在转弯或掉头时两组驱动组件的两个驱动轮做差速运动从而使训练车以训练车站立位置为中心做旋转运动。

在以上的底盘驱动装置基础上，还可以作如下改进。动力驱动机构包括动力机构、用于将动力机构的动力传递给驱动轮的传动机构、始终与地面接触的所述的驱动轮，驱动轮固定于连接板的后侧。

优选的，所述的动力机构包括伺服电机6’、与伺服电机连接的减速机14’、与伺服电机连接的驱动器7’(即电机驱动器)，传动机构包括第二同步带轮11’、同步带12’(即同步齿轮带)、第一同步带轮13’，伺服电机、减速机、第二同步带轮、同步带、第一同步带轮、驱动轮依序连接。每组驱动组件设有一个驱动轮以及两个连接板，驱动轮安装于两连接板之间，图9中，另一侧的连接板被遮挡而没有在图中示出。第二同步带轮与减速机同轴设置，第一同步带轮与驱动轮同轴设置，第一同步带轮与第二同步带轮通过同步带连接。伺服电机、减速机分别通过电机安装板、减速机安装板安装在连接板上，且伺服电机、减速机安装于驱动轮的后方。

在以上的底盘驱动装置基础上，还可以作如下改进。前轮组件包括前轮2’、用于安装前轮的前轮安装板1’，前轮安装板固定于连接板前部。驱动组件还包括固定于主梁后侧的后轮9’。

在以上的底盘驱动装置基础上，还可以作如下改进。所述的连接板中部偏前位置与铰接座通过铰接轴铰接，铰接座4’固定于主梁8’下端，连接板中部偏前位置位于连接板前部与连接板后侧之间。

一种实现下肢机器人与减重车协同运动的控制系统，包括控制器；所述的控制器包括距离信息采集模块、步态信息采集模块、速度控制模块、电机驱动模块、前述的运动路径控制模块；

所述的步态信息采集模块，用于接收下肢机器人发送的步态信息，得出当前下肢机器人是否起步、步长以及步态周期；

所述的距离信息采集模块，用于接收距离传感器采集的减重车与下肢机器人左腿、右腿之间距离的实时距离测量值；

所述的速度控制模块，在下肢机器人起步时根据下肢机器人的步态信息计算出减重车的速度并将速度信息发送至电机驱动模块；在减重车运动过程中，速度控制模块根据距离传感器采集的实时距离测量值计算下肢机器人左腿、右腿的实时行走速度，得到实时减重车速度修正值并将实时减重车速度修正值发送至电机驱动模块；

在下肢机器人起步时电机驱动模块接收减重车速度信息并驱动减重车开始行驶；在减重车运动过程中，电机驱动模块接收实时减重车速度修正值并通过控制电机使减重车以实时减重车速度修正值行驶。

下肢机器人与控制器通过CAN总线连接。在下肢机器人起步时，速度控制模块根据步态信息采集模块接收并解析的步态信息(例如下肢机器人的步长L、步态周期T)计算出减重车的速度S＝L/T(例如接收的CAN数据帧为跨步信息，步长330cm，步态周期3s，那么其初始速度为0.11m/s)，使电机驱动模块驱动减重车以S的初始速度行驶。控制器每隔10ms接收一次距离信息和步态信息。

CAN数据帧格式(数值为16进制)：

B1～B2 B3 B4 B5 B6 B7 B8 B9

B1～B2：帧ID

B3：0x01--开始起步 0x02--当前步结束

B4：0x01--左脚跨步 0x02--右脚跨步 0x11--左脚起步 0x12--右脚起步

0x21--左脚收步 0x22--右脚收步

B5：步长低位

B6：步长高位

B7：步高

B8：迈步的时间(单位100ms)例如--B8位是1E，也就是30，代表迈步时间是30*100＝3000ms，也就是3秒。

B9：0x01-训练停止0x02-训练开始

每条腿配置传感器两个，用来交叉检测纠错以及提高精度。在行走过程中，下肢机器人和患者迈不同步，两侧腿部实际速度不同，迈步腿的速度快，另一侧腿部的速度慢。

在减重车运动过程中，距离信息采集模块读取并保存上一时刻各距离传感器的距离测量值[last_d1,last_d2,last_d3,last_d4]，读取当前时刻各距离传感器的距离测量值[act_d1,act_d2,act_d3,act_d4]；

速度控制模块根据上一时刻和当前时刻距离检测值计算机器人腿部实时速度[speed1,speed2,speed 3,speed 4]，其中

speed[i]＝(act_d[i]-last_d[i])/t

其中t为通讯周期，i＝1，2，3,4；其中1、2传感器对准机器人左腿，3、4对准机器人右腿；传感器均设置于减重车上，位于机器人后方；

计算下肢机器人两侧腿部速度：

左腿实时速度：speed_left＝(speed1+speed2)/2

右腿实时速度：speed_right＝(speed3+speed4)/2

得到实时减重车速度修正值：

speed_car＝max(speed_left,speed_right)+last_speed_car；

其中last_speed_car指未经修正的当前时刻减重车速度值。max(speed_left,speed_right)指左、右腿实时速度中的最大值。

last_speed_car可以为初始速度S或上一时刻的减重车速度修正值；即，在下肢机器人刚起步时，在第一时刻接收到实时步态信息和距离信息，驱动减重车以S＝L/T的速度开始行使；在第二时刻(第二时刻与第一时刻相隔10ms，其它时刻依次类推)接收实时步态信息和距离信息，可以计算得到第二时刻的实时减重车速度修正值speed_car，此时last_speed_car即为初始速度S；在第三时刻接收实时步态信息和距离信息，可以计算得到第三时刻的实时减重车速度修正值speed_car，此时last_speed_car即为第二时刻的实时减重车速度修正值。

所述的减重车包括跟随模式开关；所述的控制器还包括跟随模式切换模块，跟随模式切换模块接收跟随模式开关的开闭信息并使得距离信息采集模块、步态信息采集模块、速度控制模块、电机驱动模块开始工作或停止工作。

所述的减重车包括急停开关；所述的控制器还包括急停模块，急停模块接收急停开关的急停信息并使得距离信息采集模块、步态信息采集模块、速度控制模块停止工作，并通过电机驱动模块、电机使减重车制动停车。跟随模式开关和急停开关均设置于减重车扶手上。

所述的距离传感器设置于减重车上，至少两个距离传感器对准下肢机器人左腿的小腿上部，至少两个距离传感器对准下肢机器人右腿的小腿上部，距离传感器安装的离地高度为30-40cm。距离传感器负责检测腿部实时速度，看整个系统当前运行的速度是否满足控制要求，也就是下肢机器人和减重车的协同速度是否一致，如果运动不一致，则控制器会根据减重车的实际速度进行动态调节，以达到最佳跟随效果。当患者穿戴下肢机器人站立在减重车中，距离传感器位于下肢机器人左腿或右腿的小腿的正后方。由于患者穿戴下肢机器人，距离传感器对准下肢机器人腿部就是对准患者腿部。而距离传感器与下肢机器人左腿或右腿的小腿的距离，指的是距离传感器与下肢机器人左腿或右腿的小腿的连线的距离，该连线与减重车行驶方向/下肢机器人行走方向平行。

控制器采用CAN总线通讯的方式接收下肢机器人步态信息，控制器每隔5-15ms(优选10ms)获取一次距离信息和步态信息。在下肢机器人刚起步时，速度控制模块根据下肢机器人的步长L、步态周期T计算出减重车的第一时刻的初始速度S＝L/T，使电机驱动模块驱动减重车以S的初始速度开始行驶。距离信息和步态信息是同时获取的，每隔10ms获取到实时的步态信息和距离信息，而机器人运动轨迹是预先设定的(一般地说，步长、步态周期都确定，模拟整个过程为匀速)，通过对距离信息的计算得到实时减重车速度修正值，在减重车行驶过程中始终驱动减重车以实时减重车速度修正值行驶，每隔10ms更新一次实时减重车速度修正值。在一次步行中，下肢机器人的步态轨迹、步长、步态周期、步高等都是确定的，因此，仅在起步时采用步态信息计算得到的速度值作为减重车初始速度，在减重车行驶过程中，始终以实时减重车速度修正值作为减重车行驶速度。

当控制器的步态信息采集模块接收到迈步信息，则减重车同步向前运动设定步长的半步距离；当控制器的步态信息采集模块接收到跨步信息，则使减重车同步向前运动设定步长的距离；以上距离不是由控制器直接控制的，而是只要不接收到收步信息，则减重车一直不停车制动，默认一直向前行驶。当控制器的步态信息采集模块接收到收步信息，则使减重车停车制动(具体地，当控制器的步态信息采集模块接收到收步信息，则将该收步信息发送至电机驱动模块，由电机驱动模块驱动减重车停车制动，减速度为固定的电机参数)。

步态信息是根据CAN通讯数据得到的，由CAN总线直接读取下肢机器人的步态信息，控制器接收的CAN报文的每一帧数据都会包含步长、周期、步态等信息，控制器解析报文然后发送指令控制减重车运动。迈步指开始起步时候的步态，由双腿并拢到其中一只腿迈出半步(通常右腿迈步起步)步长为半步，迈步周期为T/2；跨步指行走过程中正常交叉跨步行走，跨整个步长，跨步周期为T；收步为由跨步到双腿并拢停止的过程，步长为半步，周期为T/2。

优选的，当距离传感器检测到下肢机器人向前运动但减重车无动作(出现这种情况，是因为CAN总线通讯异常)，控制器接收下肢机器人实际运动状态(实际运动状态由距离传感器得到，按照通讯周期每隔10ms实时采集)并驱动减重车同步运动；控制器根据距离传感器实时检测到的减重车与下肢机器人腿部之间的距离的变化，同步实时调整减重车驱动系统的电机速度，以保证减重车和下肢机器人的跟随同步性；当距离传感器检测到下肢机器人与减重车的距离小于安全距离，控制器控制减重车驱动系统的电机制动，停止跟随。一般地，安全距离＝绝对距离-5cm。绝对距离:减重车与患者的最佳保持距离；安全距离:减重车与患者的最小距离。绝对距离可以是一个值，也可以是一个范围，这取决于传感器的测量精度，例如绝对距离可以为患者穿戴下肢机器人后、开始运动之前的下肢机器人小腿与距离传感器之间的距离(可以认为其为下肢机器人与距离传感器之间的初始距离)。

以上显示描述了本发明的基本原理、主要特征以及优点。本行业的技术人员应该了解，本发明不受上述实施例的限制，上述实施例和说明书中描述的只是说本发明的原理，在不脱离本发明精神和范围的前提下，本发明还会有各种变化和改进，这些变化和改进都落进要求保护本发明范围内。本发明要求保护范围由所附的权利要求书及其等效物界定。

Claims (8)

1.一种利用减重车腰撑调节辅助下肢机器人重心转移的装置，其特征在于，包括：

用于连接外骨骼机器人的腰撑组件；

使腰撑组件上下移动以主动调整外骨骼机器人重心的升降动力机构；

通过驱动升降动力机构以控制腰撑组件运动路径的控制器；

控制器包括运动路径控制模块，运动路径控制模块中，

腰撑组件的运动路径方程为：

式中：

f(t)为腰撑组件起伏的高度，单位为m；t代表时间，范围为[0,T]，T为步态周期，σ为路径方程参数，μ＝T/2，σ＝40，K的取值范围[3-10]。

2.根据权利要求1所述的一种利用减重车腰撑调节辅助下肢机器人重心转移的装置，其特征在于，腰撑组件包括被动减重机构，所述的被动减重机构包括：预紧力产生机构；与预紧力产生机构连接，且通过支点传递预紧力的支撑连接杆；与支撑连接杆连接的机器人安装板；腰撑组件向上或向下移动时，预紧力产生机构缩短或伸长。

3.根据权利要求1所述的一种利用减重车腰撑调节辅助下肢机器人重心转移的装置，其特征在于，所述的腰撑组件包括安装宽度调节机构、与升降动力机构连接的腰撑固定板、与腰撑固定板直接或间接地滑动连接的两个机器人安装板，安装宽度调节机构通过使两个机器人安装板向相反的方向横向滑动以放宽或收紧两个机器人安装板之间的距离。

4.根据权利要求1所述的一种利用减重车腰撑调节辅助下肢机器人重心转移的装置，其特征在于，升降动力机构为伺服电缸或丝杆螺母机构。

5.根据权利要求1所述的一种利用减重车腰撑调节辅助下肢机器人重心转移的装置，其特征在于，升降动力机构包括伺服电机、第一丝杆、第一螺帽、腰撑连接座，第一螺帽位于第一丝杠上且与第一丝杆螺纹连接，当伺服电机驱动第一丝杆旋转时第一螺帽直线移动；第一螺帽通过腰撑连接座连接腰撑固定板，第一螺帽、腰撑连接座、腰撑固定板同步运动；控制器通过驱动伺服电机以控制腰撑组件运动路径。

6.根据权利要求2所述的一种利用减重车腰撑调节辅助下肢机器人重心转移的装置，其特征在于，所述的预紧力产生机构包括由上向下依次连接的固定连接座、导向杆、导向管、调节螺母和运动连接座；缓冲弹簧套接在导向杆和导向管的外周，同时限位在调节螺母和固定连接座之间，且所述的运动连接座的下部与支撑连接杆的受力端连接。

7.根据权利要求3所述的一种利用减重车腰撑调节辅助下肢机器人重心转移的装置，其特征在于，安装宽度调节机构为丝杆组件；丝杆组件包括滑座、滑轨、第二丝杆、第二螺帽、手轮、丝杆连接座；滑轨横向设置于腰撑固定板，第二丝杆为左右旋螺纹丝杠，第二丝杠的旋转使得两个第二螺帽直线运动且运动方向相反；腰撑固定板的两端与连接板连接，第二丝杆穿过两个连接板且第二丝杆的至少一端位于连接板之外且该端部连接手轮；被动减重机构的固定安装板的侧面连接滑座，滑座可在腰撑固定板的滑轨上滑动；固定安装板的正面连接丝杆连接座，丝杆连接座与第二螺母固定连接，当第二螺母直线运动时丝杆连接座、固定安装板、滑座一起滑动。

8.一种利用减重车腰撑调节辅助下肢机器人重心转移的控制方法，其特征在于，

控制器通过驱动升降动力机构以控制腰撑组件的上下运动路径，腰撑组件的运动路径方程为：

式中：

f(t)为腰撑组件起伏的高度，单位为m；t代表时间，范围为[0,T]，T为步态周期，σ为路径方程参数，μ＝T/2，σ＝40，K的取值范围[3-10]。

Images