利用惯性传感器数据实时示教下肢外骨骼步态的研究_田启磊.pdf

第 卷 第期 年 月青 岛 大 学 学 报（自 然 科 学 版）（）文章编号：（）：利用惯性传感器数据实时示教下肢外骨骼步态的研究田启磊，王钰（青岛大学机电工程学院，青岛 ）摘要：为实时、灵活和方便地示教下肢外骨骼机器人的步态，提出利用惯性传感器实时示教步态的方法。通过示教者下肢末端的传感器，实时采集脚掌的位姿数据，再根据逆向运动学理论建立下肢各关节角的算法，从而实现每条下肢只需一只传感器即可示教步态的要求。通过安放在小腿和大腿上的其他惯性传感器实测的数据，验证该方法可行性。研究结果表明，该方法时间滞后 ，关节最大误差在 范围内，能够实现步态的实时示教控制。关键词：下肢外骨骼；步态示教；动捕系统；惯性传感器中图分类号：文献标志码：收稿日期：基金项目：山东省科技发展计划项目（批准号：）资助。通信作者：王钰，男，副教授，主要研究的方向为康复机器人与打磨机器人。：借助下肢外骨骼机器人康复卒中后偏瘫患者的肢体功能，是康复机器人领域研究的热点之一，而机器人步态的示教与控制，则是其中的一个研究重点。目前下肢外骨骼机器人的步态生成方法主要有以下几种：）拖拽方式，通过位置控制牵引患者进行重复的康复训练，但劳动强度高，灵活性差，没有实时性；）力控方式，通过多个传感器直接测量由人体肌肉收缩而产生的力，或者建立人机动力学模型估计穿戴者的运动意图，根据患者的运动能力调节机器人辅助力矩，完成对下肢外骨骼步态的控制，这种方法穿戴不便，操作复杂，同样缺少灵活性与实时性；）生物电方式，通过采集运动过程中产生的生物信号判断患者运动意图，从而实现对下肢外骨骼的控制 ，缺点是成本高，信号易受干扰，控制鲁棒性差；）光学动捕方式，通过光学传感器采集人体步态运动特征点，与人体数据库比对优化后作为机器人末端控制器的数据输入，从而控制机器人运动，但成本高，空间占用大，受环境因素影响大，无实时性。本文提出了一种基于单个惯性传感器的下肢外骨骼实时步态示教方法，将灵活性、实时性以及成本低等优点集于一体，并对比分析 仿真结果与动捕系统分布在下肢其他部位上的惯性传感器实时采集的关节转角数据，验证了该方法能帮助患者复现示教轨迹。基于惯性动捕系统的步态示教方法基于惯性动捕系统的步态示教原理图为步态示教与控制的完成流程，传感器采集的数据通过 通讯至上位机，滤波后，脚背传感器的数据输给逆向运动学算法，计算出相对于腰部坐标系的关节坐标，然后关节坐标传给由 工具箱建立的仿真模型，动态记录和展示示教步态的轨迹。惯性传感设备选型选用常见的惯性动作捕捉设备，型号为 ，相对于光学相机步态识别方法，惯性动捕系统适应性强，穿戴方便，不受场地环境的影响。如图所示，动捕系统由 个惯性传感器若干信号线和绑带以及无线接收器组成，可通过绑缚于腰部、大腿中部、小腿中部及脚背部的传感器获取中间关节位置的转角。因为只考虑步态在矢状面内运动，且以腰部作为基坐标系，左右两腿关于腰部坐标系对称分布，所以仅以左腿验证第期田启磊等：利用惯性传感器数据实时示教下肢外骨骼步态的研究该步态示教方法。本文研究只限于固定于左脚背的惯性传感器获取大地坐标系下脚掌的位姿数据用于逆运动学分析，并与通过 惯性动作捕捉设备获取髋关节、膝关节和踝关节转动角度数据对比验证逆运动学算法的正确性。图下肢外骨骼示教控制流程 下肢外骨骼的正逆运动学方程表示建立坐标变换模型基于 （）表示法建立外骨骼下肢运动学模型，描述下肢各关节之间的坐标变化，基于人体下肢功能性康复的基本要求，下肢外骨骼三个运动自由度由髋关节屈伸、膝关节屈伸和踝关节屈伸组成，坐标变换如图所示，首先为下肢每个关节指定一个参考坐标系。坐标系表示腰部基准坐标系，坐标系表示髋关节坐标系（机器人基坐标系），坐标系表示膝关节坐标系，坐标系表示踝关节坐标系，坐标系表示末端脚掌坐标系，腰部坐标系通过平移与旋转变换到末端脚掌坐标系。图 动作捕捉设备绑缚位置图下肢外骨骼 坐标系变换基于 参数建立正逆运动学方程表参数表坐标变换转角偏距杆长扭角 补偿 腰部坐标系到坐标系的参数见表。表示绕轴的旋转角，表示关节偏置，表示连杆长度，表示相邻两个轴之间的扭角。只考虑人体矢状面上的运动，为 简 化 分 析 关 节 偏 距 均 设 为；根 据 中国成年人人体尺寸标准中 岁分组中占比 的人体数据确定杆长；由于、是平行的，所以绕轴的扭角。实际情况脚尖与脚踝不在同一水平面存在夹角，所以需要补偿角度补偿，脚背部传感器测得方向初始青 岛 大 学 学 报（自 然 科 学 版）第 卷角度近似看做补偿角度补偿。根据相邻两坐标系的 变换矩阵 （，）（，）（，）（，）（）依据参数表建立下肢机器人坐标系到末端脚掌坐标系的总变换矩阵为 （）其中，、；、同理；（补偿）、（补偿），（补偿），（补偿）；表示末端脚掌坐标系矩阵，、为末端脚掌的位姿。通过机器人逆运动学理论得到的运动控制算法反向计算出下肢髋关节转角、膝关节转角、踝关节转角。下肢外骨骼机器人逆运动学解 （）（）（）（）（）（）（）（）（）补偿（）获取逆向运动学输入位姿数据图示教者与下肢外骨骼初始状态（）传感器坐标系；（）下肢外骨骼坐标系逆向运动学计算需要相对于腰部坐标系的末端脚掌的位姿数据，而传感器直接采集的位姿数据是相对于传感器大地坐标系，需要经过四元数和坐标变换转换为逆向运动学计算需要的位姿数据。如图所示，左侧为传感器坐标系，坐标表示惯性动捕系统大地坐标，坐标表示位于脚背的传感器坐标；右侧为下肢外骨骼机器人坐标系，坐标表示外骨骼腰部机架坐标，坐标表示外骨骼末端 坐标。虚线表示示教人员任意运动轨迹，点为脚背初始位置，即坐标的位置，点为运动中脚背的任意点位置，通过绑缚于脚背中部的传感器可以获取任意时刻脚掌相对于大地坐标系的数据。脚掌坐标系的位置为（，），其对应的平移矩阵为 （，），本文采用欧拉角 型姿态变换，旋转矩阵为 （，）。则脚背坐标在大地坐标系下的位姿矩阵为 （）同理可得大地坐标系下脚掌任意点的位姿。设点在脚背初始坐标系中的位姿矩阵为，第期田启磊等：利用惯性传感器数据实时示教下肢外骨骼步态的研究 （）则脚背任意点在脚背初始坐标系中的位姿矩阵为（）（）由此可得到脚背任意点在脚背初始坐标系下的位姿为（，）（）为了使下肢外骨骼 在矢状面内与带有传感器的脚背同步运动，于是可得到外骨骼末端在坐标系下随脚掌运动的位姿为 （，）（）通过坐标变换链获得相对于下肢机器人腰部坐标系的位姿数据，从而得到相对于腰部坐标系的实时脚掌位姿数据作为逆运动学算法的输入位姿数据。仿真实验分析基于 建立仿真模型，利用位于脚掌背部的动捕系统单只惯性传感器获取的实时位姿数据进行运动仿真，分析下肢关节角度与动捕系统下肢传感器直接测得的三个关节转动角度的关系。实验对象为一名身高 、体重 的健康男性，通过示教人员特定静态姿态与仿真模型姿态对比，验证外骨骼机器人运动控制算法的准确性。输入数据为实验人员大腿长度、小腿长度、脚掌长度以及脚掌相对于腰部坐标系矢状面的实时位姿数据。示教人员做出图所示姿态，通过关节中心点和脚背传感器位置点量取关节转角，以及稳定姿态位置算法计算的角度见表。仿真模型姿态与示教人员姿态数据误差在 以内，说明外骨骼机器人运动控制算法满足基本要求。图示教人员与仿真模型静态图表静态姿态对应转角资态关节位置示教人员关节转角仿真模型关节转角髋关节 膝关节 踝关节 髋关节 膝关节踝关节 髋关节 膝关节踝关节 在动态试验中采集连续步态运动数据，与仿真模型运动姿态对比分析。输入的腰部传感器在（行走方向）和方向（竖直方向）位移如图所示，脚掌相对于腰部坐标系矢状面的实时位姿数据如图所示。在 仿真设置程序运行时间为，下肢步态变化如图所示，仿真姿态与示教人员姿态一致。髋关节角度为垂直于地面的参考线与以股的长轴线之间所成的夹角，伸展角度为正；膝关节角度为股长轴延长线与胫长轴线之间所成夹角，伸展角度为正；踝关节角度为过踝关节与地面平行的水平线与足长轴之间的夹角，背伸角度为正。青 岛 大 学 学 报（自 然 科 学 版）第 卷图腰部传感器位移（）方向；（）方向图脚掌实时位姿数据（）方向；（）方向；（）矢状面屈伸角度图示教人员与仿真步态周期根据髋关节、膝关节、踝关节角度的仿真结果与惯性动捕系统直接采集的下肢各个关节角度曲线对比如图所示，算法角度因为经二阶低通滤波处理时间维度滞后 ，满足步态控制要求；角度误差范围在以内，且不存在累积误差。故该控制方法可以实现示教者的步态运动轨迹的复现，达到康复师快捷方便的实时的调整患者步态位姿，验证了该步态示教方法的可行性。图示教人员自然行走步态的矢状面关节算法角度与传感器测量角度（）踝关节转角；（）膝关节转角；（）髋关节转角第期田启磊等：利用惯性传感器数据实时示教下肢外骨骼步态的研究 结论本文提出了利用单只惯性传感器进行步态示教的方法，在 平台对其控制算法进行仿真分析，并与动捕系统实采的下肢三关节角度数据对比分析。利用单只惯性传感器数据的下肢外骨骼步态控制方法可以很好的复现示教者的步态运动轨迹，且操作简单灵活，成本低，能够实时调整示教运动轨迹，减轻康复师为患者做康复训练时的负担。参考文献 国家统计局第七次全国人口普查公报解读 ：中国脑卒中防治报告 编写组 中国脑卒中防治报告 概要 中国脑血管病杂志，（）：冯永飞坐卧式下肢康复机器人机构设计与协调控制研究秦皇岛：燕山大学，：赵小磊，林木松，李齐，等 基于加速度传感器的下肢康复机器人示教训练 传感技术学报，（）：周智雍，钱伟，丁加涛，等基于核化运动基元的外骨骼膝关节步态轨迹在线规划机器人，（）：，：，：李沈炎，韩亚丽，陈茹雯，等基于滑模 控制的下肢康复外骨骼控制研究组合机床与自动化加工技术，（）：于建均，李晨，左国玉，等基于 神经网络的仿人机器人循环步态的生成方法北京工业大学学报，（）：刘辉，陈婵娟，穆琪 基于 的下肢外骨骼机器人步态多目标优化 现代制造工程，（）：，：尚长沛，程志基于表面肌电信号的步态切换意图识别及控制研究控制工程，（）：张弼，姚杰，赵新刚，等一种基于肌电信号的自适应人机交互控制方法控制理论与应用，（）：史小华，卢浩，廖梓宇，等基于表面肌电信号的下肢康复主动训练科学技术与工程，（）：王文远，富文昌，曹富基于动作捕捉技术对仿人机器人运动学分析与步态仿真机械传动，（）：胡旭辉，王钰基于惯性传感器遥控示教康复系统的研究青岛大学学报（自然科学版），（）：，（，）：，：；