CN103786157B - 基于上肢外骨骼助力机器人的嵌入式控制*** - Google Patents
基于上肢外骨骼助力机器人的嵌入式控制*** Download PDFInfo
- Publication number
- CN103786157B CN103786157B CN201410024182.6A CN201410024182A CN103786157B CN 103786157 B CN103786157 B CN 103786157B CN 201410024182 A CN201410024182 A CN 201410024182A CN 103786157 B CN103786157 B CN 103786157B
- Authority
- CN
- China
- Prior art keywords
- dsp
- signal
- interface
- module
- upper limbs
- 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
- 210000001364 upper extremity Anatomy 0.000 title claims abstract description 48
- 230000001105 regulatory effect Effects 0.000 claims abstract description 60
- 230000033001 locomotion Effects 0.000 claims abstract description 40
- 238000006073 displacement reaction Methods 0.000 claims abstract description 33
- 102000001253 Protein Kinase Human genes 0.000 claims abstract description 30
- 108060006633 protein kinase Proteins 0.000 claims abstract description 30
- 210000002310 elbow joint Anatomy 0.000 claims abstract description 4
- 210000000323 shoulder joint Anatomy 0.000 claims abstract description 4
- 230000003750 conditioning effect Effects 0.000 claims description 33
- 108091000080 Phosphotransferase Proteins 0.000 claims description 30
- 102000020233 phosphotransferase Human genes 0.000 claims description 30
- 210000003205 muscle Anatomy 0.000 claims description 16
- 230000009467 reduction Effects 0.000 claims description 12
- 238000004891 communication Methods 0.000 claims description 10
- 238000006243 chemical reaction Methods 0.000 claims description 6
- 238000002955 isolation Methods 0.000 claims description 6
- 230000009471 action Effects 0.000 claims description 3
- 238000005265 energy consumption Methods 0.000 abstract description 2
- 230000004044 response Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 11
- 238000005516 engineering process Methods 0.000 description 9
- 238000011160 research Methods 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 238000000034 method Methods 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 230000007812 deficiency Effects 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 238000012423 maintenance Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 238000012827 research and development Methods 0.000 description 2
- 235000001674 Agaricus brunnescens Nutrition 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008901 benefit Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 230000036541 health Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000007726 management method Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 230000003278 mimic effect Effects 0.000 description 1
- 230000008520 organization Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
Landscapes
- Manipulator (AREA)
Abstract
本发明公开了一种基于上肢外骨骼助力机器人的嵌入式控制***。主要由两个结构相同的单臂部件和背部支架组成,单臂部件从下至上依次由肘关节和肩关节构成的上肢外骨骼助力机器人。还包括ARM微处理器模块、DSP微控制器模块、ARM信号调理模块、DSP信号调理模块、电源模块、两个操作员运动意图检测传感器、四个角位移传感器和四个结构相同的驱动单元;ARM微处理器模块与DSP微控制器模块通过CAN总线相连,四个驱动单元与外骨骼机构相连并驱动外骨骼机构运动。本发明功能完备、易于开发和维护的外骨骼助力机器人嵌入式控制平台,实时响应速度快、实时多任务性能高、驱动能力强、功耗低、通用可扩展性好、小型化等特点。
Description
技术领域
本发明涉及外骨骼机器人,尤其是涉及一种基于上肢外骨骼助力机器人的嵌入式控制***。
背景技术
外骨骼机器人技术实质上可以理解为一种可穿戴式机器人技术,模仿生物界的外骨骼开发一种新型机电一体化装置,可穿戴在操作者的身体外部,为操作者提供诸如保护、身体支撑、运动辅助等功能。同时结合了传感、控制、信息融合、移动计算等机器人技术,将人类的智力和机器人的“体力”结合在一起,使得外骨骼能够在操作者参与的控制模式下完成仅靠操作者自身能力无法独立完成的任务。因此,将人的智能与机器人所具有的强大机械能量结合起来,综合为一个***,将会带来前所未有的变化,这便是外骨骼助力机器人的设计思想。
外骨骼技术的研究始于1960年的美国,最早的研究成果是美国通用公司研发的Hardiman外骨骼***,研究的首要目的是缓解士兵长距离负重行军所引起的疲劳。虽然Hardiman的研究最终停止,但是它对后来外骨骼技术的研究与发展起到了重要的指导作用。进入21世纪后,由于能源技术、微驱动技术、材料科学、信息技术的发展,各种类型的外骨骼如雨后春笋般浮现,外骨骼也逐步向实用化方向发展。
在控制方面,目前世界上比较主流先进的控制方法和思路很多,例如主从控制、肌电控制、ZMP控制、直接力反馈控制等等,而这些控制往往涉及到复杂的控制算法,如PID控制算法、模糊神经网络控制算法和滑模控制算法等,需要进行大量的数据计算和传输,这就对采用普通单片机的嵌入式控制平台造成沉重的工作负担,从而进一步影响电路执行效率以及最终的控制效果。而采用通用计算机作为核心的控制平台,虽然具有强大的计算和控制能力,但其体积和功耗较大。
发明内容
针对上述背景技术中存在的问题和不足,本发明的目的是提供一种外骨骼助力机器人嵌入式控制***,可以优化外骨骼助力机器人控制***的控制结构,完善整个控制***的功能,降低开发和维护难度,提高整个控制***的执行效率,改善控制***的控制效果。
为实现上述发明目的,本发明采用的技术方案是:
本发明主要两个结构相同的单臂部件和背部支架组成,单臂部件从下至上依次由肘关节和肩关节构成的上肢外骨骼助力机器人;还包括ARM微处理器模块、DSP微控制器模块、ARM信号调理模块、DSP信号调理模块、电源模块、两个操作员运动意图检测传感器、四个角位移传感器和四个结构相同的驱动单元;ARM微处理器模块与DSP微控制器模块通过CAN总线相连,上肢外骨骼助力机器人上的两个操作员运动意图检测传感器经ARM信号调理模块与ARM微处理器模块相连,上肢外骨骼助力机器人上的四个角位移传感器经DSP信号调理模块与DSP微控制器模块相连,四个结构相同的驱动单元,均包括气动肌肉、气压传感器和两个气动高速开关阀,每个驱动单元中的气动肌肉的一端分别与上肢外骨骼助力机器人相连,每个驱动单元中的气动肌肉的另一端分别与各自气压传感器和各自两个气动高速开关阀相连,每个驱动单元中的气动高速开关阀分别与DSP信号调理模块相连,每个驱动单元中的气压传感器分别与DSP信号调理模块相连,电源模块分别与ARM微处理器模块、DSP微控制器模块、ARM信号调理模块和DSP信号调理模块连接。
所述ARM微处理器模块,包括ARM微处理器、RS232串口、RJ45网口、CAN总线接口、USB接口和AD输入接口1;RS232串口用于调试时PC机与ARM微处理器模块之间的通讯,RJ45网口用于将PC机上的文件***挂载到ARM微处理器模块上,CAN总线接口用于与DSP微控制器模块进行通讯,USB接口用于将内核与文件***的镜像文件下载到ARM微处理器模块上,上肢外骨骼助力机器人上的操作员运动意图检测传感器获得的模拟量信号经过ARM信号调理模块进入AD输入接口1,再进入ARM微处理器进行数据转换。
所述DSP微控制器模块,主要由DSP微控制器、JTAG调试接口、CAN总线接口、AD输入接口2和PWM输出接口组成;JTAG调试接口用于现场调试和程序下载,CAN总线接口用于与ARM微处理器模块进行通讯,信号从DSP微控制器出发,经过DSP信号调理模块,DSP信号调理模块输出的模拟量信号通过PWM输出接口控制气动高速开关阀,进而驱动气动肌肉使上肢外骨骼助力机器人运动,上肢外骨骼助力机器人上的气压传感器和角位移传感器获得的模拟量信号经过DSP信号调理模块进入AD输入接口2,再进入DSP微控制器进行数据转换。
所述电源模块,由外部电源将220V交流电转换为24V直流电,24V直流电为气动高速开关阀和气压传感器供电;24V直流电转换为+5V直流电和±5V直流电,+5V直流电为ARM微处理器模块、DSP微控制器模块和角位移传感器供电,±5V直流电为操作员运动意图检测传感器供电。
所述ARM信号调理模块,主要包括AD输出接口1、操作员运动意图检测传感器信号调理电路和操作员运动意图检测传感器接口,所述AD输出接口1和所述ARM微控制器模块的AD输入接口1相连,上肢外骨骼助力机器人上的操作员运动意图检测传感器获得的模拟量信号经过所述操作员运动意图检测传感器信号调理电路,由AD输出接口1进入所述ARM微处理器模块的AD输入接口1,AD输入接口1与ARM微控制器内部的AD功能模块相连,所述模拟量信号经过AD输入接口1转化为数字量信号进入ARM微控制器。
所述操作员运动意图检测传感器信号调理电路,主要由降压电路、压控电压源二阶低通滤波电路和电压跟随器组成,操作员运动意图检测传感器获得的模拟量信号在进入ARM微处理器模块的AD输入接口1之前,首先经过降压电路后进入压控电压源二阶低通滤波电路,然后经过电压跟随器,最后由所述ARM信号调理模块的AD输出接口1进入ARM微处理器模块的AD输入接口1。
所述DSP信号调理模块,主要包括AD输出接口2、气压传感器信号调理电路、气压传感器接口、角位移传感器信号调理电路、角位移传感器接口、PWM输入接口、气动高速开关阀驱动电路和气动高速开关阀接口;所述AD输出接口2与所述DSP微控制器模块的AD输入接口2相连,上肢外骨骼助力机器人上的气压传感器与角位移传感器获得的模拟量信号分别经过所述气压传感器信号调理电路与角位移传感器信号调理电路,由AD输出接口2进入所述DSP微控制器模块的AD输入接口2,AD输入接口2与DSP微控制器内部的AD功能模块相连,所述模拟量信号经过AD输入接口2转化为数字量信号进入DSP微控制器;所述PWM输入接口与所述DSP微控制器模块的PWM输出接口相连,PWM输出接口与DSP微控制器内部的PWM功能模块相连,数字量信号经过PWM功能模块转化为模拟量信号由PWM输入接口进入气动高速开关阀驱动电路,所述气动高速开关阀驱动电路将模拟信号隔离放大后控制气动高速开关阀,进而驱动气动肌肉使上肢外骨骼助力机器人运动。
所述气动高速开关阀驱动电路,主要由光耦隔离芯片PC817和场效应管IRF740N组成,信号从DSP微控制器模块的PWM输出接口出发,经过光耦隔离芯片PC817,接着由场效应管IRF740N通过所述DSP信号调理模块的PWM输入接口驱动气动高速开关阀进行动作。
所述气压传感器信号调理电路,主要由电流电压转换电路、压控电压源二阶低通滤波电路和电压跟随器组成,气压传感器获得的模拟量信号在进入DSP微控制器模块的AD输入接口2之前,首先经过电流电压转换电路后进入压控电压源二阶低通滤波电路,然后经过电压跟随器,最后由所述DSP信号调理模块的AD输出接口2进入DSP微控制器模块的AD输入接口2。
所述角位移传感器信号调理电路,主要由降压电路、压控电压源二阶低通滤波电路和电压跟随器组成,角位移传感器获得的模拟量信号在进入DSP微控制器模块的AD输入接口2之前,首先经过降压电路后进入压控电压源二阶低通滤波电路,然后经过电压跟随器,最后由所述DSP信号调理模块的AD输出接口2进入DSP微控制器模块的AD输入接口2。
与背景技术相比,背景技术具有的有益效果是:
采用本发明外骨骼助力机器人嵌入式控制平台,可以优化外骨骼助力机器人控制***的控制结构,完善整个控制***的功能,降低开发和维护难度,提高整个控制***的执行效率,改善控制***的控制效果。另外,本外骨骼助力机器人嵌入式控制平台克服了传统单片机、DSP或者PC+单片机/DSP在速度、处理能力、体积、方便性、功耗、人机接口以及复杂网络接口等方面的不足,保证了硬件***具有良好的扩展性、实时性、灵活性、低功耗等特点,既发挥了ARM微处理器高稳定性能和强大的任务管理的优点,又发挥了DSP微控制器高速交换数据和快速处理数字信号的能力。
本发明是一套结构简单、功能完备、易于开发和维护的上肢外骨骼助力机器人嵌入式控制***,它具有鲁棒性高、实时响应速度快、实时多任务性能高、驱动能力强、功耗低、通用可扩展性好、小型化等特点。
附图说明
图1是本发明的***结构示意图。
图2是本发明的ARM微处理器模块的逻辑框图。
图3是本发明的DSP微控制器模块的逻辑框图。
图4是本发明的电源模块的逻辑框图。
图5是本发明的ARM信号调理模块的逻辑框图。
图6是本发明的操作员运动意图检测传感器信号调理电路图。
图7是本发明的DSP信号调理模块的逻辑框图。
图8是本发明的气动高速开关阀驱动电路图。
图9是本发明的气压传感器信号调理电路图。
图10是本发明的角位移传感器信号调理电路图。
具体实施方式
下面结合附图和具体实施例对本发明作进一步说明。
如图1所示,本发明的一种外骨骼助力机器人嵌入式控制平台,主要由两个结构相同的单臂部件和背部支架组成,单臂部件从下至上依次由肘关节和肩关节构成的上肢外骨骼助力机器人;还包括ARM微处理器模块、DSP微控制器模块、ARM信号调理模块、DSP信号调理模块、电源模块、两个操作员运动意图检测传感器、四个角位移传感器和四个结构相同的驱动单元;ARM微处理器模块与DSP微控制器模块通过CAN总线相连,上肢外骨骼助力机器人上的两个操作员运动意图检测传感器经ARM信号调理模块与ARM微处理器模块相连,上肢外骨骼助力机器人上的四个角位移传感器经DSP信号调理模块与DSP微控制器模块相连,四个结构相同的驱动单元,均包括气动肌肉、气压传感器和两个气动高速开关阀,每个驱动单元中的气动肌肉的一端分别与上肢外骨骼助力机器人相连,每个驱动单元中的气动肌肉的另一端分别与各自气压传感器和各自两个气动高速开关阀相连,每个驱动单元中的气动高速开关阀分别与DSP信号调理模块相连,每个驱动单元中的气压传感器分别与DSP信号调理模块相连,电源模块分别与ARM微处理器模块、DSP微控制器模块、ARM信号调理模块和DSP信号调理模块连接。
如图2所示的是ARM微处理器模块的逻辑框图。ARM微处理器模块,包括ARM微处理器、RS232串口、RJ45网口、CAN总线接口、USB接口和AD输入接口1;RS232串口用于调试时PC机与ARM微处理器模块之间的通讯,RJ45网口用于将PC机上的文件***挂载到ARM微处理器模块上,CAN总线接口用于与DSP微控制器模块进行通讯,USB接口用于将内核与文件***的镜像文件下载到ARM微处理器模块上,上肢外骨骼助力机器人上的操作员运动意图检测传感器获得的模拟量信号经过ARM信号调理模块进入AD输入接口1,再进入ARM微处理器进行数据转换。
如图3所示的是DSP微控制器模块的逻辑框图。DSP微控制器模块,主要由DSP微控制器、JTAG调试接口、CAN总线接口、AD输入接口2和PWM输出接口组成;JTAG调试接口用于现场调试和程序下载,CAN总线接口用于与ARM微处理器模块进行通讯,信号从DSP微控制器出发,经过DSP信号调理模块,DSP信号调理模块输出的模拟量信号通过PWM输出接口控制气动高速开关阀,进而驱动气动肌肉使上肢外骨骼助力机器人运动,上肢外骨骼助力机器人上的气压传感器和角位移传感器获得的模拟量信号经过DSP信号调理模块进入AD输入接口2,再进入DSP微控制器进行数据转换。
如图4所示的是电源模块的逻辑框图。电源模块由外部电源将220V交流电转换为24V直流电,24V直流电为气动高速开关阀和气压传感器供电;24V直流电转换为+5V直流电和±5V直流电,+5V直流电为ARM微处理器模块、DSP微控制器模块和角位移传感器供电,±5V直流电为操作员运动意图检测传感器供电。
如图5所示的是ARM信号调理模块的逻辑框图。ARM信号调理模块,主要包括AD输出接口1、操作员运动意图检测传感器信号调理电路和操作员运动意图检测传感器接口,所述AD输出接口1和所述ARM微控制器模块的AD输入接口1相连,上肢外骨骼助力机器人上的操作员运动意图检测传感器获得的模拟量信号经过所述操作员运动意图检测传感器信号调理电路,由AD输出接口1进入所述ARM微处理器模块的AD输入接口1,AD输入接口1与ARM微控制器内部的AD功能模块相连,所述模拟量信号经过AD输入接口1转化为数字量信号进入ARM微控制器。
如图6所示的是操作员运动意图检测传感器信号调理电路图。操作员运动意图检测传感器信号调理电路主要由降压电路、压控电压源二阶低通滤波电路和电压跟随器组成,操作员运动意图检测传感器获得的模拟量信号在进入ARM微处理器模块的AD输入接口1之前,首先经过降压电路后进入压控电压源二阶低通滤波电路,然后经过电压跟随器,最后由所述ARM信号调理模块的AD输出接口1进入ARM微处理器模块的AD输入接口1。具体实现方式详见图6。
如图7所示的是DSP信号调理模块的逻辑框图。DSP信号调理模块,主要包括AD输出接口2、气压传感器信号调理电路、气压传感器接口、角位移传感器信号调理电路、角位移传感器接口、PWM输入接口、气动高速开关阀驱动电路和气动高速开关阀接口;所述AD输出接口2与所述DSP微控制器模块的AD输入接口2相连,上肢外骨骼助力机器人上的气压传感器与角位移传感器获得的模拟量信号分别经过所述气压传感器信号调理电路与角位移传感器信号调理电路,由AD输出接口2进入所述DSP微控制器模块的AD输入接口2,AD输入接口2与DSP微控制器内部的AD功能模块相连,所述模拟量信号经过AD输入接口2转化为数字量信号进入DSP微控制器;所述PWM输入接口与所述DSP微控制器模块的PWM输出接口相连,PWM输出接口与DSP微控制器内部的PWM功能模块相连,数字量信号经过PWM功能模块转化为模拟量信号由PWM输入接口进入气动高速开关阀驱动电路,所述气动高速开关阀驱动电路将模拟信号隔离放大后控制气动高速开关阀,进而驱动气动肌肉使上肢外骨骼助力机器人运动。
如图8所示的是气动高速开关阀驱动电路图。气动高速开关阀驱动电路主要由光耦隔离芯片PC817和场效应管IRF740N组成,信号从DSP微控制器模块的PWM输出接口出发,经过光耦隔离芯片PC817,接着由场效应管IRF740N通过所述DSP信号调理模块的PWM输入接口驱动气动高速开关阀进行动作。具体实现方式详见图8。
如图9所示的是气压传感器信号调理电路图。气压传感器信号调理电路主要由电流电压转换电路、压控电压源二阶低通滤波电路和电压跟随器组成,气压传感器获得的模拟量信号在进入DSP微控制器模块的AD输入接口2之前,首先经过电流电压转换电路后进入压控电压源二阶低通滤波电路,然后经过电压跟随器,最后由所述DSP信号调理模块的AD输出接口2进入DSP微控制器模块的AD输入接口2。具体实现方式详见图9。
如图10所示的是角位移传感器信号调理电路图。角位移传感器信号调理电路主要由降压电路、压控电压源二阶低通滤波电路和电压跟随器组成,角位移传感器获得的模拟量信号在进入DSP微控制器模块的AD输入接口2之前,首先经过降压电路后进入压控电压源二阶低通滤波电路,然后经过电压跟随器,最后由所述DSP信号调理模块的AD输出接口2进入DSP微控制器模块的AD输入接口2。具体实现方式详见图10。
本发明具体实施过程:
上位机ARM微处理器模块主要负责***的初始化、组织管理、任务规划、任务调度、操作员运动意图检测传感器信号的采集以及与下位机DSP微控制器模块的通讯任务等。ARM微处理器模块上运行有实时操作***(Linux),负责多任务的调度和任务的执行,并通过CAN总线向下位机DSP微控制器模块发送有特定数据格式的控制指令和控制参数。同时ARM微处理器模块还接受下位机DSP微控制器模块返回的上肢外骨骼助力机器人各关节的运动状态、位置参数、姿态等相关参数。上位机ARM微处理器模块将这些接收到的数据进行处理,结合减小人类的负重期望对上肢外骨骼助力机器人的各个气动高速开关阀给出相应的控制指令,保证人类承受的重量在允许的偏差范围内保持一致,从而达到预定控制的目标。下位机DSP微控制器模块负责接收来自上位机的控制指令和控制参数,按照规定的协议将数据进行转换,结合固化在DSP微控制器模块中的运动控制算法得出要发送给各电磁阀的控制参数。DSP微控制器模块在执行运动控制指令的同时还要实时读取上肢外骨骼助力机器人各驱动关节的实际位置、状态信息,并将这些信息实时反馈给上位机ARM微处理器模块,与上位机进行信息交换,以便上位机根据当前的运动状态和各关节的位姿决策下一步的运动指令和运动参数。
上述具体实施方式用来解释说明本发明,而不是对本发明进行限制,在本发明的精神和权利要求的保护范围内,对本发明作出的任何修改和改变,都落入本发明的保护范围。
Claims (9)
1.一种基于上肢外骨骼助力机器人的嵌入式控制***,包括主要由两个结构相同的单臂部件和背部支架组成的上肢外骨骼助力机器人,单臂部件从下至上依次由肘关节和肩关节构成;其特征在于:还包括ARM微处理器模块、DSP微控制器模块、ARM信号调理模块、DSP信号调理模块、电源模块、两个操作员运动意图检测传感器、四个角位移传感器和四个结构相同的驱动单元;ARM微处理器模块与DSP微控制器模块通过CAN总线相连,上肢外骨骼助力机器人上的两个操作员运动意图检测传感器经ARM信号调理模块与ARM微处理器模块相连,上肢外骨骼助力机器人上的四个角位移传感器经DSP信号调理模块与DSP微控制器模块相连,四个结构相同的驱动单元,均包括气动肌肉、气压传感器和两个气动高速开关阀,每个驱动单元中的气动肌肉的一端分别与上肢外骨骼助力机器人相连,每个驱动单元中的气动肌肉的另一端分别与各自气压传感器和各自两个气动高速开关阀相连,每个驱动单元中的气动高速开关阀分别与DSP信号调理模块相连,每个驱动单元中的气压传感器分别与DSP信号调理模块相连,电源模块分别与ARM微处理器模块、DSP微控制器模块、ARM信号调理模块和DSP信号调理模块连接;
所述DSP信号调理模块,主要包括AD输出接口2、气压传感器信号调理电路、气压传感器接口、角位移传感器信号调理电路、角位移传感器接口、PWM输入接口、气动高速开关阀驱动电路和气动高速开关阀接口;所述AD输出接口2与所述DSP微控制器模块的AD输入接口2相连,上肢外骨骼助力机器人上的气压传感器与角位移传感器获得的模拟量信号分别经过所述气压传感器信号调理电路与角位移传感器信号调理电路,由AD输出接口2进入所述DSP微控制器模块的AD输入接口2,AD输入接口2与DSP微控制器内部的AD功能模块相连,所述模拟量信号经过AD输入接口2转化为数字量信号进入DSP微控制器;所述PWM输入接口与所述DSP微控制器模块的PWM输出接口相连,PWM输出接口与DSP微控制器内部的PWM功能模块相连,数字量信号经过PWM功能模块转化为模拟量信号由PWM输入接口进入气动高速开关阀驱动电路,所述气动高速开关阀驱动电路将模拟信号隔离放大后控制气动高速开关阀,进而驱动气动肌肉使上肢外骨骼助力机器人运动。
2.根据权利要求1所述一种基于上肢外骨骼助力机器人的嵌入式控制***,其特征在于:所述ARM微处理器模块,包括ARM微处理器、RS232串口、RJ45网口、CAN总线接口、USB接口和AD输入接口1;RS232串口用于调试时PC机与ARM微处理器模块之间的通讯,RJ45网口用于将PC机上的文件***挂载到ARM微处理器模块上,CAN总线接口用于与DSP微控制器模块进行通讯,USB接口用于将内核与文件***的镜像文件下载到ARM微处理器模块上,上肢外骨骼助力机器人上的操作员运动意图检测传感器获得的模拟量信号经过ARM信号调理模块进入AD输入接口1,再进入ARM微处理器进行数据转换。
3.根据权利要求1所述一种基于上肢外骨骼助力机器人的嵌入式控制***,其特征在于:所述DSP微控制器模块,主要由DSP微控制器、JTAG调试接口、CAN总线接口、AD输入接口2和PWM输出接口组成;JTAG调试接口用于现场调试和程序下载,CAN总线接口用于与ARM微处理器模块进行通讯,信号从DSP微控制器出发,经过DSP信号调理模块,DSP信号调理模块输出的模拟量信号通过PWM输出接口控制气动高速开关阀,进而驱动气动肌肉使上肢外骨骼助力机器人运动,上肢外骨骼助力机器人上的气压传感器和角位移传感器获得的模拟量信号经过DSP信号调理模块进入AD输入接口2,再进入DSP微控制器进行数据转换。
4.根据权利要求1所述一种基于上肢外骨骼助力机器人的嵌入式控制***,其特征在于:所述电源模块,由外部电源将220V交流电转换为24V直流电,24V直流电为气动高速开关阀和气压传感器供电;24V直流电转换为+5V直流电和±5V直流电,+5V直流电为ARM微处理器模块、DSP微控制器模块和角位移传感器供电,±5V直流电为操作员运动意图检测传感器供电。
5.根据权利要求1所述一种基于上肢外骨骼助力机器人的嵌入式控制***,其特征在于:所述ARM信号调理模块,主要包括AD输出接口1、操作员运动意图检测传感器信号调理电路和操作员运动意图检测传感器接口,所述AD输出接口1和所述ARM微处理器模块的AD输入接口1相连,上肢外骨骼助力机器人上的操作员运动意图检测传感器获得的模拟量信号经过所述操作员运动意图检测传感器信号调理电路,由AD输出接口1进入所述ARM微处理器模块的AD输入接口1,AD输入接口1与ARM微处理器内部的AD功能模块相连,所述模拟量信号经过AD输入接口1转化为数字量信号进入ARM微处理器。
6.根据权利要求5所述一种基于上肢外骨骼助力机器人的嵌入式控制***,其特征在于:所述操作员运动意图检测传感器信号调理电路,主要由降压电路、压控电压源二阶低通滤波电路和电压跟随器组成,操作员运动意图检测传感器获得的模拟量信号在进入ARM微处理器模块的AD输入接口1之前,首先经过降压电路后进入压控电压源二阶低通滤波电路,然后经过电压跟随器,最后由所述ARM信号调理模块的AD输出接口1进入ARM微处理器模块的AD输入接口1。
7.根据权利要求1所述一种基于上肢外骨骼助力机器人的嵌入式控制***,其特征在于:所述气动高速开关阀驱动电路,主要由光耦隔离芯片PC817和场效应管IRF740N组成,信号从DSP微控制器模块的PWM输出接口出发,经过光耦隔离芯片PC817,接着由场效应管IRF740N通过所述DSP信号调理模块的PWM输入接口驱动气动高速开关阀进行动作。
8.根据权利要求1所述一种基于上肢外骨骼助力机器人的嵌入式控制***,其特征在于:所述气压传感器信号调理电路,主要由电流电压转换电路、压控电压源二阶低通滤波电路和电压跟随器组成,气压传感器获得的模拟量信号在进入DSP微控制器模块的AD输入接口2之前,首先经过电流电压转换电路后进入压控电压源二阶低通滤波电路,然后经过电压跟随器,最后由所述DSP信号调理模块的AD输出接口2进入DSP微控制器模块的AD输入接口2。
9.根据权利要求1所述一种基于上肢外骨骼助力机器人的嵌入式控制***,其特征在于:所述角位移传感器信号调理电路,主要由降压电路、压控电压源二阶低通滤波电路和电压跟随器组成,角位移传感器获得的模拟量信号在进入DSP微控制器模块的AD输入接口2之前,首先经过降压电路后进入压控电压源二阶低通滤波电路,然后经过电压跟随器,最后由所述DSP信号调理模块的AD输出接口2进入DSP微控制器模块的AD输入接口2。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410024182.6A CN103786157B (zh) | 2014-01-20 | 2014-01-20 | 基于上肢外骨骼助力机器人的嵌入式控制*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410024182.6A CN103786157B (zh) | 2014-01-20 | 2014-01-20 | 基于上肢外骨骼助力机器人的嵌入式控制*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103786157A CN103786157A (zh) | 2014-05-14 |
CN103786157B true CN103786157B (zh) | 2015-08-19 |
Family
ID=50662431
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410024182.6A Active CN103786157B (zh) | 2014-01-20 | 2014-01-20 | 基于上肢外骨骼助力机器人的嵌入式控制*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103786157B (zh) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104800040B (zh) * | 2015-03-06 | 2016-08-24 | 合肥工业大学 | 一种并联腰部康复训练装置动态特性检测装置和方法 |
CN105108760B (zh) * | 2015-08-14 | 2017-05-24 | 安徽三联机器人科技有限公司 | 一种可穿戴式助力外骨骼上肢机构的控制方法 |
CN105105895B (zh) * | 2015-08-14 | 2017-03-08 | 浙江大学 | 一种单关节助力外骨骼滑模控制的方法 |
CN105446341A (zh) * | 2015-12-28 | 2016-03-30 | 宜宾学院 | 一种基于ros的变电站巡检机器人底盘 |
TWI584801B (zh) * | 2016-04-15 | 2017-06-01 | 龍華科技大學 | 氣壓肌肉驅動兼具上肢助力與復健訓練功能之外骨骼裝置 |
WO2018035875A1 (zh) * | 2016-08-26 | 2018-03-01 | 北京神秘谷数字科技有限公司 | 外骨骼服 |
WO2018035876A1 (zh) * | 2016-08-26 | 2018-03-01 | 北京神秘谷数字科技有限公司 | 外骨骼服 |
CN106112996B (zh) * | 2016-08-26 | 2019-05-31 | 北京神秘谷数字科技有限公司 | 外骨骼服 |
CN106112997B (zh) * | 2016-08-26 | 2019-05-31 | 北京神秘谷数字科技有限公司 | 外骨骼服 |
CN109693223B (zh) * | 2017-10-20 | 2024-03-26 | 中国科学院沈阳自动化研究所 | 一种穿戴式上肢仿生柔性外骨骼机器人及其助力方法 |
CN109108939A (zh) * | 2018-08-10 | 2019-01-01 | 中国科学院合肥物质科学研究院 | 一种下肢外骨骼助残康复机器人的嵌入式控制*** |
CN111273612A (zh) * | 2018-12-04 | 2020-06-12 | 广州中国科学院先进技术研究所 | 一种移动机器人运动控制器 |
CN114800507A (zh) * | 2022-04-27 | 2022-07-29 | 北京龙诚智航科技有限公司 | 一种主从式机械臂控制*** |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3701582B2 (ja) * | 2001-05-22 | 2005-09-28 | 独立行政法人科学技術振興機構 | イグゾスケルトン装置、イグゾスケルトンサイボーグ装置及び、イグゾスケルトンサイボーグシステム |
FR2861983B1 (fr) * | 2003-11-07 | 2006-02-17 | Patrick Sadok | Systeme d'exosquelette pour segment biologique a mouvement proportionnel et assemblage exosquelettique de tels systemes |
CN101612733B (zh) * | 2008-06-25 | 2013-07-31 | 中国科学院自动化研究所 | 一种分布式多传感器移动机器人*** |
KR101572852B1 (ko) * | 2010-01-06 | 2015-12-01 | 삼성전자 주식회사 | 팔 보조 장치 |
CN103203748A (zh) * | 2013-04-08 | 2013-07-17 | 布法罗机器人科技(苏州)有限公司 | 外骨骼机器人控制***及控制方法 |
CN103192389B (zh) * | 2013-04-08 | 2015-08-26 | 布法罗机器人科技(苏州)有限公司 | 一种外骨骼机器人控制***及方法 |
CN103465253B (zh) * | 2013-09-10 | 2015-10-07 | 浙江大学 | 气动肌肉驱动的上肢外骨骼助力机构 |
-
2014
- 2014-01-20 CN CN201410024182.6A patent/CN103786157B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN103786157A (zh) | 2014-05-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103786157B (zh) | 基于上肢外骨骼助力机器人的嵌入式控制*** | |
CN101373380B (zh) | 一种仿人机器人控制***及机器人操纵方法 | |
CN101564841B (zh) | 一种基于气动人工肌肉的柔性机械手 | |
CN109249395A (zh) | 一种多功能多足机器人控制*** | |
CN204366962U (zh) | 六轴重载机器人控制*** | |
CN110834329B (zh) | 外骨骼控制方法及装置 | |
CN106863309A (zh) | 一种基于dsp和fpga的欠驱动灵巧手控制*** | |
CN103984327B (zh) | 一种基于模糊控制的小型数字舵机*** | |
CN102360190A (zh) | 一种仿人机器人控制*** | |
CN202257212U (zh) | 仿人机器人控制*** | |
CN203134248U (zh) | 一种开放式自由度教学用机器人 | |
CN103984349B (zh) | 一种基于sopc的空间绳系机器人控制***及方法 | |
CN202878317U (zh) | 一种多自由度工业机器人运动控制器 | |
CN202677196U (zh) | 一种基于fpga的agv接口板 | |
CN105373109B (zh) | 一种Delta机器人驱控*** | |
CN207807743U (zh) | 一种球形自平衡寻物机器人 | |
CN111497964A (zh) | 一种电驱动四足机器人分布式控制*** | |
Parvin et al. | Human-Machine Interface (HMI) Robotic Arm Controlled by Gyroscopically Acceleration | |
CN201760878U (zh) | 一种移动机器人 | |
Yu et al. | Development of ARM-based embedded system for robot applications | |
CN103684175B (zh) | 一种可重构的交流伺服驱动控制*** | |
Shuai et al. | Design of control system of human-computer interactive agv robot using double photoelectric encoder positioning | |
CN102722174A (zh) | 基于总线控制方式的agv控制*** | |
Kozlowski et al. | Universal multiaxis control system for electric drives | |
CN105437236A (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 |