CN104224498B - 一种外骨骼机器人系统及基于运动学末端检测的控制方法 - Google Patents
一种外骨骼机器人系统及基于运动学末端检测的控制方法 Download PDFInfo
- Publication number
- CN104224498B CN104224498B CN201410491096.6A CN201410491096A CN104224498B CN 104224498 B CN104224498 B CN 104224498B CN 201410491096 A CN201410491096 A CN 201410491096A CN 104224498 B CN104224498 B CN 104224498B
- Authority
- CN
- China
- Prior art keywords
- cantilever beam
- supporting leg
- leg
- plate
- rotational angle
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000001514 detection method Methods 0.000 title claims abstract description 54
- 238000000034 method Methods 0.000 title claims abstract description 34
- 210000002414 leg Anatomy 0.000 claims abstract description 111
- 230000005484 gravity Effects 0.000 claims abstract description 21
- 238000005259 measurement Methods 0.000 claims abstract description 15
- 210000003127 knee Anatomy 0.000 claims abstract description 7
- 210000004394 hip joint Anatomy 0.000 claims description 46
- 210000000629 knee joint Anatomy 0.000 claims description 30
- 210000003141 lower extremity Anatomy 0.000 claims description 20
- 230000005540 biological transmission Effects 0.000 claims description 11
- 230000001133 acceleration Effects 0.000 claims description 9
- 229920001971 elastomer Polymers 0.000 claims description 9
- 210000001624 hip Anatomy 0.000 claims description 9
- 239000011888 foil Substances 0.000 claims description 8
- 210000000689 upper leg Anatomy 0.000 claims description 5
- 238000004891 communication Methods 0.000 claims description 3
- 230000002093 peripheral effect Effects 0.000 claims description 3
- 239000000806 elastomer Substances 0.000 claims 3
- 230000002153 concerted effect Effects 0.000 claims 2
- 238000013507 mapping Methods 0.000 claims 2
- 230000010355 oscillation Effects 0.000 claims 2
- 239000011551 heat transfer agent Substances 0.000 claims 1
- 238000007689 inspection Methods 0.000 claims 1
- 238000003754 machining Methods 0.000 claims 1
- 238000012545 processing Methods 0.000 claims 1
- 230000033001 locomotion Effects 0.000 abstract description 12
- 230000003993 interaction Effects 0.000 abstract description 7
- 230000000694 effects Effects 0.000 abstract description 4
- 230000003183 myoelectrical effect Effects 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 11
- 244000309466 calf Species 0.000 description 6
- 239000010408 film Substances 0.000 description 4
- 210000001503 joint Anatomy 0.000 description 3
- 210000003205 muscle Anatomy 0.000 description 3
- 238000011160 research Methods 0.000 description 2
- 230000035945 sensitivity Effects 0.000 description 2
- 230000001953 sensory effect Effects 0.000 description 2
- 206010013786 Dry skin Diseases 0.000 description 1
- 206010033425 Pain in extremity Diseases 0.000 description 1
- 210000000577 adipose tissue Anatomy 0.000 description 1
- 230000032683 aging Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000007667 floating Methods 0.000 description 1
- 238000007499 fusion processing Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 210000004243 sweat Anatomy 0.000 description 1
- 239000010409 thin film Substances 0.000 description 1
Landscapes
- Manipulator (AREA)
Abstract
一种外骨骼机器人系统及基于运动学末端检测的控制方法，它涉及一种外骨骼机器人系统及控制方法，以解决传统肌电信号检测方法实现辅助提高人体行走，难以达到准确的控制效果，在辅助人体行走过程中抵抗自身的重力方面，人机交互性能差，没有行之有效的控制方法的问题。它包括上体后背部、左腿和右腿，左腿和右腿分别包括髋部驱动系统、膝部驱动系统、脚部穿戴系统和捆绑装置；它还包括鞋垫板、后背检测壳体、九轴航姿测量模块、工控计算机、两个薄膜压力传感器、两个第一角度传感器、两个第二角度传感器、两个三轴倾角传感器和三套三维接触力检测装置；本发明用于助力行走和人体运动姿态的检测控制。
Description
技术领域
本发明涉及一种外骨骼机器人系统及控制方法。
背景技术
可穿戴式外骨骼逐渐成为机器人领域的一个研究热点。可以帮助人体负重，增强运动的能力。在背负重物行走方面，目前外骨骼研究领域已有多种控制方法可以实现该功能。但在辅助人体行走过程中抵抗自身的重力方面，尚无行之有效的控制方法。然而，后者对于辅助老人行走应用中，具有重要的意义。随着人口老龄化的发展，越来越多的老年人面临日常生活，行动的困难。肌肉力量的衰退使其难以像健康人一样健步如飞。因此，需要一种外骨骼控制技术，使老人穿戴后，可以帮助老人承受自身的体重，从而使下肢关节在行走中所需的肌肉力成比例减小。
传统的做法是通过肌电信号检测，在下肢关节动作之前，判断出人体的运动意图，从而对关节提供适当的辅助扭矩，来帮助人体行走。然而肌电信号的检测难以达到精确的控制需求，人体的皮肤表面肌电信号强弱因人而异，受多种因素的影响，如人体的胖瘦，皮肤的粗糙度，运动过程中有无汗液等。因此，肌电信号控制方法在实际使用中，难以达到准确的控制效果，也不便于日常生活中的使用，申请号为201310688125.3的发明专利申请提出一种拟人化的下肢助力外骨骼机器人，通过外骨骼来分担人体的部分重力，但是该机器人在辅助人体行走过程中抵抗自身的重力方面，人机交互性能差，没有行之有效的控制方法。
发明内容
本发明是为解决传统肌电信号检测方法实现辅助提高人体行走，难以达到准确的控制效果，在辅助人体行走过程中抵抗自身的重力方面，人机交互性能差，没有行之有效的控制方法的问题，进而提供一种外骨骼机器人系统及基于运动学末端检测的控制方法。
本发明为解决上述问题采取的技术方案是：
本发明的一种外骨骼机器人系统包括上体后背部、左腿和右腿，左腿和右腿分别包括髋部驱动系统、膝部驱动系统、脚部穿戴系统和捆绑装置；上体后背部包括人体后背支架和负载安装板，人体后背支架安装在负载安装板上，髋部驱动系统包括外壳，膝部驱动系统包括小腿连接板，脚部穿戴系统包括U形连接板、脚部橡胶鞋底和两个立式支耳，U形连接板的中部与小腿连接板的下端铰接，U形连接板的两端分别与两个立式支耳转动连接；
它还包括鞋垫板、后背检测壳体、九轴航姿测量模块、工控计算机、两个薄膜压力传感器、两个第一角度传感器、两个第二角度传感器、两个三轴倾角传感器和三套三维接触力检测装置；
每个脚部穿戴系统的U形连接板与小腿连接板连接的转轴上安装有第二角度传感器，每个脚部穿戴系统的U形连接板与立式支耳连接的转轴上安装有第一角度传感器，两个外壳的端部各安装有三轴倾角传感器，两个捆绑装置上各安装有薄膜压力传感器；
三个三维接触力检测装置分别布置在人体后背板支架和相应的底板上；
每套三维接触力检测装置包括水平力传递板、第一连杆、第二连杆、第三连杆、第四连杆、弹性体和两个槽形支撑板；
所述弹性体包括本体、第一悬臂梁、第二悬臂梁、第三悬臂梁、第一弹性板、第二弹性板、第三弹性板和六个应变片；本体的中部加工有纵向设置的第三悬臂梁，第三悬臂梁的两侧的本体上各固装有纵向设置的第三弹性板，本体的两侧分别固装有第一悬臂梁和第二悬臂梁，第一悬臂梁的下部固装有第一弹性板且二者连接为一体，第二悬臂梁的下部固装有第二弹性板且二者连接为一体，第一悬臂梁的两侧面各粘贴有一个应变片，第二悬臂梁的两侧面各粘贴有一个应变片，第三悬臂梁的两侧面各粘贴有一个应变片；
每套三维接触力检测装置中的弹性体布置在底板上，底板与脚部橡胶鞋底或后背检测壳体连接，脚部穿戴系统中的两个立式支耳竖直设置在底板的两侧边上；
第一连杆、第二连杆、第三连杆和第四连杆水平且平行布置；第一连杆与第二连杆铰接，第二连杆与其中一个槽形支撑板铰接，第一悬臂梁插装在其中一个槽形支撑板的开口内；第三连杆与第四连杆铰接，第三连杆与剩余一个槽形支撑板铰接，第二悬臂梁插装在剩余一个槽形支撑板的开口内；第二连杆转动安装在底板的前端，第四连杆转动安装在底板的后端；
后背检测壳体与负载安装板连接，后背检测壳体的背面上安装有九轴航姿测量模块；底板的前端与所述其中一个槽形支撑板连接，底板的后端与所述剩余一个槽形支撑板连接，水平力传递板与鞋垫板或人体后背支架连接，水平力传递板的表面加工有突出部，突出部插装在第三悬臂梁的端部加工的并与突出部匹配的通孔内；
工控计算机安装有外围扩展电路，包括I/O数据采集卡和CAN卡，实现多种传感信息的采集和与关节驱动电机的通信及控制。
本发明的一种外骨骼机器人系统的基于运动学末端检测的控制方法是按照以下步骤进行的：
步骤一：设定外骨骼机器人对人体质量的抵消程度，其中：h人体质量，kg；g为重力加速度，m/s2，系统的控制目标为抵消的质量分数m；
单腿支撑及单腿摆动的控制：设F3、F4和T为人体后背支架坐标系映射到右腿或左腿坐标系后的值；F3为竖直力，F4为水平力，T为扭矩；F5为支撑腿脚底支撑力垂直分力；
步骤二、控制支撑腿膝关节转角θzk使[(1-m)·F3-m·F5]回归零；
步骤三、检测人体重心在竖直方向的加速度为a，m/s2，已知人体重心到后背检测支架的距离为L，控制支撑腿髋关节转角θzh1使T回归(hg+ha)mL；支撑腿膝关节转角θzk实时叠加到支撑腿髋关节上，支撑腿髋关节转角θzh＝θzh1+θzk；
步骤四、将摆动腿的脚底二维力检测值，经过当前摆动腿的脚底的第一角度传感器或第二角度传感器坐标系映射到外骨骼小腿坐标系上，设映射后的值设定为F1和F2；根据F1和F2的合力，并规划出摆动腿髋关节的转角θbh1和膝关节的转角θbk1；
步骤五、将支撑腿髋关节转角θzh实时叠加到摆动腿髋关节转角上，摆动腿髋关节实际转角为θbh＝θzh+θbh1；
步骤六、摆动腿膝关节实际转角θbk＝θbk1。
本发明的一种外骨骼机器人系统的基于运动学末端检测的控制方法是按照以下步骤进行的：
步骤一：设定外骨骼机器人对人体质量的抵消程度，其中：h人体质量，kg；g为重力加速度，m/s2，系统的控制目标为抵消的质量分数m；
双腿支撑的控制：根据脚底支撑力的竖直分力F1和F5的大小，以较大值的一侧为主支撑腿，较小值的一侧为副支撑腿，设F3、F4和T为人体后背支架坐标系映射到右腿或左腿坐标系后的值，F3为竖直力，F4为水平力，T为扭矩；设F5>F1，则此时F5对应的一侧为主支撑腿；
步骤二、控制主支撑腿膝关节转角θzzk使[(1-m)·F3-m·(F1+F5)]回归零；
步骤三、控制主支撑腿髋关节转角θzzh1使T回归(hg+ha)mL；主支撑腿膝关节转角θzzk实时叠加到主支撑腿髋关节上，主支撑腿髋关节实际为θzzh＝θzzh1+θzzk；
步骤四、控制副支撑腿膝关节转角θfzk使副支撑腿膝关节的大腿支撑力F7归零；
步骤五、副支撑腿膝关节转角θfzk和主支撑腿髋关节实际转角θzzh均叠加到副支撑腿髋关节上，因此，控制副支撑腿髋关节实际转角为θfzh＝θfzk+θzzh。
本发明的一种外骨骼机器人系统的基于运动学末端检测的控制方法是：双脚腾空控制：分别对左腿和右腿按照摆动相处理，将摆动腿的脚底二维力检测值经过当前摆动腿的脚底的第一角度传感器或第二角度传感器坐标系映射到外骨骼小腿坐标系上，映射后的值设定为F1和F2或F5和F6，根据F1和F2或F5和F6的合力，规划出摆动腿髋关节的转角θbh1和摆动腿膝关节的转角θbk1即可。
本发明的有益效果是：本发明基于一款现有的高度拟人化的下肢外骨骼机器人，针对辅助老人行走的实际应用，提出了一种基于运动学末端检测的外骨骼机器人系统及控制方法，能够在行走的过程中依靠外骨骼的腰带和肩带对穿戴者提供向上的提升力，从而减小脚底承受的重力，使人行走感觉身轻如燕。施加给穿戴者的提升力和脚底的剩余支撑力具有严格的比例关系，从而保证了穿戴者仍有真实的基于地面反作用力的行走感受。由于人体在行走过程中，脚底的支撑力有其固定的变化规律，本发明相当于成比例的减小了脚底的支撑力的大小，而不对其变化规律造成破坏，避免了穿戴者产生脚部虚浮的感觉。本发明的控制方法适用于辅助老人行走，帮助其抵抗自身的重力。另外，也适用于一般的外骨骼应用，如帮助正常人负重行走等。
本发明能够在行走的过程中依靠外骨骼的腰带和肩带对穿戴者提供向上的提升力，从而减小脚底承受的重力，使人行走中下肢肌肉承力减小；施加给穿戴者的提升力和脚底的剩余支撑力具有严格的比例关系，从而保证了穿戴者仍有真实的基于地面反作用力的行走感受；
设计了合理分布的多传感检测装置，划分了人体下肢基本的运动形态，包括三种：单脚着地，双脚着地，双脚腾空。对于单腿而言，又分为摆动相和支撑相。对任意一种运动形态，均可准确的进行运动形态判断和运动意图辨识；
多传感检测信息融合处理和人体运动意图智能辨识相结合，制定出相应的外骨骼机器人控制策略，达到了外骨骼对人体行走的实时性成比例助力，从而保证了穿戴者的正常的行走感受，提高了老年人的行走能力。本发明对脚底支撑力进行成比例的缩小，而不对其变化规律造成破坏，避免了穿戴者产生脚部虚浮的感觉。因此相对保留了行走过程中人体自身的平衡性控制本能。
本发明适用于穿戴型助力外骨骼助力机器人，帮助老年人提高行走能力，实现良好的助力效果。依靠外骨骼的腰带和肩带对穿戴者提供向上的提升力，从而减小脚底承受的重力。施加给穿戴者的提升力和脚底的剩余支撑力具有严格的比例关系，相当于成比例的减小了脚底支撑力的大小，而不对脚底支撑力的变化规律造成破坏，避免了穿戴者产生脚部虚浮的感觉。另外，本发明的控制方法也适用于一般的外骨骼机器人应用，如帮助正常人负重行走等。
附图说明
图1是本发明前侧看的立体结构示意图，图2是本发明后侧看的立体结构示意图，图3是三维接触力检测装置人体后背支架上的分解示意图，图4是脚部穿戴系统结构示意图，图5是三维接触力检测装置的立体结构示意图，图6是三维接触力检测装置与后背检测壳体连接的立体结构示意图，图7是三维接触力检测装置实现人机交互力信息测量的机构简图，图8是单腿摆动测控示意图，图9是单腿支撑测控示意图，图10是双腿支撑测控示意图，图11为本发明的控制示意图。
具体实施方式
具体实施方式一：结合图1-图7和图11说明，本实施方式的一种外骨骼机器人系统包括上体后背部A、左腿和右腿，左腿和右腿分别包括髋部驱动系统B、膝部驱动系统C、脚部穿戴系统D和捆绑装置G；上体后背部A包括人体后背支架2和负载安装板7，人体后背支架2安装在负载安装板7上，髋部驱动系统B包括外壳22，膝部驱动系统C包括小腿连接板44，脚部穿戴系统D包括U形连接板51、脚部橡胶鞋底58和两个立式支耳55-2，U形连接板51的中部与小腿连接板44的下端铰接，U形连接板51的两端分别与两个立式支耳55-2转动连接；
它还包括鞋垫板5、后背检测壳体30、九轴航姿测量模块35、工控计算机、两个薄膜压力传感器、两个第一角度传感器32、两个第二角度传感器33、两个三轴倾角传感器36和三套三维接触力检测装置；
每个脚部穿戴系统D的U形连接板51与小腿连接板44连接的转轴上安装有第二角度传感器33，每个脚部穿戴系统D的U形连接板51与立式支耳55-2连接的转轴上安装有第一角度传感器32，两个外壳22的端部各安装有三轴倾角传感器36，两个捆绑装置G上各安装有薄膜压力传感器；
三个三维接触力检测装置分别布置在人体后背板支架2和相应的底板55-1上；
每套三维接触力检测装置包括水平力传递板6、第一连杆11、第二连杆12、第三连杆14、第四连杆15、弹性体17和两个槽形支撑板10；
所述弹性体17包括本体27、第一悬臂梁19、第二悬臂梁20、第三悬臂梁99、第一弹性板21、第二弹性板23、第三弹性板18和六个应变片25；本体27的中部加工有纵向设置的第三悬臂梁99，第三悬臂梁99的两侧的本体27上各固装有纵向设置的第三弹性板18，本体27的两侧分别固装有第一悬臂梁19和第二悬臂梁20，第一悬臂梁19的下部固装有第一弹性板21且二者连接为一体，第二悬臂梁20的下部固装有第二弹性板23且二者连接为一体，第一悬臂梁19的两侧面各粘贴有一个应变片25，第二悬臂梁20的两侧面各粘贴有一个应变片25，第三悬臂梁99的两侧面各粘贴有一个应变片25；
每套三维接触力检测装置中的弹性体17布置在底板55-1上，底板55-1与脚部橡胶鞋底58或后背检测壳体30连接，脚部穿戴系统D中的两个立式支耳55-2竖直设置在底板55-1的两侧边上；
第一连杆11、第二连杆12、第三连杆14和第四连杆15水平且平行布置；第一连杆11与第二连杆12铰接，第二连杆12与其中一个槽形支撑板10铰接，第一悬臂梁19插装在其中一个槽形支撑板10的开口内；第三连杆14与第四连杆15铰接，第三连杆14与剩余一个槽形支撑板10铰接，第二悬臂梁20插装在剩余一个槽形支撑板10的开口内；第二连杆12转动安装在底板55-1的前端，第四连杆15转动安装在底板55-1的后端；
后背检测壳体30与负载安装板7连接，后背检测壳体30的背面上安装有九轴航姿测量模块35；底板55-1的前端与所述其中一个槽形支撑板10连接，底板55-1的后端与所述剩余一个槽形支撑板10连接，水平力传递板6与鞋垫板5或人体后背支架2连接，水平力传递板6的表面加工有突出部，突出部插装在第三悬臂梁99的端部加工的并与突出部匹配的通孔27-1内；
工控计算机安装有外围扩展电路，包括I/O数据采集卡和CAN卡，实现多种传感信息的采集和与关节驱动电机的通信及控制。
本实施方式的工控计算机可采用PC104工控计算机，本实施方式的人体后背支架的安装方式，前面板与人体后背支架固连，后面板与底部的支架一体，然后固连到腰部平台的负载安装板上，从而保证可以准确的测量外骨骼与人体上身之间的交互力。与左脚的底板相连的三维接触力检测装置控制外骨骼左腿的髋关节和膝关节进行跟随运动。
本实施方式的九轴航姿测量模块35可采用G-AHRS100型九轴航姿测量系统和IMU数据采集系统；两个三轴倾角传感器36可采用AHRSIMU惯性航姿九轴电子罗盘倾角仪。
如图11所示，本实施方式的两个捆绑装置G上各安装有薄膜压力传感器可理解为大腿辅助捆绑一维力传感器；底板上的两个三维接触力检测装置可理解为左右足底三维力传感器；人体后背支架上的三维接触力检测装置可理解为后背三维接触力传感器；九轴航姿测量模块35可理解为驱干航姿传感器；外壳上的三轴倾角传感器36可理解为左右大腿航姿传感器。关节电机、编码器和伺服驱动器为基于现有的高度拟人化的下肢外骨骼机器人的现有设备。
具体实施方式二：结合图7说明，本实施方式的第一悬臂梁19的一端加工有球形部，第二悬臂梁20的一端加工有球形部，第一悬臂梁19的球形部插装在所述其中一个槽形支撑板10的开口内，第二悬臂梁20的球形部插装在所述剩余一个槽形支撑板10的开口内。如此设置，悬臂梁的力信息传递上，设计了球形的传力构型结构，减小了摩擦损失，提高了检测的灵敏度。其它与具体实施方式一相同。
具体实施方式三：结合图7说明，本实施方式每个所述应变片25为箔式电阻应变片或应变片传感器。如此设置，测量范围广，产品稳定性好，灵敏度高，可测量多种力学信号。其它与具体实施方式一或二相同。
具体实施方式四：结合图1-图9和图11说明，本实施方式的一种具体实施方式一或二任意一项具体实施方式的外骨骼机器人系统的基于运动学末端检测的控制方法的步骤是：
步骤一：设定外骨骼机器人对人体质量的抵消程度，其中：h人体质量，kg；g为重力加速度，m/s2，系统的控制目标为抵消的质量分数m；
单腿支撑及单腿摆动的控制，设F3、F4和T为人体后背支架坐标系映射到右腿或左腿坐标系后的值；F3为竖直力，F4为水平力，T为扭矩；F5为支撑腿脚底支撑力垂直分力；
步骤二、控制支撑腿膝关节转角θzk使[(1-m)·F3-m·F5]回归零；
步骤三、检测人体重心在竖直方向的加速度为a，m/s2，已知人体重心到后背检测支架的距离为L，控制支撑腿髋关节转角θzh1使T回归(hg+ha)mL；支撑腿膝关节转角θzk实时叠加到支撑腿髋关节上，支撑腿髋关节转角θzh＝θzh1+θzk；
步骤四、将摆动腿的脚底二维力检测值，经过当前摆动腿的脚底的第一角度传感器或第二角度传感器坐标系映射到外骨骼小腿坐标系上，设映射后的值设定为F1和F2；根据F1和F2的合力，并规划出摆动腿髋关节的转角θbh1和膝关节的转角θbk1；
步骤五、将支撑腿髋关节转角θzh实时叠加到摆动腿髋关节转角上，摆动腿髋关节实际转角为θbh＝θzh+θbh1；
步骤六、摆动腿膝关节实际转角θbk＝θbk1。
本实施方式的步骤三中控制支撑腿髋关节转角θzh1使T回归(hg+ha)mL，目的是保证“人-机”后背的平行。
本实施方式图8是单腿摆动相的人体运动意图检测方法。以左腿摆动相为例，检测出人体主动运动造成的人机脚部之间的二维力F1和F2，控制外骨骼左腿的髋关节和膝关节进行跟随运动。图9是单腿支撑相的人体运动意图检测方法。以右腿支撑相为例，检测出后背的人机交互力F3、F4以及扭矩T，右脚底的人机交互力F5和F6，控制髋关节使外骨骼的后背和人体背部平行，控制膝关节使F3和F5成固定的比例关系。
具体实施方式五、结合图1-图7和图10-图11说明，本实施方式的一种具体实施方式一或二任意一项具体实施方式的外骨骼机器人系统的基于运动学末端检测的控制方法的步骤是：
步骤一：设定外骨骼机器人对人体质量的抵消程度，其中：h人体质量，kg；g为重力加速度，m/s2，系统的控制目标为抵消的质量分数m；
双腿支撑的控制，根据脚底支撑力的竖直分力F1和F5的大小，以较大值的一侧为主支撑腿，较小值的一侧为副支撑腿，设F3、F4和T为人体后背支架坐标系映射到右腿或左腿坐标系后的值，F3为竖直力，F4为水平力，T为扭矩；设F5>F1，则此时F5对应的一侧为主支撑腿；
步骤二、控制主支撑腿膝关节转角θzzk使[(1-m)·F3-m·(F1+F5)]回归零；
步骤三、控制主支撑腿髋关节转角θzzh1使T回归(hg+ha)mL；主支撑腿膝关节转角θzzk实时叠加到主支撑腿髋关节上，主支撑腿髋关节实际为θzzh＝θzzh1+θzzk；
步骤四、控制副支撑腿膝关节转角θfzk使副支撑腿膝关节的大腿支撑力F7归零；
步骤五、副支撑腿膝关节转角θfzk和主支撑腿髋关节实际转角θzzh均叠加到副支撑腿髋关节上，因此，控制副支撑腿髋关节实际转角为θfzh＝θfzk+θzzh。
具体实施方式六：结合图1-图9和图11说明，本实施方式的一种具体实施方式一或二的任意一项具体实施方式的外骨骼机器人系统的基于运动学末端检测的控制方法是：
双脚腾空控制，分别对左腿和右腿按照摆动相处理，将摆动腿的脚底二维力检测值经过当前摆动腿的脚底的第一角度传感器或第二角度传感器坐标系映射到外骨骼小腿坐标系上，映射后的值设定为F1和F2或F5和F6，根据F1和F2或F5和F6的合力，规划出摆动腿髋关节的转角θbh1和摆动腿膝关节的转角θbk1即可。
对于双腿腾空状态，如在跑步时，会出现短暂的双脚离地状态，这时相当于两只摆动相的腿，分别对左腿和右腿按照具体实施方式四摆动相处理即可。
Claims (6)
1.一种外骨骼机器人系统，它包括上体后背部(A)、左腿和右腿，左腿和右腿分别包括髋部驱动系统(B)、膝部驱动系统(C)、脚部穿戴系统(D)和捆绑装置(G)；上体后背部(A)包括人体后背支架(2)和负载安装板(7)，人体后背支架(2)安装在负载安装板(7)上，髋部驱动系统(B)包括外壳(22)，膝部驱动系统(C)包括小腿连接板(44)，脚部穿戴系统(D)包括U形连接板(51)、脚部橡胶鞋底(58)和两个立式支耳(55-2)，U形连接板(51)的中部与小腿连接板(44)的下端铰接，U形连接板(51)的两端分别与两个立式支耳(55-2)转动连接；
其特征在于：它还包括鞋垫板(5)、后背检测壳体(30)、九轴航姿测量模块(35)、工控计算机、两个薄膜压力传感器、两个第一角度传感器(32)、两个第二角度传感器(33)、两个三轴倾角传感器(36)和三套三维接触力检测装置；
每个脚部穿戴系统(D)的U形连接板(51)与小腿连接板(44)连接的转轴上安装有第二角度传感器(33)，每个脚部穿戴系统(D)的U形连接板(51)与立式支耳(55-2)连接的转轴上安装有第一角度传感器(32)，两个外壳(22)的端部各安装有三轴倾角传感器(36)，两个捆绑装置(G)上各安装有薄膜压力传感器；
三个三维接触力检测装置分别布置在人体后背板支架(2)和相应的底板(55-1)上；
每套三维接触力检测装置包括水平力传递板(6)、第一连杆(11)、第二连杆(12)、第三连杆(14)、第四连杆(15)、弹性体(17)和两个槽形支撑板(10)；
所述弹性体(17)包括本体(27)、第一悬臂梁(19)、第二悬臂梁(20)、第三悬臂梁(99)、第一弹性板(21)、第二弹性板(23)、第三弹性板(18)和六个应变片(25)；本体(27)的中部加工有纵向设置的第三悬臂梁(99)，第三悬臂梁(99)的两侧的本体(27)上各固装有纵向设置的第三弹性板(18)，本体(27)的两侧分别固装有第一悬臂梁(19)和第二悬臂梁(20)，第一悬臂梁(19)的下部固装有第一弹性板(21)且二者连接为一体，第二悬臂梁(20)的下部固装有第二弹性板(23)且二者连接为一体，第一悬臂梁(19)的两侧面各粘贴有一个应变片(25)，第二悬臂梁(20)的两侧面各粘贴有一个应变片(25)，第三悬臂梁(99)的两侧面各粘贴有一个应变片(25)；
每套三维接触力检测装置中的弹性体(17)布置在底板(55-1)上，底板(55-1)与脚部橡胶鞋底(58)或后背检测壳体(30)连接，脚部穿戴系统(D)中的两个立式支耳(55-2)竖直设置在底板(55-1)的两侧边上；
第一连杆(11)、第二连杆(12)、第三连杆(14)和第四连杆(15)水平且平行布置；第一连杆(11)与第二连杆(12)铰接，第二连杆(12)与其中一个槽形支撑板(10)铰接，第一悬臂梁(19)插装在其中一个槽形支撑板(10)的开口内；第三连杆(14)与第四连杆(15)铰接，第三连杆(14)与剩余一个槽形支撑板(10)铰接，第二悬臂梁(20)插装在剩余一个槽形支撑板(10)的开口内；第二连杆(12)转动安装在底板(55-1)的前端，第四连杆(15)转动安装在底板(55-1)的后端；
后背检测壳体(30)与负载安装板(7)连接，后背检测壳体(30)的背面上安装有九轴航姿测量模块(35)；底板(55-1)的前端与所述其中一个槽形支撑板(10)连接，底板(55-1)的后端与所述剩余一个槽形支撑板(10)连接，水平力传递板(6)与鞋垫板(5)或人体后背支架(2)连接，水平力传递板(6)的表面加工有突出部，突出部插装在第三悬臂梁(99)的端部加工的并与突出部匹配的通孔(27-1)内；
工控计算机安装有外围扩展电路，包括I/O数据采集卡和CAN卡，实现多种传感信息的采集和与关节驱动电机的通信及控制。
2.根据权利要求1所述的一种外骨骼机器人系统，其特征在于：第一悬臂梁(19)的一端加工有球形部，第二悬臂梁(20)的一端加工有球形部，第一悬臂梁(19)的球形部插装在所述其中一个槽形支撑板(10)的开口内，第二悬臂梁(20)的球形部插装在所述剩余一个槽形支撑板(10)的开口内。
3.根据权利要求1或2所述的一种外骨骼机器人系统，其特征在于：每个所述应变片(25)为箔式电阻应变片或应变片传感器。
4.一种根据权利要求1或2任意一项权利要求所述的外骨骼机器人系统的基于运动学末端检测的控制方法，其特征在于：它包括以下步骤：
步骤一：设定外骨骼机器人对人体质量的抵消程度，其中：h人体质量，kg；g为重力加速度，m/s2，系统的控制目标为抵消的质量分数m；
单腿支撑及单腿摆动的控制：设F3、F4和T为人体后背支架坐标系映射到右腿或左腿坐标系后的值；F3为竖直力，F4为水平力，T为扭矩；F5为支撑腿脚底支撑力垂直分力；
步骤二、控制支撑腿膝关节转角θzk使[(1-m)·F3-m·F5]回归零；
步骤三、检测人体重心在竖直方向的加速度为a，m/s2，已知人体重心到后背检测支架的距离为L，控制支撑腿髋关节转角θzh1使T回归(hg+ha)mL；支撑腿膝关节转角θzk实时叠加到支撑腿髋关节上，支撑腿髋关节转角θzh＝θzh1+θzk；
步骤四、将摆动腿的脚底二维力检测值，经过当前摆动腿的脚底的第一角度传感器或第二角度传感器坐标系映射到外骨骼小腿坐标系上，设映射后的值设定为F1和F2；根据F1和F2的合力，并规划出摆动腿髋关节的转角θbh1和膝关节的转角θbk1；
步骤五、将支撑腿髋关节转角θzh实时叠加到摆动腿髋关节转角上，摆动腿髋关节实际转角为θbh＝θzh+θbh1；
步骤六、摆动腿膝关节实际转角θbk＝θbk1。
5.一种根据权利要求1或2任意一项权利要求所述的外骨骼机器人系统的基于运动学末端检测的控制方法，其特征在于：它包括以下步骤：
步骤一：设定外骨骼机器人对人体质量的抵消程度，其中：h人体质量，kg；g为重力加速度，m/s2，系统的控制目标为抵消的质量分数m；
双腿支撑的控制：根据脚底支撑力的竖直分力F1和F5的大小，以较大值的一侧为主支撑腿，较小值的一侧为副支撑腿，设F3、F4和T为人体后背支架坐标系映射到右腿或左腿坐标系后的值，F3为竖直力，F4为水平力，T为扭矩；设F5>F1，则此时F5对应的一侧为主支撑腿；
步骤二、控制主支撑腿膝关节转角θzzk使[(1-m)·F3-m·(F1+F5)]回归零；
步骤三、控制主支撑腿髋关节转角θzzh1使T回归(hg+ha)mL；主支撑腿膝关节转角θzzk实时叠加到主支撑腿髋关节上，主支撑腿髋关节实际为θzzh＝θzzh1+θzzk；
步骤四、控制副支撑腿膝关节转角θfzk使副支撑腿膝关节的大腿支撑力F7归零；
步骤五、副支撑腿膝关节转角θfzk和主支撑腿髋关节实际转角θzzh均叠加到副支撑腿髋关节上，因此，控制副支撑腿髋关节实际转角为θfzh＝θfzk+θzzh。
6.一种根据权利要求1或2任意一项权利要求所述的外骨骼机器人系统的基于运动学末端检测的控制方法，其特征在于：它包括以下步骤：
双脚腾空控制：分别对左腿和右腿按照摆动相处理，将摆动腿的脚底二维力检测值经过当前摆动腿的脚底的第一角度传感器或第二角度传感器坐标系映射到外骨骼小腿坐标系上，映射后的值设定为F1和F2或F5和F6，根据F1和F2或F5和F6的合力，规划出摆动腿髋关节的转角θbh1和摆动腿膝关节的转角θbk1即可。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201410491096.6A CN104224498B (zh) | 2014-09-24 | 2014-09-24 | 一种外骨骼机器人系统及基于运动学末端检测的控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201410491096.6A CN104224498B (zh) | 2014-09-24 | 2014-09-24 | 一种外骨骼机器人系统及基于运动学末端检测的控制方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN104224498A CN104224498A (zh) | 2014-12-24 |
| CN104224498B true CN104224498B (zh) | 2016-04-20 |
Family
ID=52213995
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201410491096.6A Active CN104224498B (zh) | 2014-09-24 | 2014-09-24 | 一种外骨骼机器人系统及基于运动学末端检测的控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN104224498B (zh) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US9737989B2 (en) | 2015-02-20 | 2017-08-22 | Fanuc Corporation | Human cooperation robot system in which robot is caused to perform retreat operation |
Families Citing this family (23)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CA2971671A1 (en) * | 2015-02-09 | 2016-08-18 | Scuola Superiore Di Studi Universitari E Di Perfezionamento Sant'anna | Actuation system for hip orthosis |
| CN104758099B (zh) * | 2015-04-20 | 2016-08-03 | 哈尔滨工业大学 | 基于重力平衡的下肢助力外骨骼 |
| CN104983543B (zh) * | 2015-07-29 | 2016-08-24 | 张士勇 | 一种智能型下肢康复训练器 |
| KR102556931B1 (ko) * | 2015-08-26 | 2023-07-18 | 삼성전자주식회사 | 회로 보호 방법 및 장치 |
| CN105147298A (zh) * | 2015-10-16 | 2015-12-16 | 北京机械设备研究所 | 一种外骨骼状态检测方法 |
| FR3046038B1 (fr) * | 2015-12-24 | 2017-12-22 | Sagem Defense Securite | Module de support de sac a dos pour une structure modulaire d'exosquelette |
| CN106156524B (zh) * | 2016-07-29 | 2018-08-28 | 东北大学 | 一种智能下肢助力装置的在线步态规划方法 |
| CN106217352A (zh) * | 2016-08-17 | 2016-12-14 | 尖叫智能科技（上海）有限公司 | 基于压力传感器的外骨骼机器人步态控制方法 |
| WO2018035877A1 (zh) * | 2016-08-26 | 2018-03-01 | 北京神秘谷数字科技有限公司 | 外骨骼服 |
| KR102566102B1 (ko) * | 2016-09-20 | 2023-08-11 | 삼성전자주식회사 | 보행 보조 장치 및 보행 보조 장치의 제어 방법 |
| CN106344355B (zh) * | 2016-10-28 | 2017-07-18 | 广州初曲科技有限公司 | 一种具有重心自调节平衡功能的下肢辅助行动机器骨骼 |
| CN106377399B (zh) * | 2016-11-16 | 2017-07-28 | 广州初曲科技有限公司 | 一种模拟神经电信号的增强型智能仿生助力机械腿 |
| CN108283569A (zh) * | 2017-12-27 | 2018-07-17 | 北京精密机电控制设备研究所 | 一种外骨骼机器人控制系统及控制方法 |
| CN108968957A (zh) * | 2018-07-25 | 2018-12-11 | 山东体育学院 | 一种膝关节、踝关节运动觉测试仪 |
| CN109048868B (zh) * | 2018-09-25 | 2020-08-14 | 北京精密机电控制设备研究所 | 下肢外骨骼机器人系统及其随动角度检测装置及控制方法 |
| CN109648541B (zh) * | 2018-11-16 | 2020-05-22 | 浙江大学 | 一种应用于外骨骼机器人的足部穿戴装置 |
| CN109648542B (zh) * | 2018-11-16 | 2020-05-22 | 浙江大学 | 一种分布式液压动力源下肢外骨骼机器人 |
| CN110362015A (zh) * | 2019-07-23 | 2019-10-22 | 上海博灵机器人科技有限责任公司 | 一种基于5.8g wifi实现高实时性的多路数据采集系统 |
| CN110721055B (zh) * | 2019-10-17 | 2021-11-02 | 深圳市迈步机器人科技有限公司 | 下肢助行外骨骼机器人的控制方法及外骨骼机器人 |
| CN110977961A (zh) * | 2019-11-07 | 2020-04-10 | 郑州大学 | 一种自适应助力外骨骼机器人运动信息采集系统 |
| CN111887856B (zh) * | 2020-02-25 | 2022-09-16 | 哈尔滨工业大学 | 一种基于惯性传感器的抗位置窜动关节角度解算实时方法 |
| CN111419236B (zh) * | 2020-03-30 | 2023-05-05 | 哈尔滨工业大学 | 基于惯性传感器的运动模式无关下肢动力学实时解算方法 |
| CN111671625A (zh) * | 2020-07-14 | 2020-09-18 | 张强 | 一种手足创伤行走机器人 |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103135765A (zh) * | 2013-02-20 | 2013-06-05 | 兰州交通大学 | 一种基于微机械传感器的人体动作信息捕捉系统 |
| CN103330635A (zh) * | 2013-06-26 | 2013-10-02 | 中国科学院合肥物质科学研究院 | 一种穿戴型下肢助力机器人、其折叠方法及用于装运的手拉箱 |
| CN103586867A (zh) * | 2013-11-11 | 2014-02-19 | 北京航空航天大学 | 多自由度穿戴式下肢外骨骼机器人电动控制系统 |
| CN103610568A (zh) * | 2013-12-16 | 2014-03-05 | 哈尔滨工业大学 | 一种拟人化的下肢助力外骨骼机器人 |
| CN103610524A (zh) * | 2013-12-16 | 2014-03-05 | 哈尔滨工业大学 | 一种便携储能式外骨骼助力机器人 |
Family Cites Families (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2009084387A1 (ja) * | 2007-12-27 | 2009-07-09 | University Of Tsukuba | 重心位置検出装置及び重心位置検出装置を備えた装着式動作補助装置 |
| US20120101415A1 (en) * | 2010-10-21 | 2012-04-26 | Amit Goffer | Locomotion assisting apparatus with integrated tilt sensor |
| CN103263339B (zh) * | 2013-05-17 | 2015-09-23 | 大连交通大学 | 老年人外骨骼助行机器人及防摔倒步态的仿生控制方法 |
-
2014
- 2014-09-24 CN CN201410491096.6A patent/CN104224498B/zh active Active
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103135765A (zh) * | 2013-02-20 | 2013-06-05 | 兰州交通大学 | 一种基于微机械传感器的人体动作信息捕捉系统 |
| CN103330635A (zh) * | 2013-06-26 | 2013-10-02 | 中国科学院合肥物质科学研究院 | 一种穿戴型下肢助力机器人、其折叠方法及用于装运的手拉箱 |
| CN103586867A (zh) * | 2013-11-11 | 2014-02-19 | 北京航空航天大学 | 多自由度穿戴式下肢外骨骼机器人电动控制系统 |
| CN103610568A (zh) * | 2013-12-16 | 2014-03-05 | 哈尔滨工业大学 | 一种拟人化的下肢助力外骨骼机器人 |
| CN103610524A (zh) * | 2013-12-16 | 2014-03-05 | 哈尔滨工业大学 | 一种便携储能式外骨骼助力机器人 |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US9737989B2 (en) | 2015-02-20 | 2017-08-22 | Fanuc Corporation | Human cooperation robot system in which robot is caused to perform retreat operation |
Also Published As
| Publication number | Publication date |
|---|---|
| CN104224498A (zh) | 2014-12-24 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN104224498B (zh) | 一种外骨骼机器人系统及基于运动学末端检测的控制方法 | |
| CN104188675B (zh) | 具有人体运动检测功能的外骨骼机器人系统及控制方法 | |
| US11312003B1 (en) | Robotic mobility device and control | |
| CN103722550B (zh) | 外骨骼机器人的嵌入式系统 | |
| CN110695959A (zh) | 外骨骼机器人及其控制系统 | |
| CN109262596A (zh) | 一种助力外骨骼机器人 | |
| US20150088269A1 (en) | Wearable robots and control methods thereof | |
| CN103610569A (zh) | 一种穿戴式下肢助力装置及其控制方法 | |
| Lim et al. | Development of a lower extremity exoskeleton robot with a quasi-anthropomorphic design approach for load carriage | |
| CN205586208U (zh) | 外骨骼机器人 | |
| KR102146363B1 (ko) | 착용형 로봇 및 그 제어 방법 | |
| CN106176149A (zh) | 一种基于多传感融合的外骨骼步态分析系统及方法 | |
| WO2010027015A1 (ja) | モーションキャプチャ装置 | |
| CN106815857A (zh) | 行动辅助机器人的姿态估测方法 | |
| CN103129640A (zh) | 一种新型六足机器人 | |
| CA2451730A1 (en) | Method of estimating floor reactions of bipedal walking body, and method of estimating joint moments of bipedal walking body | |
| JP2007020672A (ja) | 歩行補助装置 | |
| CN110076758B (zh) | 基于混联机构的仿人型下肢外骨骼构型方法 | |
| CN105193534B (zh) | 一种可穿戴式助力外骨骼下肢机构的控制方法 | |
| CN107520834A (zh) | 一种下肢外骨骼双足支撑区域实时判别装置 | |
| Martínez et al. | A single-joint implementation of flow control: Knee joint walking assistance for individuals with mobility impairment | |
| Wang et al. | A subject-based motion generation model with adjustable walking pattern for a gait robotic trainer: NaTUre-gaits | |
| Baldovino et al. | A survey in the different designs and control systems of powered exoskeleton for lower extremities | |
| Duong et al. | Improving the accuracy of wearable sensors for human locomotion tracking using phase-locked regression models | |
| CN209220856U (zh) | 一种具有自平衡性的助力行走外骨骼机器人系统 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant |