a叶姣2017年第30卷第5期 Electronic Sci.&Tech./May.15.2017 图像・编码与软件 doi:10.16180/j.cnki.issnlO07—7820.2017.05.039 上肢康复机器人的运动方向信息处理系统设计 灵 。 ,喻洪流 ,方又方 ,石 萍 ,孟巧玲 ,王金超 。 (1.上海理工大学医疗器械与食品学院,上海200093;2.上海理工大学康复工程与技术研究所,上海200093; 3.上海康复器械工程技术研究中心,上海200093;4.民政部神经功能信息与康复工程重点实验室,上海200093) 摘要针对上肢康复机器人在位置控制过程中,关节电机轴端编码器输出的运动方向信息存在的误差,设计了一 种提高运动方向信息精确度的运动方向信息处理系统。经过该处理系统后,运动方向信息中的抖动被滤除,提高了上肢 康复机器人位置控制的准确性。具备准确位置控制的康复机器人保证了康复过程的舒适性和安全性。 关键词上肢康复机器人;位置控制;运动方向信息;信息处理 中图分类号TP242 文献标识码A 文章编号1007—7820(2017)05—142—05 Design of a Motion Direction Information Processing System for the Upper Limb Rehabilitation l bot ZHANG Linling ’ , l_,YU Hongliu ’ , ,FANG Youfang , ’。 SHI Ping ' , , ,MENG Qiaoling ・ , ..,WANG Jinchao , , , (1.School of Medical Instrument and Food Engineering,University of Shanghai for Science and Technology, Shanghai 200093,China;2.Institute of Rehabilitation Engineering and Technology,University of Shanghai for Science and Technology,Shanghai 200093,China;3.Shanghai Engineering Research Center of Assistive Devices,Shanghai 200093, China;4.Key Laboratory of Neural—functional Information and Rehabilitation Engineering of the Ministry of Civil Affais,Shanghair 200093,China) Abstract In the position control process of the upper limb rehabilitation robot,there is a deviation in the mo— tion direction information output of the encoder mounted on the joint motor shaft.In order to overcome this problem, we design a motion direction iformation process system tno improve location accuracy.The motion direction informa— tion noise is filtered to enhance accurateness of position contro1.The upper limb rehabilitation robot with high preci— sion ensures comfort and safety of rehabilitation process. Keywords upper limb rehabilitation robot;position control;motion direction information;information process 上肢康复机器人是科学技术与康复技术紧密结合 的产物…,其作用是取代康复医师,引导患者进行上肢 康复训练 J。上肢康复机器人不仅将康复医师从繁重 的康复训练中出来,而且为患者提供了专业统一 制。常用传感器有角度传感器、位移传感器、编码器 等 J。编码器是在运动关节电机轴端常用的传感 器,但在实验室研发3自由度驱动式上肢康复机 器人过程中发现编码器输出的运动方向信息存在误 差。故本文设计了一种具有辩向功能的运动方向处理 的上肢康复训练 j。上肢康复训练按照患者的损伤程 度分为被动训练、助力训练和抗阻训练 J。虽然分 为3种训练模式,但每种模式都涉及到相关关节的位 置控制,所以位置控制非常重要。在位置控制中,必须 采集系统,该系统能够提高采集运动方向信息的准确 性,从而确保康复训练顺利进行。 通过传感器采集实时运动方向信息,实现闭环位置控 1 总体设计 1.1位置控制系统 收稿日期:2016-05-25 本文设计的运动方向信息处理系统基于一个3自 基金项目:上海市科技支撑项目(16441905602);上海市科委平 台建设项目(15DZ2251700) 由度的驱动式上肢康复训练机器人 J。该机器人 使用集中安装在设备底座的驱动电机作为动力输出装 作者简介:灵(1992一),女,硕士研究生。研究方向:智能 置,通过套筒及齿轮将动力传递输出到上肢的肘关节 与肩关节处,完成肩关节屈伸、肩关节收展以及肘关节 康复等。喻洪流(1966一),男,博士,教授,博士生导师。研究 方向:人体仿生机械及智能控制等。 142——WWW.屈伸这3个自由度的运动 di ̄nzikej1.t]rg 。上肢康复训练机器 灵,等:上肢康复机器人的运动方向信息处理系统设计 ItB像・编码与软件 人的位置控制系统结构如图1所示。 输出A相滞后 相90。时,代表控制肩关节屈伸的电 机反转,肩关节伸展 。由此可见,判断关节运动方 向的依据就是电机轴端编码器A, 相输出相位差。 由于编码器自身的原因,当存在干扰脉冲时,输出 的关节运动方向信息存在高频抖动,这使得后续的关 节运动无法正常进行。本文采用微控制单元(MCU) 的Timer捕获中断来采集编码器输出的关节运动方向 信息,针对脉冲信号进行捕获,并且在捕获的边沿处判 断关节处电机的旋转方向。在编码器的关节运动方向 --1步进电机驱动制 _叫步进电机驱动别 .- --t步进电机驱动利 l肩关节屈曲伸展电机l I肩关节外展内收电驯 I肘关节屈曲伸展电机I ● t ● l 减速系统 卜__ l 减速系统 卜_ I 减速系统 S- ‘ l位置信息采集 l位置信息采集I l位置信息采集I I.........一 ———_}一 、......... l 控制系统卜_一 千 信号进入MCU之前,需要去除脉冲中的抖动。为保证 图l 上肢康复训练机器人的位置控制系统结构 运动方向信号的准确性,先将编码器输出信号输入到 位置控制系统采用位置闭环控制 。位置信息 运动方向信息处理系统的硬件部分。 采集模块实时采集各个关节的位置信息后送人控制系 当关节电机沿着一个方向转动转动时,在正常编 统。控制系统将测量值与给定值比较计算出各个关节 码器输出的运动方向信号中,同一时刻,其中一相的两 的位置调整量¨引,并将调整量传送给步进电机驱动 个相邻跳变沿和对应的另外一相的输出电平必然是相 反的。如果此时编码器出现了正常的换向,则会出现 器,从而实现上肢康复训练机器人的位置闭环控制。 一次电平相同的情况,但仅会出现一次换向完成后脉 1.2位置信息采集 冲变为正常状态。而一旦干扰脉冲出现,则会在其中 上肢康复训练机器人位置控制系统中的位置信息 一相电平保持不变期间,另一相出现高频抖动,该频率 采集模块,主要包括对3个关节在运动过程中角度信 比编码器正常频率高许多。测试过程中编码器轴的转 息的采集和方向信息的采集。通过安装在关节电机轴 速为,则正常的1000线编码器输出脉冲频率为200× 端的编码器实时输出关节运动的角度信息。结合编码 6/0.36 3.3 kHz,干扰脉冲约为100—200 kHz。根据 器和运动方向信息处理系统,实现关节运动方向信息 上述分析,设计出了以下运动方向信息处理电路,如图 的实时采集。位置信息采集流程图如图2所示。 3所示。 I电机轴端编码器I l 输出 r 、 运动关节角度信息 动方向信息处理系 .输出 运动关节方向信息 图2位置信息采集流程图 运动方向信息处理系统包含运动方向信息处理电 图3运动方向信息处理电路 路和软件去抖算法两部分。由编码器输出的运动方向 图3中,运动方向信息处理电路的基本思路为:利 信息先送人运动方向信息处理电路处理后经由软件去 用积分电路和异或门,提取出A相和 相的跳变沿, 抖算法处理,得到最终的运动方向信息。 在该跳变沿处,利用D锁存器锁存另外一相的电 2硬件设计 平 ,从而去除在一相电平保持期间另外一相的高频 抖动,后面再使用一个D锁存器来判定编码器的旋转 关节运动方向信息的实时采集主要通过安装在关 方向,关节运动方向信号接人MCU的IO口,该运动方 节电机轴端的编码器、运动方向信息处理系统两部分 向信息处理电路逻辑如图4所示。 实现。编码器通过减速系统与电机相连,实时输出关 根据分析,这里假设高频抖动脉冲出现在A相和 节运动方向信息。通常,编码器的A相输出和 相输 相脉冲中的情况,如图4所示。积分电路的特性是 出存在90。的相位差。以肩关节屈伸为例,当控制肩 使得方波的边沿变缓,利用变缓边沿与原始信号异或 关节屈伸的电机轴端编码器输出A相超前B相90。 获得方波的边沿脉冲信号,并作为第一级D锁存器的 时,代表控制肩关节屈伸的电机正转,肩关节屈曲;当 时钟,故在A相的上升沿和下降沿均有一次 相电平 WWW.[1ianzilleji.org————————— 143 田像・编码与软件 灵,等:上肢康复机器人的运动方向信息处理系统设计 A/tl ̄ 朔i厂T] ::::::: i ::…:::::::::}::} 3软件设计 硬件部分设计了运动方向信息处理电路,在软 A相边沿黼电平 l;1;…川…㈨:l I i l: 碉边沿姒相电平 i I iI… I…… 1 ;II j li㈦i i I ;卜_t 甘汁 甘__ …::r一— 件部分将运动方向信息处理电路的输出脉冲信号接 到定时器捕获引脚。定时器设置在捕获状态,当该 引脚处捕获到脉冲信号,定时器会进入捕获中断,在 中断服务函数中读取方向信号,并且对脉冲计数值 再次异或]『_] ■ 『-1 n 广 存器输出 累加或者累减,从而完成对方向信号的采集。上文 中分析了增量式光电编码器的抖动产生的原因,如 果不对抖动信号进行处理,则会对测量结果造成影 响,在软件采集程序中也会因为抖动而发生错误的 动作,故在运动方向信息处理电路的基础上,软件方 面也进行了相应的去抖处理。软件去抖的基本思路 图4运动方向信息处理电路逻辑关系 的输出。据此原理,画出A相或B相在跳变沿处另外 一相电平,如图中第3和第4行波形所示。从图中可 以看出,高频的抖动脉冲没有出现在D锁存器的输出 脉冲中,从而达到了消除抖动的目的。将这两路去抖 之后的脉冲再使用D锁存器则可以获得编码器的旋 转方向。 为:在几个连续边沿处,读取方向信号,并判断当前 方向和前一次方向是否发生改变,改变则认为抖动1 次,当抖动次数>l时,则认为发生了抖动,在总计数 值中将抖动值剔除;如果抖动次数=0则是正常的信 号;如果抖动次数=1,则认为是编码器发生了正常 换向,而不是抖动信号,从而达到去抖的目的,软件 去抖的基本思路如图6所示。 上文详细描述了对各个关节处电机轴端编码器输 前文分析了旋转方向保持不变的正常输出脉冲过 程,论证了其中一相的两个相邻跳变沿,另外一相的电 平必然是相反的结论。假如编码器是正常的变换方 向,则会出现其中一相的两个相邻跳变沿,另一相电平 保持一致的现象。这种现象只会在变向的边界出现一 次,之后编码器输出正常脉冲。现在假设关节处电机 从正转变为反转,将编码器输出脉冲经过运动方向信 息处理电路的逻辑关系分析如图5所示。 出的运动方向信息去抖的过程,上述思路中,判断抖动 是在9个连续边沿捕获中断中进行的,该数值9可以 根据实际测试结果作调整,设置太小则可能无法达到 去抖效果,如果太大则造成方向判断和角度测量不及 时,带来测量滞后的不良影响,一般设置为5~9比较 合适。 A相边沿处日相电平 4实验结果 j l_H!l_H l_—l_H l_l_ B相边沿处A相电平— :I l— i L— 再次异或;L— :I 光电编码器作为本文中关节运动方向信息采集 的传感器,其测量准确性对控制系统的执行效果有 着显著的影响。文中设计的运动方向信息处理系统 包含运动方向信息处理电路以及软件去抖算法,这 L_J U L_J L_J I:L-J U ;: ! j:i;i: I I H— D锁存器输出 :i 1 1 :i 01 j 1j1 j1 0j j:1 0‘ I图5编码器变向一次逻辑关系 从图中可以看出,经过第一级D锁存器之后的 波形在A相超前区间和A相滞后区间有明显的区 别。第二级判向用的D锁存器能正确判断方向的变 两种方式的目的均是为了提高关节运动方向信息的 准确性。为验证这两种方式对抖动消除的效果,设 计了对比实验。根据物理常识可知,无论编码器的 精度如何,其转动轴每转过1圈则必定是,基于这种 思路,将编码器的z相作为圈数计数标志,每发生一 次z相中断表明编码器转过一圈,分别在无信号干 扰、人为加入干扰、缺陷编码器自身干扰等3种条件 下分别测量10次,结果如表l一表3所示。(I组:无 化,但判断时刻滞后了一个周期。由此可见,上述运 动方向信息处理电路在提高抗干扰能力的同时,在 方向判断时间上有所牺牲,但是编码器旋转速度越 快时判断滞后的影响就越小,在可以接受的范围内。 当抖动干扰的频率较小而接近编码器正常旋转的频 率时,则可能会无法区分正常换向还是发生了抖动, 本文将使用软件算法进一步减小抖动现象对关节运 动方向信息影响。 J ——WWW.软件处理,无硬件处理;II组:有软件处理,无硬件处 理;III组:无软件处理,有硬件处理;IV组:有软件处 理,有硬件处理) dianziteji.0rq 灵,等:上肢康复机器人的运动方向信息处理系统设计 图像・编码与软件 图6软件去抖算法流程图 表1 无信号干扰时方向判断出错情况 /次 在步进电机变速过程中,是需要判断当前电机旋 转方向的,如果判断错误,将导致相反的结果,后果十 分严重,故在软硬件处理去抖的过程中将方向判断准 5结束语 针对关节电机轴端编码器输出的运动方向信息存 在的抖动误差,本文设计了一个运动方向信息处理系 统通过系统内的软硬件去抖提高了运动方向信息的精 确度。优点在于低成本,高精度,结构简单。从而确保 了上肢康复机器人位置控制的准确性,有助于上肢康 复机器人的被动训练,助力训练与抗阻训练顺利进行。 确作为首要考虑因素,实验结果也证明了这一点。表 1~表3的结果表明,无论是人为加入的干扰还是编码 器自身缺陷造成的干扰,软件去抖方式和硬件去抖方 式对方向误判的纠正效果十分明显,混合使用时有效 提高了方向判断的准确性。 WWW.dlanzik eji.or[I————————— 145 图像・编码与软件 灵,等:上肢康复机器人的运动方向信息处理系统设计 tion,2014(11):3—9. 但本文设计的运动方向信息处理系统也存在不足,如 在运动方向信息处理电路中,运动方向信号的输出存 在滞后的现象;在软件去抖算法中存在一定误差。 参考文献 [1]Mehrholz J,Platz T,Kugler J,et 1.Elaectmmechanical and robot—assisted grin training for improving alTn function and [6] 龙耀斌.康复机器人训练对脑卒中偏瘫患者上肢功能的 影响[J].中国康复,2012(3):171—173. [7]杜宁.基于3一RRC并联机构的上肢康复机器人设计 [D].秦皇岛:燕山大学,2012. [8]方又方,喻洪流,官龙,等.基于肌电触发的上肢康复训练 机器人的实现[J].上海理工大学学报,2015(4): 355—361. activities of daily living after stroke[J].Stroke,2009,40 (3):392—393. [9] 李继才,官龙,胡鑫,等.外骨骼式手功能康复训练器结构 设计[J].中国康复理论与实践,2013(5):412—415. [1O]易金花,张颖,官龙,等.脑卒中患者上肢康复训练系统研 究进展[J].中国康复,2013(4):249—251. [11]邓明君.一种液压驱动上肢外骨骼机器人设计[D].长沙: 国防科学技术大学,2013. [2] Christelle Nguyen,Marie—Martine LeFevre—Colau,Serge Poiraudeau,et a1.Rehabilitation(exercise and strength training)and osteoarthritis:a critical narrative review[J]. Annals of Physical and Rehabilitation Medicine,2016(12): 5—9. [3] Angelo V Vasiliadis,Vasileios Lampridis,Dimitrios Georgin-a nos,et a1.Rehabilitation exercise program after surgical treat— [12]李庆玲.基于sEMG信号的外骨骼式机器人上肢康复系统 研究[D].哈尔滨:哈尔滨工业大学,2009. [13]徐小俊,孙筠.光电编码器在数控系统中的应用[J].湖北 第二师范学院学报,2011,28(8):91—95. ment of pectoralis major rupture[J].Physical Therapy in spoft,2016(12):22—29. [4] 陈朋举.上肢康复机器人系统设计[D].西安:长安大 学,2014. [14]曹佃生.基于STC单片机的增量式编码器解码电路设计 [J].福建电脑,2014(8):1—2. [5] Maciejasz.A survey on robotic devices for upper limb reha- bilitation[J].Journal of Neuro Engineering and Rehabilita. [15]李智寿.上肢外骨骼助力机器人嵌入式控制系统的研究 [D].杭州:浙江大学,2015. (上接第134页) [13]Wu Chihyao,Lan Pangchang,Yeh Pingcheng.Practical physi— cal layer security schemes for MIMO—OFDM systems using [16]Yang Lieliang.Signal detection in antenna—hopping space— division multiple—access systems’vith space—shift keying precoding matrix indices[J].IEEE Journal on Selected Areas in Communications,2013(9):1687—17O0. modulation[J].IEEE Transactions on Signal Processing, 2012,60(1):489—493. [14]张桂华.MIMO的天线系统设计[J].电子科技,2014,27 (6):82—84. [17]Yang J,Yu R,Zhou X,et a1.An improved two—way training or difscriminatory channel estimation via semiblind approach [15]陈旭.基于MIMO系统的盲均衡算法研究[J].电子科技, 2014,27(9):13—15. [J].IEEE Transactions on Communications,2014(8):4442 —4447. 欢迎订阅《电子科技》 ,邮发代号:52—246 WWW.dianzikeji.org 146