爬楼梯的自行轮椅车设计【8张图纸+电路图+仿真文件】【优秀】
收藏
资源目录
压缩包内文档预览：
编号：273305
类型：共享资源
大小：12.67MB
格式：RAR
上传时间：2014-04-26
上传人：J****
认证信息
个人认证
方**（实名认证）
江苏
IP属地：江苏
50
积分
- 关 键 词：
-
爬楼梯
自行
轮椅车
设计
图纸
电路图
仿真
- 资源描述：
-
爬楼梯的自行轮椅车设计
70页 20000字数+说明书+任务书+开题报告+8张CAD图纸【详情如下】
任务书.docx
摘要.docx
爬楼梯的自行轮椅车设计开题报告.doc
爬楼梯的自行轮椅车设计说明书.doc
电路图+仿真文件.rar
行星轮装配图7张.dwg
轮椅爬楼运动分解.dwg
轮椅装配图.dwg
目录
目录1
1 绪论3
1.1 课题研究原因和意义3
1.1.1 课题研究的原因3
1.1.2 课题研究的意义3
1.2 目前国内外研究状况3
1.2.1 轮组式4
1.2.2 履带式5
1.2.3 腿式6
1.2.4 复合式6
1.3 目前研究中所存在问题7
2 系统方案设计9
2.1 系统方案确定9
2.2智能电动越障爬楼轮椅系统构成10
2.2.1底盘系统10
2.2.2座椅姿态调整系统15
2.2.3驱动控制系统16
3 轮椅驱动模块设计18
3.1 电机的选择18
3.2 电机工作原理20
3.3 电源的选择23
3.4控制核心C8051F02023
3.4.1 C8051FO20概述23
3.4.2主要性能参数24
3.5电机转速控制25
3.5.1电机转速控制原理25
3.5.2电机转速控制方案26
3.6 电机驱动电路27
4 系统控制方案设计30
4. 1操纵杆设计30
4. 2双电机同步控制方案32
4.2.1 并行控制32
4.2.2 主从控制33
5 轮椅车控制算法设计35
5.1 速度检测电路35
5.2 PID控制方法36
5.2.1 PID控制方法介绍36
5.2.2 数字式增量PID控制算法38
5.2.3 标准PID算法的改进39
5.2.4 干扰的抑制40
5.2.5 PID调节器的参数整定40
6 轮椅车控制模块的数学模型43
6.1 系统运行方框图43
6.2系统运行原理44
6.3建立数学模型44
7 软件实现50
7.1 单片机片内的资源配置50
7.1.1 单片机内各功能模块配置50
7.1.2 单片机的端口配置51
7.2 程序模块介绍51
7.2.1 初始化模块52
7.2.2 测速子程序54
7.2.3 控制程序56
7.2.3 键盘扫描程序58
7.3 总程序58
总结68
参考文献69
致谢70
1.1.2 课题研究的意义
为了解决弱势群体人群增加而给社会经济、医疗护理各方面带来的巨大压力，更好的关怀老年人、残疾人的生活，改善他们的生活质量，除了加强改善房屋和各种公共建筑设施的无障碍设计，扩大轮椅的使用范围之外，改进现有的普通轮椅，使其兼备平地行驶以及爬越楼梯障碍两种功能，成为更行之有效、立竿见影的措施。值得注意的是，最近几年突发性自然灾害将导致肢体残障者的数量大幅上升。 大量灾难幸存者急需轮椅等康复设备和辅助工具。因此，为了解决需求，给老年人和残疾人士提供性能优越的交通和辅助工具，解决楼梯或路障对他们生活造成的不便，同时在考虑使用者的经济所承受能力限制，研究一种价格适宜、轻便的爬楼梯轮椅具有重大的现实意义和实用价值。.1 系统方案确定
通过综合分析，各机构特点如下表所示：
表2.1 爬楼机构特点总结
移动机构方式轮式履带式腿式
移动速度快较快慢
越障能力差一般好
机构复杂程度简单一般复杂
能耗量小较小大
机构控制难易程度易一般复杂
本设计确定采用爬楼梯优势较强的轮式机构。本论文采用的行星轮式爬楼梯轮椅的整体结构,行星轮结构在前进过程中通过中心轴驱动中心轮带动行星轮从而带动轮椅前迸,通过翻转电机带动行星架实现爬楼梯动作。
该种结构的优点有：
(1)平顺的行驶能力。轮椅小车在平地行驶时，由于其结构上的特点，任意时刻都有两个小车轮接地，利用轮组的定轴轮系传递动力，使小车轮快速的前进，其效率与普通轮式驱动车辆相同。当遇到可跨越的障碍时，轮组通过形星轮系翻滚前进。
(2)可靠的上下楼梯能力。轮椅小车上下楼梯时，小车轮驱动电机停止，形星轮减速器及蜗轮蜗杆式大减速比装置形成自锁功能，使轮辐电机驱动轮组翻滚时，轮组中心齿轮不转动。这使得在上下楼梯过程中，小车轮不会发生滚动，使得运动方位的控制得到精确的保证。这一优点对小车下楼梯控制尤其重要。
(3)控制方式容易实现。任意时刻轮椅车体左边车轮组着地小车轮和右边轮组着地小轮分别具有相同的转速，这样就能准确控制移动轮椅的行走状态。
(4)由电动机调速控制器来实现轮椅的转弯、直线前进、爬楼前进三个基本运动单元，所需的转弯半径即为车身宽度。
2.2智能电动越障爬楼轮椅系统构成
智能电动越障爬楼轮椅从整体上可以分为电气与机械两个部分，机械部分主要由 底盘系统与座椅调节系统构成，电气部分主要由底盘驱动控制系统与座椅姿态检测调 整系统构成。该系统结构如图2.1所示：
- 内容简介：
-
毕业设计（论文）任务书I、毕业设计(论文)题目： 爬楼梯的自行轮椅车设计(控制)II、毕 业设计(论文)使用的原始资料(数据)及设计技术要求：设计技术要求：自行轮椅平地行走速度不大于15km/h自行轮椅爬楼梯速度不大于8km/h自行轮椅安全性必须保证控制系统功耗小要求方案论证充分III、毕 业设计(论文)工作内容及完成时间：1、外文翻译(6000实词以上)； 2.20 2.22 0.5周2、收集有关资料，写出开题报告； 2.233.2 1.5周3、整体方案设计； 3.53.30 4 周4、控制系统方案设计； 4.24.27 4 周5、控制电路设计； 4.306.1 4周6、撰写论文； 6.4 6.15 2周 、主 要参考资料：1房立新等.行星轮式爬楼梯电动轮椅P.中国专利号：CN102125488A，2011年7月2赵树明.爬楼梯智能轮椅P. 中国专利号：CN201564701U，2010年9月3 高明.微机应用系统设计M.北京航空航天大学出版社,2003年3月4CAO Pengbin et. al. Structural analytical approach to coupled design in.design with axiomatic DesignJ.Chinese JOURNAL OF MECHANICAL ENGINEERING, 2006，42(3):46-555 北京有色冶金设计研究院编.机械设计手册(第二卷) M.化工出版社, 1993年1月 航空制造工程 学院 机械设计制造及其自动化专业类 080316 班学生（签名）：高骏日期： 自 2012 年 2 月 20 日至 2012 年 6 月 15日指导教师（签名）： 袁坤 助理指导教师(并指出所负责的部分)：机械制造工程 系（室）主任（签名）：爬楼梯的自行轮椅车设计(控制)学生姓名：高骏 班级：080316 指导老师：袁坤摘 要：轮椅在老年人和残疾人的生活中扮演着重要的角色，尤其是随着人口老龄化和残疾人数量增加等问题的日益严重，轮椅车将更加成为改善这一特殊人群的生活必备工具。然而，普通的手动和电动轮椅都不能够实现爬楼和翻越障碍的功能，使使用者的行动自由度受到了极大的限制。针对这个问题，本文研究了一种既可在平地使用，又能上下台阶的多功能爬楼梯轮椅，完成了系统方案设计和控制系统方案的设计。 本文在充分研究目前爬楼轮椅的国内外产品及相关文献，经综合比较分析，采用了以有刷直流电机驱动的基于行星轮结构的爬楼装置，并在此基础上详细论述了轮椅车的驱动控制方案。针对本文中所使用的双电机分别驱动左右轮的方案，提出了双电机同步控制的一种解决方案：采用主从式控制结构，为解决主从式控制系统的跟踪滞后问题，采用了带速度负反馈的PID算法。选用C8051FO20作为控制器极大地简化了外围电路设计及软件编程，仿真结果表明本文所采用的控制方案具有比较好的同步效果。关键词：爬楼轮椅 行星轮 双电机同步控制 pid算法 指导老师签名：design of Automatically stair-climbing walking wheelchair (control)Student name：Gao Jun Class: 080316Supervisor: Yuan Kun Abstrac： Wheelchair play an important role in the life of the elderly and persons with disabilities, especially with the increasingly serious problem of an aging population and the increase in the number of Persons with Disabilities, the wheelchair will be more and more become an essential tool to improve the lives of this special population. However, the normal manual or electric wheelchairs are disable to have the function of climbing stairs and climb over obstacles, so that the users freedom of action has been extremely limited. in connection with this issue, this study can both be used on flat ground, multi-function but also up and down stairs, stair climbing wheelchair, completed the design of the system design and control system program.In this paper, by the climbing stairs wheelchair domestic and foreign products and related literature comprehensive comparative analysis, using a brush DC motor drive based on the structure of the planetary wheel climbing stairs device, and on this basis are discussed in detail wheelchair drive control program. Used herein, the dual motor drive the left and right wheels, dual-motor synchronous control solution: a master-slave control structure, to solve the master-slave control system tracking lag, with negative feedback of the PID algorithm. The selection C8051FO20 as the controller greatly simplifies the peripheral circuit design and software programming, simulation results show that using this control scheme has good synchronization effect.Key words: Climbing stairs wheelchair planetary gear motor synchronous control pid algorithm Signature of Supervisor：毕业设计（论文）开题报告题目 爬楼梯的自行轮椅车设计 专 业 名 称 机械设计制造及其自动化 班 级 学 号 08031623 08031633 学 生 姓 名 黄海星 高 骏 指 导 教 师 袁 坤 填 表 日 期 2012 年 3 月 14 日一、选题的依据及意义： 轮椅是年老体弱者以及下肢伤残者必不可少的代步工具，随着无障碍设施的增多，轮椅使用者的活动范围逐步加大，但楼梯却使轮椅受到很大限制。目前的轮椅、电动轮椅能在坡度小于12度平坦的路面上行驶，但遇到楼梯台阶、沟槽、坎就无法跨越。当然随着我国城市化进程的不断加快，各类无障碍设施不断出现，以及重要的公共场合都会有特殊通道以供他们使用，这是时代的潮流，是社会进步的标志，更是人类文明不断发展的结果。但由于我国无障碍设施建设的滞后 ，很多地方都还没有无障碍设施，使他们的日常出行与生活造成相当大的不便， 鉴于楼梯 、台阶是最常见的障碍 ，研究爬楼梯的轮椅车能给由于生理机能变化的老年人，先天或意外致残等行动不方便人士提供一种能方便自我、操作方便、使用安全的、能将代步、跨越沟、坎、台阶与楼层（楼梯）融为一体的工具。解决他们在康复前的生活、学习、工作、交流等实际困难，减少他们由于自身身体缺陷而造成的不便。二、国内外研究概况及发展趋势：1 爬楼梯轮椅车的国内外现状 国外对爬楼梯的轮椅车产品较多如是德国PERFEKTA公司的产品。其为履带式传动，采用12V-15Ah的蓄电池、12V/170W的直流电机，自重42kg，可爬楼梯的最大坡度为35度。这种轮椅车除了可以单独使用外，还可以作为普通轮椅的搬运工具，直接把轮椅放在上面上下楼梯，因此作为车站、机场等处移动轮椅乘客的专用工具比较方便。而且，熟练操纵者能够自行乘坐轮椅上下楼梯。在平地能自由移动，也可折迭存放。这种轮椅的形式，采用的是履带式，是利用履带的附着力好，容易爬坡的优点设计的。但是，由于履带与楼梯的接触时，只是与楼梯的前棱接触，又由于人们对美学的要求好多楼梯的前棱作成了弧形，即使是传统的楼梯，如果经过多年的磨损，前棱也会被磨秃，这样一来，对于这种轮椅就很容易打滑，而且极不安全。为了解决楼梯打滑的问题,美国又发明了一种新型轮椅IBoT3000独立机动系统. 从外表看上去，iBOT与普通轮椅不大一样：它有6个轮子，前面一对为直径10厘米的实心脚轮，后面两对为直径30厘米的充气轮胎。iBOT通过复杂的陀螺仪系统来保持平衡，当轮椅上分布的传感器感受到重心变化时，它们马上把这些信息传输到位于座椅下面的控制盒中。控制盒里有几个“奔腾III”处理器和预先设计好的程序，这些程序会“命令”轮椅的机械系统进行自我调整，保持平衡。iBOT共有3种运动模式，一种是正常模式，像普通轮椅一样在平地上前进，6只轮子同时着地；如果遇到崎岖的路面、沙土地或斜坡，它就进入四轮驱动状态，靠4个后轮行走。第二种是直立模式，只靠一对后轮接触地面，很像中国武术中的“金鸡独立”，iBOT可以保持这种站立姿势，也能“直立行走”。第三种是爬梯模式，两对后轮交替“爬”到上一级(或下一级)台阶上。但其价格为29000美元,鉴于我们国内的消费水平,还无法普遍接受如此高昂的费用。所以国内有人参照IBOT研发了行星轮系的爬楼梯轮椅车,最有代表性的是李荣标为骨折妻子发明能爬楼梯轮椅车。其是由5个小轮组成的五星轮，轮椅前方一个半米长的安全支架上还有4个小轮，整个椅子共有14个小轮。他背对着楼梯将轮椅微微倾斜，很轻松就将老伴拉了上去，五星轮上的一个小轮刚好能上一级楼梯。在爬楼过程中，因为有安全支架的支撑，轮椅能停在任何一处。其明显的缺点是不够自动化,全程操作需要旁人相助,且车体结构不够紧凑。2 发展趋势连续型爬楼梯轮椅工作效率高，爬楼梯的速度较快，间歇型的爬楼梯轮椅因两套支承装置交替支承，爬楼梯的速度一般较慢，且间歇型爬楼机构和控制较复杂所以连续型是其发展趋势。其中，星型轮式爬楼梯轮椅的活动范围广，运动灵活，但是上下楼梯时平稳性不高；履带型爬楼梯轮椅的技术比较成熟，传动效率比较高，行走重心波动很小，运动非常平稳，但是运动不够灵活，对楼梯有一定的损坏，这限制了其在日常生活中的推广应用。可见若减小星型轮式爬楼梯轮椅的上下楼梯平稳性，这将是将来爬楼轮椅的主要趋势。随着当前电动车的普及，将来轮椅车也更多的是采用电动驱动，免去旁人的帮助操作者也能轻松自如的进行行走，以缓解身体不便带来的诸多困扰。可见轮椅车将是朝着电气化，智能化的方向发展着，它将在残障人士及年老人群发挥积极作用，成为他们生活中的帮手。而不仅仅是一种用途有限的代步工具。三、主要研究的内容、预期目标： 1 主要研究内容：轮椅的自动上下楼动作的完成，包括机械结构部分和控制部分两大部分 2 预期目标：实现轮椅自动上下楼的自动控制，和上下楼时的平稳性和安全性以及成本的大众性 四、目标、主要特色及工作进度 1 目标 通过这次对爬楼梯自行轮椅车的总体和结构的设计，学会利用查参考书和某些图表正确计算和选用零件的尺寸和一些参数，培养自己掌握一般机械设计的思路，设计方法和设计步骤。提高自己利用计算机绘制二维图纸的能力。 研究重点：自动控制的实施，机械传动的完成。 研究难点：如何才能使轮椅在自动上下楼个过程中，达到让使用者安全舒适而且造价可以让大众所接受 2 主要技术要求（1） 自行轮椅平地行走速度不大于15km/h;（2） 自行轮椅爬楼梯速度不大于8km/h；（3） 自行轮椅安全性必须保证；（4） 机械结构合理，传动效率高；（5） 控制系统功耗小；（6） 要求方案论证充分。 3 工作进度 毕业设计（论文）工作内容机完成时间：1）外文翻译(6000实词以上)； 2.20 2.22 0。5周2）收集有关资料，写出开题报告； 2.233.2 1。5周3）整体方案设计； 3.53.30 4 周4）机械结构与控制系统方案设计； 4.24.27 4 周5）机械零件设计绘图与控制电路设计； 4.306.1 4周 6）撰写论文； 6.4 6.15 2周7）答辩准备及论文答辩： 6.15 7.2 2周 五、参考文献【1】璞良贵，纪名刚主编.机械设计.第七版.北京: 高等教育出版社， 2001【2】房立新等.行星轮式爬楼梯电动轮椅P.中国专利号：CN102125488A，2011年7月【3】赵树明.爬楼梯智能轮椅P. 中国专利号：CN201564701U，2010年9月【4】高明.微机应用系统设计M.北京航空航天大学出版社，2003年3月【5】王中发.实用机械设计M.北京：北京理工大学出版社，1998年2月【6】北京有色冶金设计研究院编.机械设计手册(第二卷) M.化工出版社， 1993年1月【7】CAO Pengbin et. Al.Structural analytical approach to coupled design in. design with axiomatic DesignJ.Chinese JOURNAL OF MECHANICAL2006，42(3):46-5南昌航空大学学士学位论文目录目录11 绪论31.1 课题研究原因和意义31.1.1课题研究的原因31.1.2课题研究的意义31.2 目前国内外研究状况31.2.1轮组式41.2.2履带式51.2.3腿式61.2.4复合式61.3 目前研究中所存在问题72 系统方案设计92.1 系统方案确定92.2智能电动越障爬楼轮椅系统构成102.2.1底盘系统102.2.2座椅姿态调整系统152.2.3驱动控制系统163 轮椅驱动模块设计183.1 电机的选择183.2 电机工作原理203.3 电源的选择233.4控制核心C8051F020233.4.1 C8051FO20概述233.4.2主要性能参数243.5电机转速控制253.5.1电机转速控制原理253.5.2电机转速控制方案263.6 电机驱动电路274 系统控制方案设计304. 1操纵杆设计304. 2双电机同步控制方案324.2.1 并行控制324.2.2 主从控制335 轮椅车控制算法设计355.1 速度检测电路355.2 PID控制方法365.2.1 PID控制方法介绍365.2.2 数字式增量PID控制算法385.2.3 标准PID算法的改进395.2.4 干扰的抑制405.2.5 PID调节器的参数整定406 轮椅车控制模块的数学模型436.1 系统运行方框图436.2系统运行原理446.3建立数学模型447 软件实现507.1 单片机片内的资源配置507.1.1 单片机内各功能模块配置507.1.2 单片机的端口配置517.2 程序模块介绍517.2.1 初始化模块527.2.2 测速子程序547.2.3 控制程序567.2.3 键盘扫描程序587.3 总程序58总结68参考文献69致谢701 绪论1.1 课题研究原因和意义1.1.1课题研究的原因 现今，老龄化人群以和下肢残障者在占我国总人口总数的比重愈来愈大，他们丧失了部分行动能力，更需要有人来加以帮助和护理。目前，在其中的很大一部分年老体弱者和下肢伤残者会选择轮椅作为他们的外出行动工具，而且大都需要在家人或护理人员下使用轮椅来进行活动。随着现今社会的快速发展，城市化的不断加快，楼梯和跨越路障等不断增加。然而，对于普通轮椅而言是很难跨越这种障碍，从而限制了轮椅使用者的活动范围，影响其一系列的社交生活。尤其是国内城市楼房公寓，电梯并没有应用到所有的居民住宅，这给轮椅乘坐者造成诸多不便。马路沿、土坑等户外障碍同样对老年人、残障人士的出行带来了很多不便，影响了他们的正常生活。1.1.2课题研究的意义为了解决弱势群体人群增加而给社会经济、医疗护理各方面带来的巨大压力，更好的关怀老年人、残疾人的生活，改善他们的生活质量，除了加强改善房屋和各种公共建筑设施的无障碍设计，扩大轮椅的使用范围之外，改进现有的普通轮椅，使其兼备平地行驶以及爬越楼梯障碍两种功能，成为更行之有效、立竿见影的措施。值得注意的是，最近几年突发性自然灾害将导致肢体残障者的数量大幅上升。 大量灾难幸存者急需轮椅等康复设备和辅助工具。因此，为了解决需求，给老年人和残疾人士提供性能优越的交通和辅助工具，解决楼梯或路障对他们生活造成的不便，同时在考虑使用者的经济所承受能力限制，研究一种价格适宜、轻便的爬楼梯轮椅具有重大的现实意义和实用价值。1.2 目前国内外研究状况 在爬楼梯装置的研究领域内，国外对爬楼梯装置的研究开始得相对较早，最早的专利是1892 年美国的Bray 发明的爬楼梯轮椅。此后，各国纷纷开始投入此项研究，其中美国、英国、德国和日本占主导地位，技术相对比较成熟，且有一些产品己经投入市场使用。国内的研究也在近一、二十年内取得了显著成果，近年来相关专利屡见不鲜，目前国内外现有的爬楼梯装置和专利种类众多，不同的爬楼梯装置适用于不同的环境和条件，各有利弊。按照爬楼梯装置爬楼执行机构的类型，主要可归结为轮组式、履带式、腿式三类。1.2.1轮组式 轮组式的特点是每个轮组依照星形轮的方式进行运动：平地行驶时，各小轮绕各自轴线自转；爬楼梯时，各小轮一起绕中心轴公转。 美国发明家Dean Kamen 发明的IBOT （专利号：US6 , 443 , 250 BI ）是一种能自动调节重心的两轮组式轮椅，是单轮组爬楼装置中最具代表性的爬楼装置之一。iBOT 不仅采用了比普通轮椅复杂的驱动结构，而且安装了多个感知人 轮椅重心位置的陀螺仪，控制器根据陀螺仪的信号调整重心的位置，使轮椅能够在不同路面和直立状态下保持平衡。iBOT3000 己经获得FDA 批准在欧美上市，售价相当于中高档轿车的价格。如下图所示: 图1.1 ibot实物图 内蒙古民族大学物理与机电学院的苏和平等人借鉴了iBOT 的爬楼方式，采用星形轮系作为爬楼梯机构，设计了一种双联星形机构电动爬楼梯轮椅。改轮椅爬楼时需要人工辅助或者楼梯扶手的辅助支撑，使其能调整重心的位置，安全爬楼。如下图1-2 和1-3所示 图1-2 双联星形爬楼梯轮椅图 图1-3 双联星形爬楼梯轮椅改进图 图1.4 双联行星轮内部传递图1.2.2履带式 履带式爬楼梯装置的原理类似于履带装甲运兵车或坦克，技术较成熟，操作简单，行走时重心波动很小，对楼梯的形状、尺寸适应性强。英国Baronmead 公司开发的一种电动轮椅车，底部是履带式的传动结构，可爬楼梯的最大坡度为35 度，上下楼梯速度为每分钟15-20个台阶。法国Topchalr 公司生产的电动爬楼梯轮椅，它的底部有四个车轮供正常情况下平地运行使用，当遇到楼梯等特殊地形时，用户通过适当操作将两侧的橡胶履带缓缓放下至地面，然后把这四个车轮收起，依靠履带无需旁人辅助便能自动完成爬楼等功能。如图1-5所示 图1.5 履带式结构1.2.3腿式 早期的爬楼梯装置一般都采用步行式，其爬楼梯执行机构由铰链杆件机构组成。上楼时先将负重抬高，再水平向前移动，如此重复这两个过程直至爬完一段楼梯。步行式爬楼梯装置模仿人类爬楼的动作，外观可视为足式轮椅，采用多条机械腿交替升降、支撑座椅爬楼的原理。如图1-6所示 图1.6 步行式爬楼轮椅1.2.4复合式 现今，爬楼装置一个研究创新点是将上述的轮组、腿式、履带机构相互结合，吸取各自的优点。比较广泛的组合思路有以下两种：一是轮履、腿履复合。比如中国科学技术大学精密机械与精密仪器系研制的一种小型全自主多种移动方式相融合的复合式越障轮椅。二是采用了轮一履复合 如图1-7所示和轮腿一履带复合 如图1-8所示等结构。设计主要是依靠腿式机构来完成越障，以及履带平稳性和轮组的灵活性来达到功能的完整。 图1.7 轮一履复合图 图1.8 轮腿一履复合图1.3 目前研究中所存在问题履带式的缺点就是对楼梯边缘施加的强压力，不可避免的对楼梯沿有一定的损坏，不适合大绝大多数室内楼梯。自重较大，平地行走时阻力较大，相对于其他结构，履带式转弯需要更大的动力，使用过程中噪声很大。这些都限制了它在日常生活中的推广，被接受程度低。 腿式爬楼装置有最好的地形适应力，但承载重量较小，具有较大危险性，且重心偏高。运动相对比较平稳，颠簸感轻微，但同时运行速度较缓。此外，该类型装置对控制的要求较高，操作比较复杂，在平地行走时运动幅度不大，动作缓慢。复合式爬楼装置各种机构的复合也给控制方面提出了更高的要求，而且爬楼过程中的稳定性、如何适应不同尺寸的楼梯、如何实现手动操作省力与省时的问题以及反向自锁等问题仍然存在。综上所述，国外在爬楼梯装置方面的研究己经有一百多年的历史，成果也较多，但是它们大多结构复杂、造价昂贵，远远超出了发展中国家人民的经济承受能力。国内的研究相对较晚，虽然也诞生了很多专利，但由于受到体积、重量、稳定性及安全性的限制，还没有产品真正投入使用。由此可见，为了解决移动轮椅使用受限的问题，同时考虑到我国使用者的经济承受能力，需要研究一种价格低廉、功能多样的爬楼梯装置。本装置作为面向老年人和残疾人的服务型机构，作者认为其设计思想必须从以下几个性能出发： ( 1 ）平地、楼梯两用；( 2 ）平地行驶效率高，操作方便简单；( 3 ）爬楼时重心波动缓和，稳定性好；( 4 ）不平坦地形下对系统的重心作适时调节，避免车体倾斜给使用者带来恐惧；( 5 ）上下楼时符合日常运动习惯，避免反向上楼给乘坐者带来不便；（6）轮椅结构尽量简单，造价低廉。为了满足上述要求，本文给出了一种结构紧凑、爬楼重心波动较小、正面上楼的平地、楼梯两用助行装置，并对其控制部分进行了详细的论述。2 系统方案设计2.1 系统方案确定 通过综合分析，各机构特点如下表所示：表2.1 爬楼机构特点总结移动机构方式轮式履带式腿式移动速度快较快慢越障能力差一般好机构复杂程度简单一般复杂能耗量小较小大机构控制难易程度易一般复杂 本设计确定采用爬楼梯优势较强的轮式机构。本论文采用的行星轮式爬楼梯轮椅的整体结构,行星轮结构在前进过程中通过中心轴驱动中心轮带动行星轮从而带动轮椅前迸,通过翻转电机带动行星架实现爬楼梯动作。 该种结构的优点有：(1)平顺的行驶能力。轮椅小车在平地行驶时，由于其结构上的特点，任意时刻都有两个小车轮接地，利用轮组的定轴轮系传递动力，使小车轮快速的前进，其效率与普通轮式驱动车辆相同。当遇到可跨越的障碍时，轮组通过形星轮系翻滚前进。(2)可靠的上下楼梯能力。轮椅小车上下楼梯时，小车轮驱动电机停止，形星轮减速器及蜗轮蜗杆式大减速比装置形成自锁功能，使轮辐电机驱动轮组翻滚时，轮组中心齿轮不转动。这使得在上下楼梯过程中，小车轮不会发生滚动，使得运动方位的控制得到精确的保证。这一优点对小车下楼梯控制尤其重要。(3)控制方式容易实现。任意时刻轮椅车体左边车轮组着地小车轮和右边轮组着地小轮分别具有相同的转速，这样就能准确控制移动轮椅的行走状态。(4)由电动机调速控制器来实现轮椅的转弯、直线前进、爬楼前进三个基本运动单元，所需的转弯半径即为车身宽度。2.2智能电动越障爬楼轮椅系统构成智能电动越障爬楼轮椅从整体上可以分为电气与机械两个部分，机械部分主要由 底盘系统与座椅调节系统构成，电气部分主要由底盘驱动控制系统与座椅姿态检测调 整系统构成。该系统结构如图2.1所示：图2.1智能电动越障爬楼轮椅系统结构图2.2.1底盘系统爬楼底盘系统釆用了创星的行星轮机构作前轮驱动行走，万向轮、引导轮作为后 轮辅助行走。该系统可实现平地行走和越障爬楼的功能，对崎岖的路面具有较好的适应能力。根据GBT 18029.23-2008,可知一般楼梯每阶髙度为180 mm5 mm,最小楼梯坡度为35,容许误差为(见下图)。所有楼梯的梯级突边都在由两个相距10 mm、倾斜角度与楼梯坡度相同的平行平面所形成的区域内。 图2.2 标准楼梯结构图可画出爬楼底盘运动效果如图2.3所示： 图2.3 爬楼底盘运动效果下图为行星轮系结构图 图2.4 行星轮系结构图行星轮结构由2K-H周转轮系的演化结构来实现。下图2.5是2K-H周转轮系的 结构简图。图2.5 K-H周转轮系的结构简图万向轮由于受到轮胎直径的影响，在水平作用力推动的情况下只能翻爬小于轮胎 半径的台阶或楼梯。在翻越楼梯及障碍的过程中采用中.纯的万向轮结构不仅会产生阻力，而且在翻爬楼梯时会产生较大的冲击。在使用创新的引导轮结构与万向轮相配合后，轮椅在翻越的过程中，障碍物或楼梯的台阶将首先与引导轮相接触，由引导轮引导障碍物或楼梯的台阶与万向轮和接触。这样不仅有利于提高万向轮的翻越能力，而且可以减少阻力与冲击。图2.6 创新的引导轮结构2.2.2座椅姿态调整系统座椅姿态检测采用双轴倾角传感器，实吋检测座椅与水平面的姿态以保证乘坐者的安全。翻转时轮椅与地面的支撑点，增加了乘坐齐的安全性与舒适性，同时又使得行星轮在翻转的过程中所需要的力矩减少，翻转更加容易。 图2.7 座椅姿态调整机构示意图2.2.3驱动控制系统驱动控制系统主要由微处理器系统、控制手柄及按键系统、主驱动电机及其驱动电路、电池组组成。驱动控制系统的目的在于配合机械结构完成相应的执行动作，保证轮椅的正常运行。电力驱动控制系统的效果图如下: 图2.8 电力驱动控制系统的效果图3 轮椅驱动模块设计3.1 电机的选择 考虑到轮椅车的户外使用条件,我们需要选择永励直流电机。永励直流电机根据有无机械换向装置又分为有刷直流电机和无刷直流电机。无刷直流电机有如下优点：a) 电子换向来代替传统的机械换向，性能可靠、永无磨损、故障率低 b) 属静态电机，空载电流小； c) 效率高； d) 体积小。固目前电动车大部分都采用无刷直流电机作为动力部分,且有很多相应的控制器。但其还有如下缺点：a) 低速起动时有轻微振动； b) 价格高，相应的控制器要求高，成本也高； c) 易形成共振；而有刷电机的如下特性是无刷电机所不可比拟的：a) 变速平稳，几乎感觉不到振动； b) 温升低，可靠性好； c) 价格低基于有刷直流电机的平稳可靠及低成本，本方案采用有刷直流电机。如果注意碳刷的保养，以及及时更换其使用性还是非常好的。通过查找相关资料，我选择北京康键宜医疗器械有限公司的轮椅车专用电机DG-M4。其外形及参数如下： 图3.1 DG-M4外形 表3.1 DG电机产品系列 表3.2 DGM4电机参数该电动机构由一个带电磁离合器（刹车）装置的永磁电动机和带一级直齿和一级蜗轮副传动的全封闭齿轮箱组成；手推轮椅时，可以通过简易操作手柄释放花键来实现离合。通过计算行走电机与翻转电机均可为DG-M4。通过对花键的操作即可实现手动与自动的切换，而蜗轮蜗杆传动对于爬楼装置来说，可以实现自锁，这对爬楼这一动作提供了安全保障。3.2 电机工作原理永磁直流电机是用永久磁体来建立电机所需的磁场，无需另用电源进行励磁。有刷电机的定子上安装有固定的主磁极和电刷，转子上安装有电枢绕组和换向器。直流电源的电能通过电刷和换向器进入电枢绕组，产生电枢电流，电枢电流产生的磁场与主磁场相互作用产生电磁转矩，使电机旋转带动负载。下图为电机的四个永磁体磁极，排列在同一圆周上。 图3.1 电机磁极排列钕铁硼是目前最好的永磁体材料，磁力非常强大、矫顽力很高，性能好的永磁电机多选用钕铁硼做磁极。磁极固定在机壳内，机壳同时为电机提供磁路。 在下图中用蓝色的磁力线表示电机的磁路。 图3.2 电机的磁路 永磁电机不需励磁电流发热较少，但机壳为防铁粉污染多为密封，一般通过机壳外周多个散热片进行散热；端盖板延伸到机壳外兼做机脚，整个构成电机的定子机座，通过机脚来安装固定电机。 永磁直流电机的转子由转子铁芯，转子绕组、换向器、转轴构成。电流通过电刷连接转子绕组，四极电机一般有四组电刷，一同装在刷架上，共同构成电刷组件。下图显示了转子与电刷组件的相对位置。 图3.3 转子与电刷组件的相对位置下图为合上端盖的永磁直流电机剖面图图3.4 永磁直流电机剖面图3.3 电源的选择 明显电动轮椅车的电源为可充电式电池，选择好电池也是轮椅车正常工作的先决条件之一。本次方案选择一般电动车上使用的铅蓄电池。铅蓄电池的优点是放电时电动势较稳定，电压平稳、使用温度及使用电流范围宽、能充放电数百个循环、贮存性能好（尤其适于干式荷电贮存）、造价较低，因而应用广泛。铅蓄电池原理如下： 把A、B两块铅板插入硫酸溶液中，铅与硫酸作用的结果，使A、B两块铅板上形成硫酸铅，溶液中也被硫酸铅饱和，这是还没有电势，给蓄电池充电时，在两极上发生的化学反应如下： A;PbSO4+2H2O - 2e-PbO2+H2SO4+2H+; B:PbSO4+2e-Pb+SO42-; 可以看出，充电后，A板上的PbO2成为正极， B板上Pb成为负极。放电时，两极发生的反应如下： 正极：PbO2+H2SO4+2H+ -2e-PbSO4+2H2O-2e-; 负极：Pb+SO42-PbSO4+2e-;又电机的额定电压为24V,固选用24V的铅蓄电池组。其自带充电模块。3.4控制核心C8051F0203.4.1 C8051FO20概述C8051FO20系列单片机是Cygnal公司新推出的一种混合信号系统级单片机。该系列单片机片内含CIP-51的CPU内核，它的指令系统与MCS-51完全兼容。其中的C8051F020 单片机含有64kB片内Flash程序存储器，4352B的RAM、8个IO端口共64根IO口线、一个12位AD转换器和一个8位AD转换器以及一个双12位DA转换器、2个比较器、5个16位通用定时器、5个捕捉比较模块的可编程计数定时器阵列、看门狗定时器、VDD监视器和温度传感器等部分。C8051F020单片机支持双时钟，其工作电压范围为2.7-3.6V(端口IO，RsT和JTAC引脚的耐压为5V)。与以前的51系列单片机相比，C8051F020增添了许多功能，同时其可靠性和速度也有了很大提高。外形及引脚排列如图所示： 图3.5 C8051FO20外形及引脚排列 图3.6 C8051FO20内部逻辑图3.4.2主要性能参数 C8051F02x 系列单片机是集成在一块芯片上的混合信号系统级单片机。芯片上有 64 位数字 I/O 口（C8051F020/2)或 32 位数字 I/O 口（C8051F021/3）。C8051F020作为整个系统的控制部件，它具有以下特点10,14：l 高速、流水线结构的8051兼容的CIP-51内核（可达25MIPS）；l 全速、非侵入式的在系统调试接口（片内）；l 12位、100ksps的8通道ADC，带PGA和模拟多路开关；l 8位、500ksps的ADC，带PGA和8通道模拟多路开关；l 两个12位DAC，具有可编程数据更新方式；l 64KB可在系统编程的Flash存储器；l 4352（4096+256）B的片内RAM；l 可寻址64KB地址空间的外部数据存储器接口；l 硬件实现的SPI、SMBus/IIC和两个UART串行接口；l 5个通用的16位定时器；l 具有5个捕捉/比较模块的可编程计数器/定时器阵列；l 片内看门狗定时器、VDD监视器和温度传感器；l 两种可软件编程的电源管理方式空闲方式（等待方式）和停机方式（掉电方式）；l C8051F020工作电压2.7V-3.6V，端口I/O、/RST和JTAG引脚都容许5V的输入信号电压；l 64个IO口， TQFP100封装；l 与其它8位单片机相比，有更高的程序安全性；3.5电机转速控制3.5.1电机转速控制原理 根据直流电机转速方程 （3-1） 式中 U 电枢电压（V）； I 电枢电流（A）； R 电枢回路总电阻（ W ）； 励磁磁通（Wb）； 由电机结构决定的电动势常数。可推出有三种方法调节电动机的转速： （1）调节电枢供电电压 U； （2）减弱励磁磁通 F； （3）改变电枢回路电阻 R。 对于要求在一定范围内无级平滑调速的系统来说，以调节电枢供电电压的方式为最好。改变电阻只能有级调速；减弱磁通虽然能够平滑调速，但调速范围不大，往往只是配合调压方案，在基速（即电机额定转速）以上作小范围的弱磁升速。 因此，自动控制的直流调速系统往往以调压调速为主。3.5.2电机转速控制方案 由上可得电机直流调速系统往往以调压调速为主,电压可采用模拟电路实现.即通过改变电路中的电阻可得到可连续变化的可调电压;也可通过数字电路实现,即通过PWM波来实现。模拟电路法功耗大，且对于精确控制来说非常困难。固一般均采用PWM驱动法。 PWM驱动原理是就是直流斩波原理，利用大功率晶体管的开关特性来调制固定电压的直流电源。按一个固定的频率来接通和关断，并根据需要改变一个周期内“接通”和“断开”时间的长短，通过改变直流电动机电枢上的占空比来改变平均电压的大小，从而控制电机的转速。因此，这种装置又称为“开关驱动装置”。PWM输出波形如图1.3所示，周期为T，一个周期内的导通时间为t，则加在电机两端的平均电压为： (3-2) 其中，= t /T称为占空比，为电源电压。 图3.7 PWM原理图直流电机的转速与电机两端电压成正比，而电机两端的平均电压与控制波形的占空比成正比，占空比越大，电机转得越快，当占空比为1时，加在电机两端的平均电压最大，电机转速也就最大。3.6 电机驱动电路 单片机虽然可以输出PWM波，但其输出功率太小，无法满足电机工作的需求，固要有功率放大器，一般功率放大器都是有MOS管或IGBT来放大，而这些分立元件组合起来就是一个完整的功率放大器。现代电子技术是朝着高度集成化方向发展的，由于这些功率放大器在生产生活中引用广泛，尤其是电机的普遍应用，所以市场上有专门的针对电机的功率放大芯片。本文选择的是智能功率芯片BTS7960。其资料如下：BTS7960是NovalithIC家族三个独立的芯片的一部分:一是p型通道的高电位场效应晶体管，二是一个n型通道的低电位场效应晶体管，结合一个驱动晶片,形成一个完全整合的高电流半桥。所有三个芯片是安装在一个共同的引线框,利用芯片对芯片和芯片芯片技术。电源开关应用垂直场效应管技术来确保最佳的阻态。由于p型通道的高电位开关，需要一个电荷泵消除电磁干扰。通过驱动集成技术，逻辑电平输入、电流取样诊断、转换速率调整器，失效发生时间、防止欠电压、过电流、短路结构轻易地连接到一个微处理器上。BTS7960可结合其他的BTS7960形成全桥和三相驱动结构。图框如下： 图3.8 BTS7960图框引脚的定义和功能 表3.3 BTS7960引脚的定义和功能以下是其驱动电机的应用实例： 图3.9 BTS7960驱动电机电路综上所述，我们可得出系统硬件的系统框图为 图3.10 系统硬件框图4 系统控制方案设计4. 1操纵杆设计 方案一：速度的给定由用户通过操纵杆来实现。操纵杆输出两路相互垂直的模拟信号，来实现控制轮椅运动的方向和速度，如图所示： 图4.1 操纵杆输出信号分解 在上图（a）中，操纵杆搬动的方向和倾斜的程度分解为和两路互相垂直的信号输出；在图（b）中，轮椅运动的方向V由X方向的速度分量和Y方向的速度分量适量合成。设左，右轮的转速分别为，则易知为两轮的差模分量，为两轮转速的共模分量。，按照下面的算法建立联系：式中,为X和Y方向的控制灵敏系数，,值越大，对相应通道的操纵杆输出信号的检测就越灵敏。通过适当配置,就能获得满意的操纵性能。是由速度挡设定的系数，速度挡越高，越大转速给定也就越大。依据上两式即可将用户给定的控制信号分别转化为左右两轮的给定速度。方案二：我们直接对电机进行控制，翻转电机只需一个开关，即可实现翻转电机的爬楼动作；行使电机则需要两个开关，一个控制左行使电机，一个控制右行使电机，当两个开关同时按下则实现直线行走，只开一个时实现转向，转速则通过单片机调节PWM波的占空比来实现无极调速。 方案一是目前市场上专用控制手柄采用的方案，其操纵简单，但成本相当高昂，且对硬件电路要求也非常高，需要提供相应的硬件接口与信号处理电路。实物图如下： 图4.2专用控制手柄实物图而方案二虽然操纵复杂点，但其成本较低廉，硬件易于实现，控制可靠，操作人员经过短时间的训练即可适应。固采用方案二，下图为控制开关分布图：图4.3 控制开关分布图 方案二要解决的一个突出问题即为双电机的同步实现，因为行使是要实现直线行使的，不能跑偏，更为重要的是爬楼梯时，必须两个电机转速相同，否则会产生危险，使安全性大大降低。下面将讲述双电机的同步控制方案。4. 2双电机同步控制方案目前存在的同步控制技术包括并行控制、主从控制、交叉耦合控制、虚拟总轴控制、偏差耦合控制。这里对并行控制和主从控制这两种基本的控制方式作一下简单的介绍和比较。4.2.1 并行控制 并行控制是一种基于同一定值控制的并联运行方式，这是一种最简单的同步控制方法。并行式适用于每个单独系统的控制目标基本一致的情况，要求伺服系统具有良好的速度稳定性。调速系统采用同一给定电压，其控制结构图如图4.4所示。采用并行运行方式的同步控制系统其优点在于启动和停止阶段系统的同步性能很好，但是由于整个系统相当于开环控制，当运行过程中某一台电机受到扰动时，电机之间将会产生同步偏差，同步性能较差。控制器电机1控制器电机2 图4.4 并行控制结构图4.2.2 主从控制主从控制是一种基于跟踪随动原理的串联运行方式。以双电机为例，主从同步控制系统的结构图如图1.2所示。在这种控制方式中，主电机的输出转速作为从电机的转速参考值。由此可推断，任何加在主电机上的速度命令或是负载扰动都会被从电机反映并且跟随，但是任何从电机上受到的扰动却不会反馈回给主电机，也不会影响到其他的从电机。主从式特点是从系统跟踪主系统的输出，大大增加了其控制策略的稳定性，但存在跟踪滞后。这种控制方式要求伺服系统具有良好的跟踪性能，主要应用在对速度或者位置的同步精度不是很高的工业生产中。控制器控制器电机1电机2 图4.5 主从控制结构图本系统设计的电机同步控制为了提高抗干扰能力，在一台电机速度受到外部扰动或人为干扰时两台电机仍能保持速度的同步，采用了带速度负反馈的主从式控制结构，因为其稳定性很好，这对爬楼轮椅是相当有利的，速度负反馈可以确保相应的控制精度。跟踪滞后问题可以通过pid算法和构建控制电路校正网络电路进行改进。5 轮椅车控制算法设计5.1 速度检测电路测速元件是闭环调速系统中的关键元件，为了扩大调速范围，改善电动机的低速平稳性，要求测速元件低速输出稳定，波纹小，线性度好。常用的测速元件有模拟式测速元件和数字式测速元件。模拟式测速元件通常采用测速发电机；数字式测速元件采用光电式脉冲发生器。数字测速元件具有低惯量低噪声高分辨率和高精度的特点，有利于控制直流电机。在现代驱动控制系统中，为了提高速度反馈检测精度，正在摒弃直流测速发电机加A/D转换器的方案，而采用光电码盘直接数字测速的方案。本系统采用增量式光电旋转编码器测量电机的速度。将光电编码器与电动机相连，当电动机转动时，带动码盘旋转，便发出相应的信号。光电编码器由光源，光电转盘，光敏元件和光电整形放大电路组成。光电转盘与被测轴连接，光源通过光电转盘的透光孔射到光敏元件上，当转盘转动时，光敏元件便发出与转速成正比的脉冲信号，为了判别电机的转向，光电编码器输出两路相隔90度电脉冲角度的正交脉冲。利用光电编码器进行数字测速的常用方法有两种：M法和T法。（1）M法测速：M法又叫定时计数法，是用计数器记取规定时间内光电编码器输出的脉冲个数来反映转速值，即在规定的时间间隔T内，测量编码器光栅所产生的脉冲数来获得被测的速度值。设编码器光栅每转一圈发出的脉冲数为Z，且在规定的时间T内，测得的脉冲数为M，则电机每分钟转数为：n=60M/ZT （5-1）将转速实际值和测量值之差与实际值之比定义为测量误差率，反映了测速方法的准确性，越小，准确度越高。M法测速误差率取决于编码器的制造精度，以及编码器输出脉冲前沿和测速时间采样脉冲前沿不齐所造成的误差等，最多可以产生一个脉冲的误差。因此，M法测速误差率的最大值为： （5-2）由上式可知，误差率与M成反比，即脉冲数越大，误差越小，故M法测速适用于高速段。（2）T法测速：T法又叫定数计时法，是用定时器记取光电编码器输出脉冲一个周期内的高频时基个数，然后取其倒数来反应速度值，即测量相邻两个脉冲的时间间隔来确定被测速度。设编码器光栅每转一圈发出的脉冲数为Z，定时器的时基是一已知频率为F的高频脉冲，定时器的起始和终止由编码器光栅脉冲的两个相邻脉冲的起始沿控制。若定时器的读数为M，则电机每分钟的转速为： （5-3）T法测速的误差产生原因与M法相仿，定时器的计数M最多存在一个脉冲的误差，因此，T法测速误差率的最大值为： （5-4）低速时，编码器相邻脉冲间隔时间长，测得的高频脉冲个数多，误差小，故T法适用于低速段。我们采用M法测速。所采用的光电编码器光栅每转一圈发出1000个脉冲。设电机工作在额定转速下，即n=500转/分，则在0.1秒的采样间隔内，计数器所应接受到的标准脉冲个数为M=500/60*0.1*1000=833个，可以看出，精度还是较高的。本设计中速度反馈回路的原理图下图所示。图5.1 速度反馈原理图5.2 PID控制方法5.2.1 PID控制方法介绍PID控制是迄今为止最通用的控制策略，有许多不同的方法以确定合适的控制器参数，根据现代理论的观点，PID调节器具有本质的鲁棒性、符合二次型最优控制选型原则、且具有智能化的专家特色。PID调节器及其改进型是在工业过程控制中最常见的控制器。PID控制是比例积分微分控制的简称，本身是一种基于对“过去”、“现在”和“未来”信息估计的控制算法，最早出现在模拟控制系统中，通过硬件（电子元件，气动和液压元件）来实现。控制器系统原理图如图5.2所示。现 在过 去未 来对 象 图5.2 模拟PID控制系统原理图PID的三种控制规律可以组成不同的线性控制器。在电力传动控制系统中，常采用的串联校正控制装置有比例微分（PD）控制器、比例积分（PI）控制器及比例积分微分（PID）控制器。由PD控制器构成的超前校正可以提高稳定裕度并获得足够的快速性，但稳态精度可能受到影响；由PI控制器构成的滞后校正，可以保证稳态精度，但快速性不佳；用PID控制器实现的滞后-超前校正兼有二者的优点，可以全面提高系统的控制性能。连续控制系统中的模拟PID控制规律为: （5-5）式中, u ( t ) 控制器的输出 e ( t ) 控制量的偏差 Kp 比例系数 Ti 积分时间常数 Td 微分时间常数(1) 比例环节比例环节对偏差是即时反应的，偏差一旦出现，调节器立即产生控制作用，使输出量朝减小偏差的方向变化，控制作用的强弱取决于比例系数Kp。比例调节器虽然简单快速，但对于系统响应为有限值的控制对象存在静差。加大比例系数Kp可以减小静差，但过大会使系统的动态质量变坏，引起输出量震荡,甚至导致系统不稳定。(2) 积分环节为了消除在比例调节中的残余静差，可在比例调节的基础上加入积分调节。积分调节具有累积成分，只要偏差e不为零，它将通过累积作用影响控制量u，从而减小偏差，直到偏差为零。如果积分时间常数Ti大，则积分作用弱，反之为强。增大Ti将减慢消除静差的过程，但可减小超调，提高稳定性。引入积分环节的代价是降低系统的快速性。 (3) 微分环节为了加快控制过程，有必要在偏差出现或变化的瞬间，按偏差变化的趋势进行控制，使偏差消灭在萌芽状态，这就是微分调节的原理。微分作用的加入将有助于减小超调，克服震荡，使系统趋于稳定，特别对高阶系统非常有利，它加快了系统的跟踪速度，但对噪声非常敏感，使用前需要对输入信号进行滤波。5.2.2 数字式增量PID控制算法计算机控制是一种采样控制，它只能根据采样时刻的偏差值计算控制量。因此，连续PID控制算法不能直接使用，需要采用离散化方法，根据采样时刻的偏差值计算控制量，离散化得： （5-6） 式中 k为采样序号，k=0,1,2,3 如果采样周期足够小，这种离散逼近相当精确。式中u（k）为全量输出，它对应于被控对象的执行机构第k次采样时刻应达到的位置。因此，上式称为PID位置型控制算式。可以看出，按PID位置型控制算式计算u(k)时，输出值与过去所有状态有关。当执行机构需要的不是控制量的绝对数值，而是其增量时(如步进电机的驱动)，可导出下式： （5-7） 其中， 此式称为增量型PID控制算式，增量型PID控制算式具有以下优点：1. 计算机只输出控制增量，即执行机构位置的变化部分，因而误动作影响小。2. 在k时刻的输出u(k)，只需要用到此时刻的偏差，及前两次的偏差和前一次的输出值，这大大节约了内存的计算时间。3. 在手动-自动切换时，控制量冲击小，能够较平滑地过渡。位置式控制算法可通过增量式控制算法推出递推计算公式： （5-8）这就是目前在计算机控制中广泛应用的数字递推PID控制算式。5.2.3 标准PID算法的改进 在实际过程中，控制变量因受到执行元件机械和物理性能的约束而限制在有限范围内，即Uminu=4选出CS1中最大最小值计算cesu1选出CS2中最大最小值计算cesu2将i清0，j置1开始中断返回 图7.2 测速子程序流程图7.2.3 控制程序PID控制算法是在控制程序中完成的。在控制程序中不断地以0.1秒的周期循环计算控制量，即主从电机PWM的占空比，通过改变占空比来调节电机的速度。其流程图如图7.4所示。j作为控制程序的循环标志，每当Timer4循环4次(计时0.1秒)时在T4中断中被置1，在控制程序中进入if语句执行一次控制算法，并被清0。下一次控制程序循环过来时if语句就不会再执行了，直到过了0.1秒后j再次被置1，这样就保证了0.1秒内只计算一次。在控制程序中，左电机的设定速度转化成的标准脉冲数减去其实测脉冲数，其结果作为当前时刻主电机的速度偏差值，从电机把主电机的实测脉冲数作为自己的设定速度值，用其减去从电机的实测脉冲数，结果作为其当前时刻的速度偏差值，以实现跟踪主电机。 改进的PID算法采用了遇限削弱积分法和积分分离法。主电机积分饱和的条件为：e13300或u1=255且e130， 即当左电机速度偏差达到300或主电机控制量已达到上限且偏差为正时，除去主电机控制算法中的积分项。从电机积分饱和的条件为：e23300或u2=255且e230，即当右电机速度偏差达到200或右电机控制量已达到上限且偏差为正时，除去从电机控制算法中的积分项。为了避免主从电机稳定情况下频繁地修改控制量并减小计算工作量，控制程序采用了带死区的控制算法，当主从电机的速度偏差满足以下条件|ei3|2且|ei3-ei2|300)|(u1=255)&(e130) k1=0; /判断主电机运算是否积分饱和 else k1=1; if(e23200)|(u2=255)&(e230) k2=0; /判断从电机运算是否积分饱和 else k2=1; if(e132)|(e132)|(e12-e132) /计算主电机控制量 A11=1+k1*T1/Ti1+Td1/T1; eu1=(A11*e13+A12*e12+A13*e11)*Kp1; u1+=eu1; if(u1255) u1=255; if(u1
- 温馨提示:
1: 本站所有资源如无特殊说明，都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
2: 本站的文档不包含任何第三方提供的附件图纸等，如果需要附件，请联系上传者。文件的所有权益归上传用户所有。
3.本站RAR压缩包中若带图纸，网页内容里面会有图纸预览，若没有图纸预览就没有图纸。
4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
5. 人人文库网仅提供信息存储空间，仅对用户上传内容的表现方式做保护处理，对用户上传分享的文档内容本身不做任何修改或编辑，并不能对任何下载内容负责。
6. 下载文件中如有侵权或不适当内容，请与我们联系，我们立即纠正。
7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
人人文库网所有资源均是用户自行上传分享，仅供网友学习交流，未经上传用户书面授权，请勿作他用。
川公网安备: 51019002004831号