康复机器人系统设计设计说明书.docx

康复机器人系统设计【12张CAD图纸和毕业论文】

收藏

压缩包内文档预览:(预览前20页/共71页)
预览图 预览图 预览图 预览图 预览图 预览图 预览图 预览图 预览图 预览图 预览图 预览图 预览图 预览图 预览图 预览图 预览图 预览图 预览图 预览图
编号:11331812    类型:共享资源    大小:3.93MB    格式:RAR    上传时间:2018-11-13 上传人:好资料QQ****51605 IP属地:江苏
200
积分
关 键 词:
全套CAD图纸和毕业论文 康复 痊愈 机器人 系统 设计 全套 cad 图纸 以及 毕业论文
资源描述:

【温馨提示】 购买原稿文件请充值后自助下载。

以下预览截图到的都有源文件,图纸是CAD,文档是WORD,下载后即可获得。


预览截图请勿抄袭,原稿文件完整清晰,无水印,可编辑。

有疑问可以咨询QQ:414951605或1304139763

摘要

康复机器人技术则是近年来迅速发展的一门新兴机器人技术,是机器人技术在医学领域的新应用;目前康复机器人已成为国际社会研究的热点之一。本课题主要研究的基于姿态控制康复训练系统的设计。

本文介绍了康复机器人国内外发展现状和应用情况,进行了训练机器人的总体方案设计、结构设计,和总体控制方案设计等;对训练机器人进行三维建模,并对重要零件进行校核。本训练机器人共有7个自由度,其中每一条机械腿上有3个关节(3个自由度)模仿人体腿上的踝关节、膝关节、髋关节和一个用于减重的减重系统(包括1个自由度)。此系统能用于脑损伤、中风等病人的康复训练,帮助病人更好地进行康复训练,减轻他人的帮助,挺高效果。


关键词:康复训练;机器人;



Abstract

Externally pressurized gas bearing has been widely used in the field of aviation, semiconductor, weave, and measurement apparatus because of its advantage of high accuracy, little friction, low heat distortion, long life-span, and no pollution. In this thesis, based on the domestic and overseas researching.

Keywords:keyword 1; keyword 2; keyword 3;


目  录

摘要 I

Abstract II

第1章 绪论 1

1.1 研究背景及意义 1

1.3 国内外研究现状 1

1.3 本课题主要研究内容 2

第2章 总体方案设计与选择的论证 3

2.1 分析 3

2.2 方案的选择 4

2.2.1 自由度的设计 5

2.2.2 基本参数的选取 5

2.2.3 驱动器的选择 6

2.2.4 关节结构的选择 6

2.2.5 连杆结构的选择 6

2.2.6 腰部结构设计 7

2.2.7 减重机构 7

2.2.8 整体结构设计 7

2.3 本章总结 7

第3章 机械结构的设计与计算及驱动元件选型 8

3.1 人体参数 8

3.2 各关节运动学分析 8

3.2.1踝关节的运动学分析 8

3.2.2 膝关节的运动学分析 9

3.2.3 髋关节的运动学分析 9

3.3 关节力矩分析 10

3.4 具体结构设计 11

3.4.1 关节结构的选择 11

3.4.2 连杆结构的选择 12

3.4.3 腰部结构设计 12

3.4.4 减重机构 12

3.5 一些零件的设计和校核 12

3.5.1 轴承的选择及校核 12

3.5.2气缸的选择 12

3.5.3 连杆的计算与校核 14

3.5.4 腰部板件的校核 14

3.5.4 销轴的校核 15

3.5.5 双头螺柱的校核 16

3.5.6 传感器的选取 16

3.6 减重系统分析及相关计算 16

3.7 本章小结 17

第4章 供气与控制系统的设计 18

4.1 供气系统的设计 18

4.1.1 供气回路设计 18

4.1.2 气动元件的选择 19

4.2 气动自动控制方框图 23

4.4 本章小结 24

第5章 控制系统设计 25

5.1 控制系统概述 25

5.2 处理器选型及硬件总体设计 25

5.2.1 处理器选型 25

5.2.2 控制系统的硬件总体设计 27

5.3 电路设计 28

5.3.1 电源电路 29

5.3.2 时钟与复位电路 29

5.3.3 调试接口电路 30

5.3.4 启动模式选择电路 31

5.3.5 AD模块电路 31

5.3.6 人机界面电路 32

5.3.7 存储模块电路 34

5.4  控制系统的软件设计 35

5.4.1软件总体设计 35

5.4.2 系统初始化 37

5.4.3 运动控制软件设计 38

5.4.4 人机界面的软件设计 42

5.4.5 存储模块的软件设计 44

结    论 46

参考文献 47

致    谢 48



第1章 绪论

1.1 研究背景及意义

现代中枢神经康复机理研究和临床医学表明,脑卒中患者失去运动能力的肢体,在辅助训练运动中,能部分或者全部恢复运动能力。但这需要专业医师的指导与护理。由于目前我国的老龄化及心脑血管疾病患者的增多,肢体瘫痪患者相应增多,目前的专业医师人数远远不能满足病人需要。随着机器人技术、计算机技术、微电子技术、传感器技术等相关技术的发展,具有实用价值的机器人进入众多领域,甚至走进人们的生活,如清洁机器人,护理机器人等。把机器人引入康复医疗领域,发挥类似专业医师的作用,辅助患者实现康复医疗训练和评价,将极大地缓解当前专业医师人数严重不足的局面,具有重大社会意义。目前,康复机器人相关研究正成为众多学者的研究热点。

1.3 国内外研究现状

康复机器人是一种自动化医疗康复设备,它以医学理论为依据,帮助患者进行科学而有效的康复训练,使患者的运动机能得到更快更好的恢复。目前,康复机器人已经广泛地应用到康复护理、假肢和康复治疗等方面,这不仅促进了康复医学的发展,也带动了相关领域的新技术和新理论的发展。

德国柏林自由大学(Free University of Berlin)开展了腿部康复机器人的研究[5],并研制了MGT型康复机器人样机。

瑞士苏黎士联邦工业大学(ETH)在腿部康复机构、走步状态分析方面也取得了一些成果,在汉诺威2001年世界工业展览会上展出了名为LOKOMAT的康复机器人模型。LOKOMAT机器人主要由矫正器、先进的体重支持系统和跑台组成。

德国柏林的IPK研究所研制的Robotic Gait Rehabilitation,通过一个可编程控制的脚踏板来带动患者实现的轨迹模拟,这个脚踏板由直线电机带动实现往复直线运动,脚踏板支撑部分类似于二自由度机械臂,由两个伺服电机驱动[7]。

美国加州大学伯克利分校的科学家研制出一种机器人称为“伯克利末端外骨骼”(BLEEX)[8],BLEEX包括可以牢牢地固定在使用者脚上但又不会和使用者摩擦的金属支架,以及用来承载重物的背包式外架和动力设备等,这种机器人除了可以帮助正常人增加负载能力外还可以帮助残疾的病人行走,一定程度上恢复功能。

日本筑波大学Cybernics实验室的科学家和工程师们,研制出了世界上第一种商业外骨骼机器人(Hybrid Assistive Leg,HAL)[9],准确地说,是自动化机器人腿:“混合辅助腿”。这种装置能帮助残疾人以每小时4公里的速度行走,毫不费力地爬楼梯。除HAL“混合辅助腿”外,日本还研制成功了一种全身性外骨骼机器人。

美国NPH研究中心开创了机器人系统量化步行能力和失调的研究领域,根据活动依赖神经系统的可塑性,量化和评估模式肌电图在等方面的作用,建立数学模型模拟的感觉运动障碍。

在我国,康复医疗工程已经得到了普遍重视,康复训练机器人广阔的应用前景将推动康复机器人技术的进一步发展。我国对康复机器人的研究起步比较晚,辅助型康复机器人的研究成果相对较多,康复训练机器人方面的研究成果则比较少。清华大学在国内率先研制了卧式康复训练机器人样机在这项成果中他们采用了虚拟现实技术[10]。哈尔滨工程大学研制的康复机器人可以模拟正常人行走的、踝关节的运动姿态以及重心的运动规律,带动做行走运动,实现对各个关节的运动训练、肌肉的锻炼以及神经功能的恢复训练。通过获取脚的受力状态、腿部肌肉状态和关节状态等人体的生物信息,协调重心控制系统和系统的运动关系,使之与人体运动状态相协调,获得最佳训练效果。


内容简介:
本科毕业设计(论文)论文题目:康复机器人系统设计专 业:班 级:学生姓名:学 号:指导教师:答辩日期: 本科毕业设计(论文)原创性声明本人郑重声明:所呈交的毕业设计(论文),是本人在指导教师的指导下,独立进行研究工作所取得的成果。除文中已经注明引用的内容外,本论文不包含任何其他个人或集体已经发表或撰写过的作品成果。对本文的研究做出重要贡献的个人和集体,均已在文中以明确方式标明。本人完全意识到本声明的法律结果由本人承担。作者签名:日期:2018年 月 日摘要康复机器人技术则是近年来迅速发展的一门新兴机器人技术,是机器人技术在医学领域的新应用;目前康复机器人已成为国际社会研究的热点之一。本课题主要研究的基于姿态控制康复训练系统的设计。本文介绍了康复机器人国内外发展现状和应用情况,进行了训练机器人的总体方案设计、结构设计,和总体控制方案设计等;对训练机器人进行三维建模,并对重要零件进行校核。本训练机器人共有7个自由度,其中每一条机械腿上有3个关节(3个自由度)模仿人体腿上的踝关节、膝关节、髋关节和一个用于减重的减重系统(包括1个自由度)。此系统能用于脑损伤、中风等病人的康复训练,帮助病人更好地进行康复训练,减轻他人的帮助,挺高效果。关键词:康复训练;机器人;I- I -中文摘要AbstractExternally pressurized gas bearing has been widely used in the field of aviation, semiconductor, weave, and measurement apparatus because of its advantage of high accuracy, little friction, low heat distortion, long life-span, and no pollution. In this thesis, based on the domestic and overseas researching.Keywords:keyword 1; keyword 2; keyword 3;III- III -目 录摘要IAbstractII第1章 绪论11.1研究背景及意义11.3国内外研究现状11.3本课题主要研究内容2第2章总体方案设计与选择的论证32.1分析32.2方案的选择42.2.1自由度的设计52.2.2基本参数的选取52.2.3驱动器的选择62.2.4关节结构的选择62.2.5连杆结构的选择62.2.6腰部结构设计72.2.7减重机构72.2.8整体结构设计72.3本章总结7第3章机械结构的设计与计算及驱动元件选型83.1人体参数83.2各关节运动学分析83.2.1踝关节的运动学分析83.2.2 膝关节的运动学分析93.2.3 髋关节的运动学分析93.3关节力矩分析103.4具体结构设计113.4.1关节结构的选择113.4.2连杆结构的选择123.4.3腰部结构设计123.4.4减重机构123.5一些零件的设计和校核123.5.1轴承的选择及校核123.5.2气缸的选择123.5.3连杆的计算与校核143.5.4腰部板件的校核143.5.4 销轴的校核153.5.5双头螺柱的校核163.5.6传感器的选取163.6减重系统分析及相关计算163.7本章小结17第4章供气与控制系统的设计184.1供气系统的设计184.1.1供气回路设计184.1.2气动元件的选择194.2气动自动控制方框图234.4本章小结24第5章 控制系统设计255.1 控制系统概述255.2 处理器选型及硬件总体设计255.2.1 处理器选型255.2.2 控制系统的硬件总体设计275.3 电路设计285.3.1 电源电路295.3.2 时钟与复位电路295.3.3 调试接口电路305.3.4 启动模式选择电路315.3.5 AD模块电路315.3.6 人机界面电路325.3.7 存储模块电路345.4 控制系统的软件设计355.4.1软件总体设计355.4.2 系统初始化375.4.3 运动控制软件设计385.4.4 人机界面的软件设计425.4.5 存储模块的软件设计44结 论46参考文献47致 谢48VII- VII -第1章 绪论1.1研究背景及意义现代中枢神经康复机理研究和临床医学表明,脑卒中患者失去运动能力的肢体,在辅助训练运动中,能部分或者全部恢复运动能力。但这需要专业医师的指导与护理。由于目前我国的老龄化及心脑血管疾病患者的增多,肢体瘫痪患者相应增多,目前的专业医师人数远远不能满足病人需要。随着机器人技术、计算机技术、微电子技术、传感器技术等相关技术的发展,具有实用价值的机器人进入众多领域,甚至走进人们的生活,如清洁机器人,护理机器人等。把机器人引入康复医疗领域,发挥类似专业医师的作用,辅助患者实现康复医疗训练和评价,将极大地缓解当前专业医师人数严重不足的局面,具有重大社会意义。目前,康复机器人相关研究正成为众多学者的研究热点。1.3国内外研究现状康复机器人是一种自动化医疗康复设备,它以医学理论为依据,帮助患者进行科学而有效的康复训练,使患者的运动机能得到更快更好的恢复。目前,康复机器人已经广泛地应用到康复护理、假肢和康复治疗等方面,这不仅促进了康复医学的发展,也带动了相关领域的新技术和新理论的发展。德国柏林自由大学(Free University of Berlin)开展了腿部康复机器人的研究5,并研制了MGT型康复机器人样机。瑞士苏黎士联邦工业大学(ETH)在腿部康复机构、走步状态分析方面也取得了一些成果,在汉诺威2001年世界工业展览会上展出了名为LOKOMAT的康复机器人模型。LOKOMAT机器人主要由矫正器、先进的体重支持系统和跑台组成。德国柏林的IPK研究所研制的Robotic Gait Rehabilitation,通过一个可编程控制的脚踏板来带动患者实现的轨迹模拟,这个脚踏板由直线电机带动实现往复直线运动,脚踏板支撑部分类似于二自由度机械臂,由两个伺服电机驱动7。美国加州大学伯克利分校的科学家研制出一种机器人称为“伯克利末端外骨骼”(BLEEX)8,BLEEX包括可以牢牢地固定在使用者脚上但又不会和使用者摩擦的金属支架,以及用来承载重物的背包式外架和动力设备等,这种机器人除了可以帮助正常人增加负载能力外还可以帮助残疾的病人行走,一定程度上恢复功能。日本筑波大学Cybernics实验室的科学家和工程师们,研制出了世界上第一种商业外骨骼机器人(Hybrid Assistive Leg,HAL)9,准确地说,是自动化机器人腿:“混合辅助腿”。这种装置能帮助残疾人以每小时4公里的速度行走,毫不费力地爬楼梯。除HAL“混合辅助腿”外,日本还研制成功了一种全身性外骨骼机器人。美国NPH研究中心开创了机器人系统量化步行能力和失调的研究领域,根据活动依赖神经系统的可塑性,量化和评估模式肌电图在等方面的作用,建立数学模型模拟的感觉运动障碍。在我国,康复医疗工程已经得到了普遍重视,康复训练机器人广阔的应用前景将推动康复机器人技术的进一步发展。我国对康复机器人的研究起步比较晚,辅助型康复机器人的研究成果相对较多,康复训练机器人方面的研究成果则比较少。清华大学在国内率先研制了卧式康复训练机器人样机在这项成果中他们采用了虚拟现实技术10。哈尔滨工程大学研制的康复机器人可以模拟正常人行走的、踝关节的运动姿态以及重心的运动规律,带动做行走运动,实现对各个关节的运动训练、肌肉的锻炼以及神经功能的恢复训练。通过获取脚的受力状态、腿部肌肉状态和关节状态等人体的生物信息,协调重心控制系统和系统的运动关系,使之与人体运动状态相协调,获得最佳训练效果。1.3本课题主要研究内容本文“基于姿态控制康复训练系统的设计”的研究目的是设计出一种可以辅助有运动功能障碍的老人或残疾人进行功能恢复训练的康复机器人,工作重点是机器人机械本体的结构设计,要考虑安全性、可靠性、柔顺性,同时进行了气动控制系统的设计。课题内容主要包括:(1)康复训练系统的结构方案设计及运动学分析,包括人体行走的、自由度的设计、基本参数的选取、整体结构设计等。(2)机器人机械本体结构的设计与计算,包括姿态控制结构设计和减重结构设计。(3)机器人驱动器的供气控制系统的设计。- 59 -第2章总体方案设计与选择的论证2.1分析康复机器人是对有脑损伤、中风等病人进行主动康复训练的自动化机械装置。它可以帮助患者进行运动机能恢复性训练,进行主动式训练。训练各时期划分及有关具体内容如下:(l)双侧肢体支撑期。为双足着地、由双侧肢体支撑体重的时期,又分为被测在前的“前足着地双足支撑期”(预承重期)和被测在后的“后足蹬地双足支撑期”(摆动前期)2个时期。预承重期是从被侧足足跟着地至对侧足趾离地的时期;摆动前期是从对侧足足跟着地至被侧足足趾离地的时期。一侧足的预承重期即为对侧足的摆动前期。(2)单侧肢体支撑期。仅由被测足承担体重的时期,即从对侧足足趾离地至对侧足足跟着地的时期,也是对侧肢体摆动期。(3)摆动期。被测足不接触地面的时期,即从被测足足趾离地至同侧足跟着地的时期,也是对单侧肢体支撑期。在一个周期的各个时间点,各个关节的角度和所受到的力矩不同。下面从图2.2图2.7显示了一个75kg的人以1.3m/s的步行速度在平地上走时,髋关节、膝关节、踝关节三处关节在一个步行周期内不同阶段的转角和力矩变化131415。 图2.2步行周期内踝关节的角度变化图2.3踝关节力矩变化由图2.2、2.3可知步行时踝关节处力矩的最大值为-120N,角度范围为-2015。由图2.4、2.5可知步行时踝关节处力矩的最大值为60N,角度范围为-700。由图2.6、2.7可知步行时踝关节处力矩的最大值为-80N,角度范围为-2030。为了模拟人体行走的正常,更科学合理有效的进行康复训练,所设计的康复机器人各关节的运动(角度、力矩)和人体行走时关节的运动(角度、力矩)应该近似。为本设计就是根据这个原则进行设计的。 图2.4 膝关节的角度变化 图2.5 膝关节的力矩变化 图2.6 髋关节角度变化 图2.7 髋关节力矩变化2.2方案的选择本设计的主要工作是设计出一个有六个自由度(每一条腿有3个自由度)的康复机器人及其相应的框架和减重机构(一个自由度),然后绑在人腰部和上,分别带动髋关节、膝关节和踝关节的运动,从而训练相应部位的肌肉,帮助使用者恢复的运动功能,机构模型如图2.8。它由减重机构、姿态控制机构、运动平板等组成。图2.8机器人的功能模型2.2.1自由度的设计人体的灵活度很高,关节比较复杂。运动关节主要包括髋关节、膝关节、踝关节3个部分。髋关节是球窝关节,它的活动形式有3种,分别是向前伸展/向后伸展、侧向内转/外展、和向内外扭转。膝关节有向前伸展/向后伸展和侧向内转/外展两种活动形式。踝关节有背/跖屈、侧向内转/外展、向内外扭转3种形式的运动。考虑到有些关节运动消耗的能量小和结合康复医学的相关知识,确定3个自由度:髋关节的向前伸展、向后伸展,膝关节的向前伸展、向后伸展,踝关节的背曲和跖曲。总体结构有两条腿和一个减重机构共7个自由度。2.2.2基本参数的选取康复机器人的运动学和人体的运动学相近,因此人体关节的运动范围决定了下至康复机器人的关节运动范围。康复机器人的关节运动范围至少要和人体行走时关节范围一致。为了安全,机器人的关节运动范围一般要小于人体关节运动范围的最大值。参考人体各关节的运动角度,结合本设计的使用者是需要康复的患者和各关节在行走状态的最大值,具体数值见表2.1。表 2.1各关节的运动范围()关节活动形式人体行走最大值机器人关节取值人体关节活动最大值髋关节向前伸展32.245119髋关节向后伸展-22.5-30-70膝关节向前伸展000膝关节向后伸展-73.5-80-136踝关节背曲14.13046踝关节跖曲-20.6-30-43注:各关节的零度位置是:人体双脚并立,垂直站立。2.2.3驱动器的选择康复机器人不同于工业机器人,因为它特殊的使用场合和使用对象,要求在能够完成功能的前提下,整个康复要要安全、柔顺。本设计中的驱动器选择直线气缸。因为由传统的电、液驱动的马达或液压缸驱动结构复杂,所需能源的消耗较大。考虑到安装和运动的方便,采用圆形气缸。2.2.4关节结构的选择各个关节均为旋转关节。滚动轴承传动有摩擦阻力小,功率消耗少,启动容易等优点,可以充分利用气缸所作的功,减小机构体积。2.2.5连杆结构的选择作为大小腿的连杆机构既是传动装置又是执行装置。连杆的长度精度要求较高,若大腿连杆或小腿连杆长度与使用者大腿或小腿长度不同,将会导致两者髋关节轴线、膝关节轴线和踝关节轴线不同轴,这会直接导致两者在运动状态中出现运动干涉现象,两者偏差较大时,整个人一机混合系统将无法正常工作。因此,在进行大、小腿机械连杆设计时,把连杆设计成长度可调节的结构体尤为重要。其优点:可避免出现实验对象单一化,扩大使用对象;有利于关节同轴度的调整,避免运动干涉现象。本设计中连杆结构采用内外杆结构通过调节内外杆之间的固定位置调整连杆的长度(即大小腿的长度)。2.2.6腰部结构设计腰部结构主要为患者腰部提供支持和与框架的链接。腰带一方面可以对机械骸关节进行固定作用,另一方面在人行走过程中,当一支人机混合腿抬起时,即其处于摆动期时,其机械腿的部分重量可通过钢制腰带转移到另一支处于支撑状态的机械腿上,这样可以部分分担因一支腿抬起时,机械腿自重对使用者产生的负重效应。2.2.7减重机构残疾病人的力量往往不能给正常步行提供足够的力,所以在设计康复系统时要考虑到减重机构,在康复训练时减轻身体重力作用在腿上的力,使作用在腿上的力为身体重力大小的一部分。考虑到各个病人腿部力量的不同,减重比例要可以调节,要从0100%。2.2.8整体结构设计设计总体结构时,要考虑到装配工艺过程和整体效果,如:杆件各零件的装配顺序,气缸和杆件之间的干涉,轴承与轴承座装配,关节间的连接方式,外部框架之间的安装,减重结构与外部框架的链接,与外部框架的连接。具体装配方式见总体装配图。2.3本章总结本章在对康复机器人分析了解的基础上,构建用气缸作驱动器的康复机器人的结构方案。包括自由度的选择,基本参数的选取,驱动器的选择,关节结构的选择,连杆结构的选择,腰部结构的选择,减重结构的选择,整个机构的装配特性、工艺特性的考虑。在后面的章节中将具体进行具体结构的设计、标准件的选型、非标准件的设计、气缸的选型计算等。第3章机械结构的设计与计算及驱动元件选型3.1人体参数本设计的机械部分是要与人体接触的,它的关节、腿长等的设计要借鉴人体的一些参数,在零件的选择和校核计算过程中也要用到这些参数,具体参数见表3.1。表3.1中国青年几何统计表数据 足小腿 大腿质量/kg 0.885 2.196 8.497长度/mm 249 376 502质心长度/mm 38 224 254腿围/mm 253 355 507考虑到本设计的使用对象是有运动功能障碍的患者,所以确定各旋转关节运动为:髋关节向前伸展范围为45,向后伸展为30;膝关节屈伸范围为80;踝关节向上折屈范围为30,向下伸展为30。角度范围的选择是根据第2章中青年男子在行走时关节活动角度数据而定的。3.2各关节运动学分析本设计中的关节均为旋转关节,它由上下杆件和两块关节连接板,轴承及轴承盖和传感器组成。具体结构见装配图。3.2.1踝关节的运动学分析图3.1所示为踝关节的运动学模型示意图。2是小腿杆的一部分的长度,1是气缸端部安装孔距小腿杆中心线的距离,L3是关节中心到气缸活塞杆接头关节轴承中心的距离,L为气缸的长度(包括附件接头的长度),R为关节中心O点到L的距离,为关节转过的角度。图3.1踝关节运动学模型其中L1=110,L2=313,L3=178,单位为毫米,=100,的范围为30+30。气缸的长度(包括附件接头的长度)由下面公式 (3.1)计算出的L范围为310450,行程为140。R的最小值为110。3.2.2 膝关节的运动学分析图3.2所示为膝关节的运动学模型示意图。2是大腿杆的一部分的长度,1是气缸端部安装孔距关节中心水平方向上的的距离,L3是关节中心到气缸活塞杆接头关节轴承中心的距离,L为气缸的长度(包括附件接头的长度),R为关节中心到L的距离,为关节转过的角度。图3.2 膝关节机构运动学模型其中L1=110,L2=402,L3=171,=120,气缸L的长度可由公式(3.1)算出。计算出的L的范围为350500,行程为150。R的最小值为110。3.2.3 髋关节的运动学分析图3.3所示为髋关节的运动学模型示意图。2是大腿杆的一部分的长度,1是气缸端部安装孔距关节中心水平方向上的的距离,L3是关节中心到气缸活塞杆接头关节轴承中心的距离,L为气缸的长度(包括附件接头的长度),R为关节中心到L的距离,为关节转过的角度。其中1=60,L2=340,L3=135,=120,的范围为30 +45。气缸L的长度可由公式(3.1)算出。计算出的L的范围为350-450,行程为100。R的最小值为74。图3.3髋关节机构运动学模型3.3关节力矩分析由于本设计的机械结构部分的作的是低速运动,所以零件的选择从静力学角度分析和计算。图3.4力矩分析示意图其中:、分别为髋关节、膝关节和踝关节的旋转角度,以轴正方向为初始位置,图中所示角度的转向为正向、分别为大腿和小腿的长度 、分别为大腿、小腿和足的质心 、分别是大腿、小腿和足的质心到相应关节的距离。根据力矩方程 (3.2)得到各关节的力矩方程分别为 (3.3) (3.4) (3.5)式中:、分别是各质心处的质量,包括人体和机械结构总质量。 在下面的计算过程中,力矩的计算式均是按式(3.3)、(3.4)、(3.5)的原理计算的,所不同的是,下面的计算均取的是极限位置,即各关节受到最大力矩的位置。3.4具体结构设计3.4.1关节结构的选择各个关节均为旋转关节,实现结构如图3.5所示。滚动轴承传动有摩擦阻力小,功率消耗少,启动容易等优点,可以充分利用气缸所作的功,减小机构体积。通过关节连接板将关节的两个杆件连接在一起,而且整个机构零件分散,零件个体小,可以使整个关节结构轻便小巧、安全。图3.5关节结构图3.4.2连杆结构的选择作为大小腿的连杆机构既是传动装置又是执行装置。连杆的长度精度要求较高,本设计中连杆结构采用内外杆结构通过调节内外杆之间固定位置调整连杆的长度(即大小腿的长度)。3.4.3腰部结构设计腰部结构主要为患者腰部提供支持和与框架的链接。为适应不同腰围患者的需求,腰部结构中有铰链调整结构,可以调整腰围大小。同时为了适应人体行走时骨盆上下运动,腰部结构中有可以转动的关节结构。3.4.4减重机构减重机构如图3.9所示,它由滑车内的气缸带动安全带上下运动,安全带上的力传感器检测安全带上的力的变化,并根据力的变化调整减重气缸的供气压力,使得气缸提供恒定拉力,减重机构起到恒力减重作用。3.5一些零件的设计和校核3.5.1轴承的选择及校核本设计中的轴承主要承受径向力,所以选用深沟球轴承6000,它的径向基本额定动载荷C=13.2kN,预期寿命L=500小时。最大当量动载荷P=600N,寿命指数=3,转速n=60r/min,轴承基本额定寿命Lh(单位为小时)为所选轴承6000符合要求3.5.2气缸的选择 本设计中用到的气缸是根据德国Festo公司提供的型号选用的,类型根据工作要求和条件,选择双作用单耳环气缸。1.安装方式根据工作条件,选择摆动式单耳环气缸。2.作用力大小负载力F,负载率=70%,气缸输出力F拉=F,F推=F,气体压力P=0.6MPa,由公式 F拉= (3.6) 和F推= (3.7)由于F拉10MPa)。气缸的供气压力为0.6MPa,所以选择低压型空气压缩机。螺杆式空压机的脉动小,振动小,噪音小,符合本设计的要求,所以选择螺杆式空气压缩机。(1)空气压缩机的输出压力a (4.1)式中a空压机的输出压力,MPa; p 气动元件的最高使用压力,MPa; 启动系统的总压力损失,MPa。本设计中=0.6MPa,=0.150.2MPa,由公式(4.1)可得:a=0.750.8MPa(2)空气压缩机的吸入流量qa (4.2)式中qa空压机的吸入流量,m3/min (ANR);qb气动系统的平均耗气量,m3/min (ANR);k修正系数,k=1.52.0。本设计中qb=0.6m3/min (ANR),由公式(4.2)可得:qa=0.1m3/min (ANR)(3)空气压缩机的功率P (4.3)式中P空压机的功率,kW;p1吸入空气的绝对压力,MPa;K等熵指数,K=1.4;pa输出空气的绝对压力,MPa;qa空压机的吸入流量,m3/min (ANR);n中间冷却器个数。本设计中p1=0.1MPa,pa=0.8MPa,qa= 0.1m3/min (ANR),n=1,由公式(4.3)可得:P=1.35kW所选的空气压缩机型号为:德国BOGE公司的微油螺杆式空压机CL3;排气量:231L/MIN;工作压力:8BAR;马达功率:2.2KW。2、后冷却器从空压机中输出的压缩空气温度可达180,在此温度下,压缩空气中的水分完全呈气态,如直接送入气罐和气动设备,将会带来不良后果。后冷却器分为风冷式(HAA系列)和水冷式(HAW系列)两种。选用SMC公司的HAA22,主要参数见表4.1。表4.1风冷式后冷却器(HAA22)的技术参数额定流量(L/min)最高使用压力(MPa)适用压缩机功率(kW)进口空气温度()出口空气温度()3300 1.0 225100 40 3、主管路过滤器气体经空气压缩机后,先经过主管道到各支管管道,在主管道中设置主管过滤器,在支管中再按工作需要装置各种除尘、除油和除臭的过滤器。本设计选用SMC公司AFF系列中的AFF22B型号主路过滤器,主要参数见表4.2。表4.2AFF22B主路过滤器的主要参数额定流量(L/min)使用压力范围(MPa)额定流量下的压降(L/min)环境和介质温度()35000.151.00.01254、空气干燥器干燥器有高分子隔膜式、冷冻式和吸附式等。为了使用的方便,本设计选用高分子隔膜式干燥器(IDG系列)。这种干燥器的特点是:体积小、重量轻、无需排水器,带露点显示器,不用氟利昂,不用电源,无震动,无排热,使用寿命长,安装方便,除水率高等。符合本设计的要求,所以本设计所选用SMC公司的IDG系列中的IDG-H型号,它的主要参数如表4.3。表4.3IDG-H的技术参数进口压力范围(MPa)环境和介质温度()输出流量(L/min)分流流量(L/min)输出空气大气压露点()0.31.0 -550251000 3110 -405、气罐气罐的作用主要是:消除压力脉动;依靠绝热膨胀及自然冷却降温,进一步分离掉压缩空气中的水分和油分;贮存一定量的压缩空气,一方面可解决短时间内用气量大于压缩机输出气量的矛盾,另一方面可在空气压缩机出现故障时,维持短时间供气,以便采取措施保证气动设备的安全。这里估算气罐的容积V (4.4)式中:气动系统的最大耗气量,单位:L/min;气动系统允许的最低工作压力,单位:MPa;突然停电时,气罐内的压力,单位:MPa;大气压力,取MPa;停电后,应维持气动系统正常工作时间,单位:s。式中=100L/min,=0.6MPa,=1MPa,t=20s,可得Vmin=10L。气罐选择了SMC公司的AT6C型号,技术参数见表5.4。表4.4 AT6C的技术参数适用空压机功率(kW)容积(L)最高使用压力(MPa)使用流体温度() 5.51001.001006、截止阀截止阀的作用是:在执行元件不需要工作时或气动系统出现问题时,用来切断通路,或是它后面的通路中出现问题需要维修时,用来切断该部分支路,不去影响其它支路的工作。截止阀选择扬中市华威电力设备厂YZJ-2A J23W/H型外螺纹截止阀。7、除油器除油器可以分离掉主路过滤器和空气过滤器难以分离掉0.35m气状溶胶油粒子及大于0.3m的锈末、碳粒,这些微粒会加速气动元件的损坏。本设计中采用SMC公司的AM550的除油器,技术参数见表5.5。表4.5AM550主路过滤器的主要参数额定流量(L/min) 使用压力范围(MPa)额定流量下的压降(L/min)环境和介质温度() 35000.051.00.02558、除臭器除臭器的作用是除去压缩空气中的气味及有害气体,以获得清洁室所要求的压缩空气,本设计的使用采用SMC公司的AMF系列除臭器,其技术参数如表4.6所示。表4.6AMF550主路过滤器的主要参数额定流量(L/min) 使用压力范围(MPa)额定流量下的压降(L/min)环境和介质温度() 35000.051.00.01559、空气过滤器在这里用的过滤器比主路过滤器的过滤精度高,为了进一步除去压缩空气中的固态杂质,水滴和污油滴等。选择的产品型号为SMC公司的AF-60的空气过滤器。10、减压阀减压阀按压力调节方式有直动式减压阀和先导式减压阀两种,经比较选用先导式减压阀,因为它调压时操作轻便,流量特性好,稳压精度高,压力特性好。本设计对设备的安全性要求较高,所以选了SMC公司的外部先导式精密型减压阀(IR3120),它的主要技术参数如表4.7。表4.7IR3120的技术参数最高进口压力(MPa)最低进口压力(MPa)调压范围(MPa)控制压力(MPa)重复度1.00.10.010.80.010.811、压力表、消声器压力表的作用是测定并显示气动回路的压力高于大气压力的值,用来保证回路需要的压力。选择的型号为江苏金科仪表有限公司的Y-40压力表。本设计要与人体直接相连,它的环境不允许有噪音,所以需要消声器。消声器选择的型号为上海中石化阀门制造有限公司的XSQ-1消声器。12、比例流量阀流量型电气比例阀作用是实现输出流量进行比例控制。它的特点是:能实现程序控制、实现自动化;能实现连续控制、优化系统功能;使用功率小、发热少、噪声低;不会发生火灾、不污染环境、安全性高。这些特点很符合本设计的使用要求。结合本设计要求,选择SMC公司的先导式压力型电气比例阀中的VEF型号,参数见表4.8。表4.8VEF电气比例阀的主要参数最大电流(A)最高供给压力(MPa)额定消耗功率(w)电源电压(V)使用温度范围() 11.013 DC2410% 05013、两位四通直动式电磁换向阀直动式电磁换向阀结构简单,切换速度快,符合本设计的要求。选用德国Festo公司的JMEH-4/2电磁阀。4.2气动自动控制方框图供气系统直接为气缸供气,但是,要完全实现自动控制,还需要由单片机或计算机执行的控制系统。如图4.2中,是自动控制系统的功能方框图,反馈信息为髋关节、膝关节和踝关节的实际旋转角度,经与给定的角度相比较形成一个闭环系统。当实际旋转关节超出给定角度值时,形成差值,经放大器放大后,作用到流量比例阀上,控制流量大小,调节气气缸的运动速度,改变旋转关节的角度,使其在按给定的运动方式运动。如图4.3中,是减重部分的控制自动控制系统的功能方框图,反馈信息为作用在气缸上的拉力f,经与给定的力F相比较形成一个闭环系统。当拉力超出给定值F时,形成差值经放大器放大后,作用到压力比例阀上,控制压力大小,调节气缸的压力,使气缸提供恒定压力。图4.2气动自动控制方框图图4.3减重系统控制方框图4.4本章小结本章主要介绍了供气控制系统的设计,气动元件的选取过程。介绍了机器人的训练方式和控制的功能,为进一步完成自动控制系统的设计提供了理论基础。第5章 控制系统设计5.1 控制系统概述本项目所研发的康复机器人,目的是形成实用化的产品,为脑卒中患者提供康复医疗训练,缓解当前及以后患者众多而专业护理医师不足的局面。康复机器人的控制部分应采用体积小、功耗低、成本低的嵌入式控制系统。本章介绍康复机器人的嵌入式控制系统的软硬件设计。康复机器人控制系统总体结构示意图如图5.1 所示。图 5.1 康复机器人控制系统总体结构示意图5.2 处理器选型及硬件总体设计5.2.1 处理器选型单片机市场的市场规模越来越大,预计到 2010 时每年能有20G 片的出货量。世界各地的器件供应商纷纷推出自己的高性能产品,他们提供的器件和架构也是各具特色。各行各业对单片机能力的要求也一直在增加,处理器必须在不怎么增加主频和功耗的条件下处理更多任务。另一方面,处理器之间的互连通信增多:串口,USB,以太网,无线数传等,处理器要支持这些数据通道,就必须在片上集成更多的外设。软件方面的情况也类似,程序的功能一直在增强,性能需求也越来越高:更快的运算速度,更强的实时能力,更多的功能模块,更炫的图形界面,这些要求都要求单片机来满足。在这个需求下,为了让32 位处理器进入单片机市场,ARM Cortex-M3 处理器应运而生。由于采用了最新的设计技术,它的门数更低,性能却更强。许多曾经只能求助于高级32位处理器或DSP 的软件设计,都能在ARM Cortex-M3 上跑得很快。相信用不了多久,ARM Cortex-M3 就一定能在32 位嵌入式处理器市场中脱颖而出,像当年8051 推动整个业界那样,推动整个行业的发展。ARM Cortex-M3 的主要特征包括:1) 性能强:在相同的主频下能做处理更多的任务,全力支持复杂的程序设计。2) 功耗低:延长了电池的寿命,这对便携式设备如无线网络应用等至关重要。3) 实时性好。采用了很前卫甚至革命性的设计理念,使它能极速地响应中断,而且响应中断所需的周期数是确定的。4) 代码密度高。代码密度得到很大改善。一方面满足大型应用程序,另一方面为低成本设计留下余地。5) 使用方便。更简单的编程模型和更透彻的调试系统,为工程师大大减轻负担。6) 成本低:让32 位系统比和8 位/16 位的还便宜,低端的CortexM3 单片机甚至不到1 美元。7) 开发工具多:众多优秀的开发工具,免费的,便宜的,全能的,各种都有。众多知名半导体企业已经推出基于 ARM Cortex-M3 架构的处理器或者微控制器。如德州仪器(TI)、意法半导体(ST)、LM 等。其中STM32F10X 系列的微控制器就是ST公司推出的。STM32F103XX 增强型系列使用高性能的ARM Cortex-M3 32 位的RISC内核,工作频率为72MHz,内置高速存储器(高达512K字节的闪存和64K字节的SRAM),丰富的增强I/O 端口和联接到两条APB 总线的外设。所有型号的器件都包含3 个12 位的ADC、3 个通用16 位定时器和一个PWM 定时器,还包含标准和先进的通信接口:多达2 个I2C 和SPI、3 个USART、一个USB 和一个CAN。STM32F103XX 增强型系列工作于-40至+105的温度范围,供电电压2.0V 至3.6V,一系列的省电模式保证低功耗应用的要求。完整的STM32F103XX 增强型系列产品包括从36 脚至100 脚的五种不同封装形式。根据不同的封装形式,器件中的外设配置不尽相同。公司提供完整详细的底层固件库和大量技术支持文档,开发非常迅速方便。从以上介绍中可以看出,STM32F103XX 系列的微控制器非常适应于康复机器人嵌入式控制系统的开发。5.2.2 控制系统的硬件总体设计康复机器人的嵌入式控制系统要实现以下功能:操作方便的人机界面、安全柔顺的运动控制、康复医疗信息记录、与PC 机或网络的通信等。人机界面部分由小键盘和液晶屏组成,完成信息输入和显示。运动控制为闭环控制,即力传感器和角度传感器检测位置误差,经AD 转换完成数据采集,控制器根据传感器检测的数据,得到控制信息,由DA 转换将控制信息送往执行器,实现运动控制。康复医疗信息记录,有助于对患者病情的记录和临床分析数据的积累,对患者康复医疗方案的制定和康复医疗的研究都有帮助。康复机器人与外界的通信也是其基本功能之一。康复机器人与其他PC 机通信,能够方便专业医师对患者的治疗和指导、对康复机器人的控制。网络通信跟能完成远程康复医疗,更好地实现资源共享,患者在家里或者户外也可以像在医院和康复医疗中心一样得到专业医师的指导和康复医疗服务。基于以上功能分析,康复机器人的嵌入式控制系统硬件总体设计如图5.2所示。图 5.2 硬件系统总体结构这里选用的微控制器是 STM32F103RE,硬件设计系统资源分配如图5.3 所示。图 5.3 STM32F103RE 系统资源分配图5.3 电路设计最小系统是保证系统正常运行起来的最基本条件,包括主芯片、电源、时钟、复位、启动模式选择、调试接口等硬件电路部分。其中电源部分同时给整个控制板供电。最小系统是整个系统稳定运行的基础,主要的要求是电源和时钟稳定、复位可靠、调试接口正常、有一定的抗干扰能力。5.3.1 电源电路系统的供电,要求达到芯片或者模块的供电电压、电流以及电压稳定。通常使用低压差稳压芯片获得品质较好的供电。嵌入式控制板上,有的模块需要5V 供电,如LCM、传感器等。有的模块需要3.3V 供电,如STM32F103RE 芯片、SD 卡等。市面上有很多种输出为9V 的直流电源适配器。经过分析系统的各个模块对电压、电流的要求,采取的方案是用直流电源适配器将220V 的交流电转为9V 直流电,将9V 直流电用低压差稳压芯片转为5V 直流电,进一步将5V 直流电用低压差稳压芯片转为3.3V 直流电,给整个系统供电。LED 灯指示系统是否处于上电状态。具体的电路原理图如图5.4 所示。图 5.4 系统供电5.3.2 时钟与复位电路微控制器 STM32F103X 工作频率可以达到72MHz。在这一工作频率下,芯片性能发挥比较好。芯片的时钟采用内部振荡器,外部只需要按照技术手册的要求增加一个晶体振荡器和两个电容即可。另外,STM32 芯片提供一个实时时钟模块,可以在电池供电的情况下保存系统的时间,相当于系统的日历。实时时钟需要单独外接晶体振荡器来独立提供时钟基准。复位电路采用简单的按键、电阻及电容组成的电路,在按键按下时产生一个低电平,引发系统复位。时钟与复位电路的原理图如图5.5 所示。图 5.5 时钟与复位5.3.3 调试接口电路JTAG(联合测试行动组合)调试接口,是芯片制造商为开发者预留的在线仿真接口,同时也是边缘扫描测试技术的一种应用。JTAG 调试接口是一种国际标准的调试口,在STM32F103RE 芯片上已经有相应功能引脚。硬件设计只需要按规定的标准设计即可。硬件原理图如图5.6 所示。图 5.6 JTAG 调试口5.3.4 启动模式选择电路在每个 STM32 的芯片上都有两个管脚BOOT0 和BOOT1,这两个管脚在芯片复位时的电平状态决定了芯片复位后从哪个区域开始执行程序。由BOOT0 和BOOT1 的电平状态决定的启动模式见下表:表 5.1 STM32 启动模式表启动模式选择电路,就是要利用跳线使得BOOT1和BOOT0两个引脚能有不同的电平组合。电路原理图如图5.7所示。图 5.7 启动配置5.3.5 AD模块电路康复机器人总共有 7 个主动自由度,每个主动自由度上有一个角度传感器用于测量关节角度;有两个力传感器用于测量关节系统的两根气动肌肉拉力,共21 路传感器信号需要AD 转换。主芯片STM32F103RE 自带3 路12 位AD 转换。显然,AD 转换的精度可以满足,但路数不够。解决这一问题的方法是将21 路信号分为7 组(每个自由度的3 个传感器作为一组),采用多路分时复用。即利用多路开关在某一时刻转换一组(3 路)传感器的信息,下一周期转换下一组,如此循环。STM32F103RE 自带的AD 输入范围是0-3.3V,而传感器输出的模拟信号电压范围是0-5V。因此采用电阻分压电路,将传感器输出的模拟信号电压0-5V 转换为0-2.5V,然后送给STM32F103RE 的AD。所选用的多路开关芯片CD4051 导通电阻低,可以满足系统对传感器电压信号的分辨能力。CD4051 有8 路开关,则3 片CD4051 可完成21路信号的采集。AD 输入接口的电路原理图设计如图5.8 所示。图 5.8 AD 输入接口电路5.3.6 人机界面电路康复机器人的人机界面主要包括小键盘和液晶屏两个部分,使得用户能够在康复训练前或者康复训练中进行一些运行参数的设置以及康复机器人向用户返回一些信息。通过小键盘、液晶屏和微控制器STM32F103RE,可是实现用户菜单,设计出比较简单友好的人机界面。(1)键盘接口电路按键电路的作用就是在有按键按下时,给微控制器一个信号,如高电平、低电平或者脉冲,让微控制器知道外界有输入作用。利用按键实现菜单操作,只需要两三个按键即可。为操作方便,可以稍增加按键个数。这里的按键电路类似于复位电路,即电路由电阻、电容和按键组成。按下按键时在微控制器引脚上产生一个低电平,松开按键时微控制器引脚上恢复高电平。键盘电路中共五个按键,即菜单键(KEY_MENU), 向上键(KEY_UP),向下键 (KEY_DOWN),确认键 (KEY_OK), 复位键(KEY_RESET)。每个按键占用一个STM32F103RE 的GPIO 口,利用中断来检测按键按下,保证响应的实时性和可靠性。按键电路原理图如图5.9 所示,右边是给外购键盘所留的接口。图 5.9 键盘接口电路(2)液晶屏接口电路液晶屏通常在市面上购买,有不带控制器的液晶屏(LCD)和带控制器的液晶屏即液晶屏模块(LCM)。液晶屏模块(LCM)的接口电路设计较不带控制器的液晶屏(LCD)简单,程序设计也简单一些。液晶屏模块(LCM)有的带字库,有的不带字库。编程难易也有差别。这里选用性价比较高的金鹏电子有限公司的OCMJ(奥可拉中文集成模块)C 系列的OCMJ4X8C。OCMJ4X8C 中文模块可以显示字母、数字符号、中文字型及图形,具有绘图及文字图形混合显示功能。提供三种控制接口,分别是8 位微处理器接口,4 位微处理器接口及串行接口。所有的功能,包含显示RAM,字型产生器,都包含在一个芯片里面,只要一个最小的微处理系统,就可以方便操作模块。内置2M-位中文字型ROM(CGROM),总共提供8192 个中文字型(16x16 点阵);16K-位半宽字型ROM(HCGROM)总共提供126 个符号字型(16x8 点阵);64x16-位字型产生RAM(CGRAM),另外绘图显示画面提供一个64x256 点的绘图区域(GDRAM),可以和文字画面混和显示。提供多功能指令。主要参数:1) 工作电压(VDD):4.55.5V2) 逻辑电平:2.75.5V3) LCD 驱动电压(Vo):07V4) 工作温度(Ta):055(常温)/-2075(宽温) 保存温度(Tstg):-1065(常温)/-3085(宽温)为节约控制器的资源,这里选用串行接口作为接口通信方式。并使用STM32F103RE的GPIO 口模拟串口通信,完成LCM 信息传输。接口电路设计如图5.10 所示。图 5.10 液晶屏接口电路5.3.7 存储模块电路存储模块的功能是在患者进行康复医疗的过程中,记录康复训练相关信息,如所选用的康复训练方案、训练效果、患者感受的反馈等。这些信息既可以作为患者下一阶段的康复医疗方案制定的依据,也可以作为医师对康复医疗方案分析评价的基础数据。因此康复训练相关信息对用户个人和康复医疗研究都比较重要。目前使用比较方便的介质有U 盘、SD 卡等。U 盘通常使用USB 接口,接口协议相对复杂。SD 卡配一个USB 读卡器,相当于U 盘,可以非常方便的在PC 机上使用。这里选用接口简单,使用方便的SD 卡。SD 卡通常有支持两种协议:SD 协议和SPI 协议。主控制器STM32F103RE 上有SPI 接口,因此SD 卡的接口也设计为SPI 接口。按照SD 卡的设计规范,其接口电路设计如图5.11:图 5.11 SD 卡接口电路5.4 控制系统的软件设计5.4.1软件总体设计康复机器人的嵌入式控制系统软件设计,按功能模块划分,有运动控制模块、参数设置及显示模块、通信模块、信息存储模块、安全监控模块等。其中前四个模块的程序运行时需要进行调度。各个模块可以根据功能或者软件层次进一步细分。运动控制模块可以分为AD 程序、DA 程序、模糊控制三个子模块;参数设置及显示模块可以分为键盘程序和LCM 显示程序两个子模块;通信模块有串口通信、网络通信两个子模块;信息存储模块有文件系统和驱动等。系统程序设计采用前后台方式,即前台处理底层的中断程序,后台为包含各模块的主程序。软件总体设计如图5.12 所示。图 5.12 软件总体设计主程序中有多个模块,有些模块是长时间运行的,如运动控制模块;有的模块是随机运行的,如参数设置及显示模块。因此在主程序中需要对各个模块的运行进行调度。软件系统以全局变量和系统周期作为程序调度和模块间通信的手段。在各个软件模块运行过程中和在中断发生时更新全局变量Flag。系统周期作为软件系统运行的心脏,以Flag 变量为标志,每个周期内进行一次程序调度。图 5.13 系统软件主流程图5.4.2 系统初始化系统初始化是系统开始运行后首先执行的程序代码,将整个系统的硬件和软件配置到一个预定的合适状态,以便于后面应用程序的执行。硬件初始化主要的目标是让微控制器能够运行起来,按照硬件系统的资源分配和预定功能配置各种外设,如系统时钟、中断、存储器映射、总线、监控、运行模式、控制寄存器、外设配置如GPIO、通信接口等。软件初始化主要是对一些全局变量、静态变量、静态函数等进行赋值和执行。程序设计上,这里没有使用实时操作系统,软件编程采用模块化,系统初始化时硬件初始化和软件初始化并没有明显分开。系统初始化也就是对各个模块初始化函数的调用,程序代码如下:SystemInit()Microcontroler_Init(); / 微控制器初始化MotionControl_Init(); / 运动控制初始化UserInterface_Init(); / 人机界面初始化Communication_Interface_Init(); / 通信模块初始化File_Storage_Init(); / 文件存储初始化各个模块里有各自的硬件配置及软件初始化,如微控制器初始化里有时钟、中断、GPIO 口、存储器映射等设置;运动控制摸摸里有AD、DA、模糊控制的初始化。具体代码这里不详细列举。5.4.3 运动控制软件设计康复机器人的运动控制采用闭环控制方式,即用角度传感器检测位置信息,控制量与反馈信息比较后给模糊控制器,模糊控制器根据误差输出控制信号。力传感器的信息用作辅助控制。由系统定时器和中断保证在每个运动控制周期内,执行一次运动控制。就软件模块功能划分,运动控制软件模块有以下三个部分:传感器的AD 转换、控制信号的DA 转换和模糊控制器。(1)AD 转换程序传感器的 AD 转换采用STM 自带的三路AD,程序的功能是根据一定的采样频率,将3 路AD 转换的数据读到STM 的内存,进行相应的滤波和处理,得到可以供模糊控制器直接使用的角度信息。AD 转换程序中需要设置AD 转换的时钟、GPIO 口、嵌入式中断向量表入口、数据转移方式DMA、AD 转换方式、AD 采样频率等。还有多路开关CD4051 的驱动、滤波函数、角度数据处理函数。具体代码分别对应以下函数:void RCC_Configuration(void); / AD 转换的时钟设置void GPIO_Configuration(void); / GPIO 口设置void NVIC_Configuration(void); / 嵌入式中断向量表入口void DMA_Configuration(void); / 数据转移方式DMAvoid ADC1_Configuration(void); / AD 相关配置void SysTick_Configuration(void); / 用于AD 采样频率及延时void fliter(void); / AD 滤波函数void GetADC(u8); / 通过CD4051 选址读取一组数据float SensorData(void); / 数据处理获得传感器的值(2)DA 转换程序硬件上是通过两片 DA 转换芯片TLC5628 实现16 路的AD 转换,其中康复机器人要使用的有14 路DA。TLC5628 是串行接口的DA 芯片,其引脚及功能说明如表5.2。表5.2 TLC5628 引脚功能硬件设计上,两片TLC5628 共用时钟线和数据线。DA 程序设计就是要将数字数据发送给TLC5628。这里仍然是用STM32F103RE 的GPIO 口模拟TLC5628 的时钟和串行数据。TLC5628 的数据格式为连续两个8 位二进制数据。第一个8 位二进制数据的低4位有效,分别为地址信息和输出倍数信息。第二个8 为二进制信息为DA 转换的数字数据。其数据格式和控制时序如图5.14 所示。图 5.14 TLC5628 的数据格式和控制DA 转换只需要一个函数,这里给出具体代码:void SendDAC(u16 address,u16 data) /DA 转换u8 t;u16 k;GPIO_ResetBits(GPIOB, GPIO_Pin_5); /CLK=0,脉宽至少50nsGPIO_SetBits(GPIOB, GPIO_Pin_7 | GPIO_Pin_8);/LOAD0=LOAC0=1GPIO_SetBits(GPIOB, GPIO_Pin_9 | GPIO_Pin_10);/LOAD1=LOAC1=1k=data+(2*part+1)8); /合成串行数据,倍数rag=1for(t=0;t12;t+)GPIO_SetBits(GPIOB, GPIO_Pin_5); /CLK=1if(k&0x0800)GPIO_SetBits(GPIOB, GPIO_Pin_6); /dataelseGPIO_ResetBits(GPIOB, GPIO_Pin_6);delay(0x0fff);GPIO_ResetBits(GPIOB, GPIO_Pin_5); /CLK=0delay(0x0fff);k=k1;if(part8)GPIO_ResetBits(GPIOB, GPIO_Pin_7); /更新LOAD0delay(0x0fff); /脉宽至少250ns,即4MHZGPIO_SetBits(GPIOB, GPIO_Pin_7);delay(0x0fff);GPIO_ResetBits(GPIOB, GPIO_Pin_8); /更新LOAC0delay(0x0fff);GPIO_SetBits(GPIOB, GPIO_Pin_8);delay(0x0fff);elseGPIO_ResetBits(GPIOB, GPIO_Pin_9); /更新LOAD1delay(0x0fff); /脉宽至少250ns,即4MHZGPIO_SetBits(GPIOB, GPIO_Pin_9);delay(0x0fff);GPIO_ResetBits(GPIOB, GPIO_Pin_10); /更新LOAC1delay(0x0fff);GPIO_SetBits(GPIOB, GPIO_Pin_10);delay(0x0fff);(3)模糊控制器在前面已经介绍,模糊控制器的具体实现,是借助于 Matlab 的模糊控制工具箱以及Simulink。在Matlab 中建立模糊控制器的模型,设置好模糊控制器的论域、模糊变量隶属度函数、模糊规则、推理方法、解模糊方法等,通过Simulink 进行仿真和系统测试,得到模糊控制表。有了模糊控制表,可以把模糊控制器看作黑箱,只需要给定输入,查表即可得到输出。因此这里模糊控制器的程序实现相当简单。主要是由控制量及AD 反馈的信息计算误差,将误差和误差变化率分别通过误差量化因子Ke 和误差变化率量化因子Kec 缩放到模糊控制器的论域,查表得到模糊控制器的输出,再把模糊控制器的输出通过控制器输出比例因子Ku 缩放到执行器要求的范围,数据处理后由DA 转换输出控制信息。模糊控制器函数原型如下:void FuzzyConrtol(int joint, float angle, struct FuzzyConst *) ;模糊控制器函数的输入依此为关节编号、目标角度、常数结构体。常数结构体FuzzyConst 的分量有误差量化因子Ke、误差变化率量化因子Kec 和控制量输出比例因子Ku。函数中将调用AD 函数、DA 函数以及模糊控制表的数据。5.4.4 人机界面的软件设计人机界面由键盘和 LCM 两部分组成,完成系统的参数输入和信息显示。键盘操作向微控制器发送低电平脉冲,微控制器捕获信号后,以中断形式向系统返回按键值。微控制器根据按键值刷新LCM。(1)键盘程序设计键盘信号的捕获可以用查询、中断等方式,这里采用中断方式,最小程度地较少系统资源占用。键盘电路中共五个按键,即菜单键(KEY_MENU)、向上键(KEY_UP)、向下键(KEY_DOWN)、确认键(KEY_OK)、复位键(KEY_RESET)。KEY_MENU 用于回主菜单;KEY_UP、KEY_DOWN 用于按钮上下翻动;KEY_RESET 用于停机、紧急停车。主要的程序设计就是把键盘响应GPIO 口配置为中断捕获模式,以及在中断服务程序里指明当前按下的按键。按键的数据结构:typedef struct keyu8 x; /当前按键文字的行数u8 y; /当前按键文字的列数u8 *text; /当前按键文字内容void (*onOK)(void); /下一级菜单第一个按键struct key *next; /同级菜单的下一个按键KEY;按键相关程序举例如下:/*-键盘初始化-*/void Key_Init(void)Key_GPIO_Configuration(); / GPIO 配置Key_EXIT_Configuration(); / 外部中断配置Key_NVIC_Configuration(); / 中断向量表的映射/*-按键“OK”中断服务程序-*/void EXTI0_IRQHandler(void)if(EXTI_GetITStatus(EXTI_Line0) != RESET)KeyValue=6; / KEY_OK=1KeyFlag=1; /是否有按键按下EXTI_ClearITPendingBit(EXTI_Line0); / 清中断(2)LCM 程序设计LCM 程序的目标是在按键的配合下,实现菜单操作和相关信息显示。这里采用OCMJ4X8C 中文液晶模块的串口并使用STM32F103RE 的GPIO 口模拟串口通信,完成LCM 信息传输。以下是OCMJ4X8C 的串口时序图。图 5.15 OCMJ4X8C 的串口时序LCM 程序以下组成部分:硬件初始化、OCMJ4X8C 驱动程序、菜单显示程序。硬件初始化主要是配置STM32F103RE 的GPIO 口;驱动程序用GPIO 口完成对OCMJ4X8C的串口模拟,并实现LCM 相关相关基本操作如文字显示、图形显示、反白操作等;菜单显示程序则是根据按键的操作刷新LCM 的内容。LCM 程序由以下几个文件组成:LCM.c:初始化、驱动程序及菜单相关文字、图形点阵表示的数据,其中一些函数供StaticWindows.c 调用;StaticWindows.c:各级子菜单静态画面,其中一些函数供OnOK.c 调用。Menu_init.c:各级菜单的初始化链表,其中一些函数供OnOK.c 调用来显示当前按钮;OnOK.c:响应确认键操作,按键KEY_OK 按下时,往下一级菜
温馨提示:
1: 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
2: 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
3.本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
提示  人人文库网所有资源均是用户自行上传分享,仅供网友学习交流,未经上传用户书面授权,请勿作他用。
关于本文
本文标题:康复机器人系统设计【12张CAD图纸和毕业论文】
链接地址:https://www.renrendoc.com/p-11331812.html

官方联系方式

2:不支持迅雷下载,请使用浏览器下载   
3:不支持QQ浏览器下载,请用其他浏览器   
4:下载后的文档和图纸-无水印   
5:文档经过压缩,下载后原文更清晰   
关于我们 - 网站声明 - 网站地图 - 资源地图 - 友情链接 - 网站客服 - 联系我们

网站客服QQ:2881952447     

copyright@ 2020-2025  renrendoc.com 人人文库版权所有   联系电话:400-852-1180

备案号:蜀ICP备2022000484号-2       经营许可证: 川B2-20220663       公网安备川公网安备: 51019002004831号

本站为文档C2C交易模式,即用户上传的文档直接被用户下载,本站只是中间服务平台,本站所有文档下载所得的收益归上传人(含作者)所有。人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对上载内容本身不做任何修改或编辑。若文档所含内容侵犯了您的版权或隐私,请立即通知人人文库网,我们立即给予删除!