关 键 词：

自动 爬梯 轮椅

资源描述：

自动爬梯轮椅,自动,爬梯,轮椅

内容简介：

BTS7960智能功率芯片中文资料The BTS7960 is part of the NovalithIC family containing three separate chips in one package: One p-channel highside MOSFET and one n-channel lowside MOSFET together with a driver IC, forming a fully integrated high current half-bridge. All three chips are mounted on one common leadframe, using the chip on chip and chip by chip technology. The power switches utilize vertical MOS technologies to ensure optimum on state resistance. Due to the p-channel highside switch the need for a charge pump is eliminated thus minimizing EMI. Interfacing to a microcontroller is made easy by the integrated driver IC which features logic level inputs, diagnosis with current sense, slew rate adjustment, dead time generation and protection against overtemperature, overvoltage, undervoltage, overcurrent and short circuit. The BTS7960 can be combined with other BTS7960 to form H-bridge and 3-phase drive configurations.BTS7960是NovalithIC家族三个独立的芯片的一部分:一是p型通道的高电位场效应晶体管，二是一个n型通道的低电位场效应晶体管，结合一个驱动晶片,形成一个完全整合的高电流半桥。所有三个芯片是安装在一个共同的引线框,利用芯片对芯片和芯片芯片技术。电源开关应用垂直场效应管技术来确保最佳的阻态。由于p型通道的高电位开关，需要一个电荷泵消除电磁干扰。通过驱动集成技术，逻辑电平输入、电流取样诊断、转换速率调整器，失效发生时间、防止欠电压、过电流、短路结构轻易地连接到一个微处理器上。BTS7960可结合其他的BTS7960形成全桥和三相驱动结构。图框如下： 下图显示使用的数据表2引脚结构2.1引脚分配上视图是BTS 7960B and BTS 7960P的引脚结构引脚的定义和功能引脚的定义和功能PINSYMBOLI/O功能1GND-接地2INI输入，高电位开关、低电位开关是否开启决定3INHI抑制，当设定为低电平进入睡眠状态4，8OUTO功率输出5SRI转换速率功率开关的转换速率通过SR和GND间连接的电阻调整6ISO电流取样诊断7VS-电源应用事例下图是智能功率芯片BTS7960是应用于电机驱动的大电流半桥高集成芯片上图是正常模式和故障模式下电流检测智能功率芯片BTS7960是应用于电机驱动的大电流半桥高集成芯片，它带有一个P沟道的高边MOSFET、一个N沟道的低边 MOSFET和一个驱动 Ic，如图 1所示。集成的驱动Ic具有逻辑电平输入、电流诊断、斜率调节、死区时间产生和过温、过压、欠压、过流及短路保护的功能。BTS7960通态电阻典型值为 16mQ，驱动电流可达 43A。智能功率芯片BTS7960是应用于电机驱动的大电流半桥高集成芯片，它带有一个P沟道的高边MOSFET、一个N沟道的低边 MOSFET和一个驱动 Ic，如图 1所示。集成的驱动Ic具有逻辑电平输入、电流诊断、斜率调节、死区时间产生和过温、过压、欠压、过流及短路保护的功能。BTS7960通态电阻典型值为 16mQ，驱动电流可达 43A。BTS7960的引脚Is具有电流检测功能，正常模式下，从Is引脚流出的电流与流经高边 MOS管的电流成正比，若RIS=lkQ，则 VIS=Iload85；在故障条件下，从 Is引脚流出的电流等于IIS(1im)(约45mA)，最后的效果是 Is为高电平。如图3所示 ，图3(a)为正常模式下Is引脚电流输出，图3(b)为故障条件下IS引脚上的电流输出。DG-M4系列电动机构说 明 书兰州万里航空机电有限责任公司目 录1. 介绍.12. 产品组成.13. 技术要求和机械特性.24. 安装.4 4.1固定.4 4.2连接和布线.5 4.3测试.75. 离合器操作.76. 维修和服务.7 6.1电动机碳刷更换.8 6.2离合器摩擦片更换107. 指定用途.118. 安全和不当使用警告.119. 担保.1210. 销售和服务.121. 介绍本手册为DG-M4系列电动机构提供安装和维护信息。本手册应结合控制系统所有其它元器件的安装说明书仔细阅读；安装前必须完全理解。更多信息，请联系兰州万里航空机电有限责任公司。兰州万里航空机电有限责任公司欢迎客户对自己产品及资料的反馈; 如果对该手册或其所描述产品有什么建议或意见，请通过邮件18919899949189.CN联系。2. 产品组成DG-M4系列电动机构专为电动轮椅车而设计。该电动机构由一个带电磁离合器（刹车）装置的永磁电动机和带一级直齿和一级蜗轮副传动的全封闭齿轮箱组成；手推轮椅时，可以通过简易操作手柄释放花键来实现离合。13. 技术要求和机械特性电机类型永磁直流电动机，直流24V离合器类型电磁离合器，直流24V空载电流最大3.3A连续电流8.0A最大输出功率65R/M时230W持续扭矩1.1Nm/A最大扭矩使用40A控制器时44Nm使用50A控制器时55Nm离合器制动扭矩输出轴，大于50Nm输出轴空载转速正常120RPM减速比i32.88绝缘等级F重量5.5kg电机壳体颜色黑色推荐轮子尺寸31.75cm (12.5)基本尺寸见图纸输出轴接口尺寸如下：2DG-M4 系列电动机构（左）总体布置和主要尺寸 (所有尺寸单位均为毫米) 如下:34. 安装为确保安全操作，DG-M4系列电动机构结合相应的控制器使用于电动轮椅车。该电动机构必须成对使用于电动轮椅车。安装电动机构需遵循以下步骤：固定连接和布线测试4.1 固定固定电动机构有一套办法。不管有什么固定方法，电动机构必须水平固定。最常用的办法见下图：将电动机构固定于车架，需按如下顺序进行操作：松开螺钉，固定电动机构于车架。注意不同固定位置使用不同长度的螺钉。轻轻松开齿轮箱上离合器手柄端的螺钉（序号、）。按指示顺序上紧螺钉，确保施加在衬垫上的压力适中。4注意不同位置使用不同长度的螺钉。确保电动机构安全紧固、轮轴精确结合。所有可选择的固定办法必须经过轮椅生产厂家测试和证实，以确保其符合有关标准。结构固定如下：4.2 连接和布线每台电动机构有连接电动机和电磁离合器的的四根电线。注意红色和蓝色电线连接反映电动机构不同的的转动方向。参照图表如下，以确保电动机构成对工作。5 注意：电动机构极性颠倒、左右电动机构交换完全由控制器程序决定。不过电缆必须以一种方式固定，即左右电动机构的连接不能交换。 电线颜色电线尺寸及插件等级车轮转向（从轮轴方向看）左电动机构右电动机构离合器红色接到蓝色接到红色接到蓝色接到黑色2.5mm2.5mm0.5mm持续10A或更高持续10A或更高持续0.5A或更高逆时针顺时针可使用不同接插件，但必须根据相应用途、电线尺寸和电流要求6来选择。考虑兼容性因素，左右电动机构接插件应是一样的。为了降低互换接插件的风险，推荐使用有极性接插件。4.3 测试当电动机构和控制器系统安装结束时，可以接受检测。检测时，应注意以下各点：电路中必须包括电路断路器：车轮抬离地面。检查电源，不要弄弯电线。检查电压，使用万用表。5 离合手柄操作希望手推轮椅车时，只需脱开花健，转动电动机构上的手柄即可。6 维修和服务DG-M4系列电动机构是一种低维修电动机构，且无须定期检测。在正常条件下不需要进一步的维修；在任何维修过程中都应断开蓄电池，事实上将他们从轮椅上完全移除是有利于维修的。有规则地检查系统。检查松动、损坏或腐蚀的接插件和接头。更换损坏的电线。检查电动机构的固定情况。用湿布清洁电动机构和控制系统元器件。取掉罩子，检查碳刷长度，其应大于10mm。7检查密封圈、输出轴和离合器手柄周围油膏的渗漏情况。对显示外部有碰撞的电动机构或轮椅车的损坏进行检查。检查电动机构是否有增大的间隙或活动、过大的噪音或其它（如：显示过大的齿轮磨损）。 警告：如果有任何损坏或过大的磨损显示，如：箱体损坏、噪音过大、油膏渗漏、间隙或活动增大、异常反应、发热、冒烟或弯曲，请不要使用电动机构。确保电动机构安全紧固在车架上、车轮安全紧固在电动机构上。 6.1 电机碳刷更换每台电动机构包括两个碳刷，在超寿命使用时根据需要可更换电刷。碳刷更换是一个简单的操作：断开电动机构。移开端盖，进行更换。移开固定碳刷电线的螺钉。由于所含磁铁使得移开螺钉相当困难，不要让螺钉掉进电动机构很重要。用一个小勾作为工具抑制弹簧、拉出碳刷。检查换向器是否过度磨损、异常灼烧或有腐蚀痕迹。倒着按上述步骤，安装新的碳刷，确保碳刷在其轨道可滑行。确保弹簧正确置于碳刷，且按照图纸摆放碳刷电线。 注意：碳刷电线不得接触铝刷架。确保电动机构壳体和电动机构电线之间的正确绝缘。 两台电动机构的所有碳刷需同时更换。8更换新碳刷后需要半速向前运行轮椅车12小时，确保电动机正常工作。电动机碳刷更换如下：96.2 离合器摩擦片更换每套离合器组件包括一个需要更换的摩擦片。不足的刹车制动能力显示摩擦片需要更换。作为选择之一，整个离合器组件也可以被替换。断开电动机构。移开端盖，可以更换。移开固定刹车组件到刹车架的螺钉。避免电线过分雨淋。将固定刹车组件的螺钉一起移开。倒着按上述步骤，安装新的摩擦片，确保刹车组件固定到刹车架。检查刹车啮合和释放的电压。8V刹车啮合电压16V。在最小电压1.5V时，刹车必须顺利释放。刹车钢盘和线圈机架之间的间隙过大，将使得刹车啮合电压过高。移除一些薄垫圈，可降低刹车啮合电压。检查刹车释放情况下电枢的自由转动。 注意：不要依赖咔哒声；因为刹车钢盘和线圈机架之间的间隙不均匀时可以听到咔哒声，但刹车可能只是部分释放。 两台电动机构的所有摩擦片需同时更换。检查所有部件正确定位后，方可更换盖子。刹车摩擦片更换如下：107 指定用途DG-M4 系列电动机构是指定用于电动轮椅车的直流24V永磁电动机构。该电动机构包括一套完整的刹车，且指定与轮椅控制器、相应过载保护元器件一同使用。8 安全和不当使用警告11所有警告必须进行阅读和理解。警告适用于可能导致人身伤害或财产损失的不安全行为。如有怀疑，请寻求建议。电动机构不得按本手册中描述之外的方法进行使用，否则可能发生伤害或损失。电动机构满足淋浴和雾气保护IP54；然而其不适合在有水地面驱动。如果行为不规律或显示有异常反应（如：发热、冒烟或弯曲），不得操作设备且立即关掉设备、咨询服务中心。如果显示有异常噪音、过大间隙或其它损坏，不得操作设备且立即关掉设备、咨询服务中心。9 担保兰州万里航空机电有限责任公司所提供DG-M4系列电动机构由公司担保无材料或工艺问题。如果在担保期内发现故障，公司将负责维修或（凭判断）无材料和手工费用替换。担保条款如下：正确安装。按照本手册单独使用。按照本手册正确连接到合适的电源。不得有误用、意外或未授权人员更改或修理情况。按照轮椅车生产厂家推荐，单独用于电动轮椅车驱动。10 销售和服务兰州万里航空机电有限责任公司在中国兰州有销售和服务中心。需要销售或服务可以直接联系，我们的网址为、. cn12P0.1(EXT)P0.0(RXT)+0.5VP1.2P1.3P0.2EN1P2.1P0.3EN2P2.1P0.2P2.1P0.3P2.1EN0P0.5P0.4RSTP0.5P0.4X1CRYSTALC110pFC210pFJIANJIAFANGXIANG MOSHI P2.1P2.4P3.6P3.7U5NOTU4NOTEN0EN1EN2VI1VO3GND2U67805VI2VO3GND1U7HZD05B- 12S03C41nFC51nFC61nFC71nFR310kR410k+24V+24VD1DIODED2DIODE5V3.3VR5R6R7R8R9R10R11R12C8C9VSOUTGNDINHINISSRINHINISSRVSOUTGNDBTS 7960BTS 7960C8051FO20TMS1TCK2TDI3TDO4RST5CP1-6CP1+7CP0-8CP0+9AGND10AV+11VREF12AGND13AV+14VREFD15VREF016VREF117ADN0.018ADN0.119ADN0.220ADN0.321ADN0.422ADN0.523ADN0.624ADN0.725XTAL126XTAL227MONEN28AIN1.7/A15/P1.729AIN1.6/A14/P1.630AIN1.5/A113/P1.531AIN1.4/A112/P1.432AIN1.3/A111/P1.333AIN1.2/A110/P1.234AIN1.1/A19/P1.135AIN1.0/A18/P1.036VDD37DGND38A15m/A7/P2.739A14m/A6/P2.640A13m/A5/P2.541A12m/A4/P2.442A11m/A3/P2.343A10m/A2/P2.244A9m/A1/P2.145A8m/A0/P2.046AD7/D7/P3.747AD6/D6/P3.648AD5/D5/P3.549AD4/D4/P3.450AD3/D3/P3.351AD2/D2/P3.252AD1/D1/P3.153AD0/D0/P3.054WR/P0.755RD/P0,656ALE/P0.557P0.458P0.359P0.260P0.161P0.262DGND63VDD64AD7/D7/P7.765AD6/D6/P7.666AD5/D5/P7.567AD4/D4/P7.468AD3/D3/P7.369AD2/D2/P7.270AD1/D1/P7.171AD0/D0/P7.072A15m/A7/P6.773A14m/A6/P6.674A13m/A5/P6.575A12m/A4/P6.476A11m/A3/P6.377A10m/A2/P6.278A9m/A1/P6.179A8m/A0/P6.080A15/P5.781A14/P5.6882A13/P5.583A12/P5.484A11/P5.385A10/P5.286A9/P5.187A8/P5.088DGND89WR/P4.791RD/P4.692ALE/P4.593P4.494P4.395P4.296DAC199DAC0100VDD90P4.098P4.197C101nFC111nF3.3vTSMTCKTDITDO+3.3VGNDJTAGT1IN11R1OUT12T2IN10R2OUT9T1OUT14R1IN13T2OUT7R2IN8C2+4C2-5C1+1C1-3VS+2VS-6U8MAX232C121nFC131nFC310pFR1200kR21k+3.3VSCL6SDA5WP7A12A01A23U10AT24C512B+5VC141nFR13R14R15R16R17R18R19R20C15C19VSOUTGNDINHINISSRINHINISSRVSOUTGNDBTS 7960BTS 7960R23R24R25R26R27R28R29R30C20C21VSOUTGNDINHINISSRINHINISSRVSOUTGNDBTS 7960BTS 7960R31R32R33R34R35R36R37R38C22C23VSOUTGNDINHINISSRINHINISSRVSOUTGNDBTS 7960BTS 7960VABCVABC12345678R39R40R41R42R43R44+5V+3.3VVABCVABC12345678R39R40R41R42R43R44+5V+3.3VP h o t o e l e c t r i c e n c o d e rP h o t o e l e c t r i c e n c o d e rp h o t o e l e c t r i c c o u p l e rP h o t o e l e c t r i c e n c o d e rP h o t o e l e c t r i c e n c o d e rp h o t o e l e c t r i c c o u p l e r南昌航空大学学士学位论文目录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操控基地C8051F020 233.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年美国研发的爬楼梯轮椅。此后各国纷乱初步投入此项研讨，其间美国、英国、德国和日本占主导方位，技能相对比较老练，且有一些商品己经投入商场运用。 国内的讨论也在近一、二十年内得到了明显的用途，近些年关于品牌的不足为奇，现在国内外该有的爬楼梯配置和品牌类型有很多，不同的爬楼梯配置适合于不同的处境，条件有好有坏。根据爬楼梯配置，实行组织的种类关键可归纳为轮组式、履带式、腿式三大类。1.2.1轮组式轮组式的特点是每个轮组根据星形轮的方式间隔运动：平地奔波时，各小轮围绕自己的轴线自动旋转；爬楼梯时，各小轮一起围绕基地轴公用旋转。美国发明家研发的IBOT是一种能自主调节平衡的两轮模式轮椅，是单轮组爬装置中最具有意义性的爬楼装配之一。IBOT不单单采用了比普通轮椅复杂的驱动构造，并且设置了很多个感知人 轮椅平衡位置的陀螺仪，控制器按照陀螺仪的信息调节平衡的位置，让轮椅可以在不同的路面和直立状况下维持平衡。IBOT己经得到了FDA赞同并且在欧美发行，价格适合于中高档汽车的价格。如下图所示:图1.1 ibot实物图内蒙古民族大学与机电大学的苏战役等人创造了IBOT的爬楼方式，采用星形轮椅当做爬楼梯模式，策划了一种双联星形模式电动爬楼梯轮椅。普通的轮椅爬楼时必须要人工帮忙或者采用楼梯扶手的帮助来支持，这个轮椅可以能调节平衡的位置，安全爬楼。如下图1-2 和1-3所示图1-2双联星形轮椅图图1-3双联星形轮椅改良图图1.4 双联行星轮内部传送图1.2.2履带式履带式爬楼梯装配的道理相似于履带装运坦克，技术比较熟练，使用简便，行走时平衡不坚定不大，对楼梯的外部、尺寸适用性强。英国公司研发的一种电动轮椅车，轮椅下面是履带式的传动构造，可爬最大斜度为35 度的楼梯，上下楼梯速率是每一分钟15-20个台阶。法国公司消耗的电动爬楼梯轮椅，它的下面有四个车轮供应一般状况下路面的运用，当碰到楼梯或者特别的路面时，用户经过适当调整把两侧的橡胶履带缓慢放下到空中，其次把这四个车轮收起来，依靠履带不需要旁人帮忙就可以主动完成爬楼等作用。如图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.1DG-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操控基地C8051FO203.4.1C8051FO20概述 C8051FO20一系列单片机是Cygnal公司首要推展的一种合体信号系统级单片机。这个系列的单片机内含有CIP-51的CPU内存，它的命令系统与MCS-51完整无缺。其中的C8051F020单片机内含64kB片程序储备器，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.5C8051FO20外形及引脚摆放图3.6C8051FO20内部逻辑图3.4.2首要功能参数 C8051F020系列单片机是集中在一块芯片上的合体信号系统级单片机。芯片上有64位数字I/O接口或32位数字I/O接口。 作为全部体系的操控部件，它具有以下特性10,14： l迅速、流水线构造的8051兼并的CIP-51内存（可达到25MIPS）； l全速、非侵入式的在体系调试接口（片内）； l12位、100ksps的8通道ADC，带PGA和仿照多路开关； l8位、500ksps的ADC，带PGA和8通道仿照多路开关； l两个12位DAC，具有可编程数据更新方法； l64KB可在体系编程的Flash存储器； l4352（4096+256）B的片内RAM； l可寻址64KB地址空间的外部数据存储器接口； l硬件完结的SPI、SMBus/IIC和两个UART串行接口； l5个通用的16位守时器； l具有5个捕捉/比较模块的可编程计数器/守时器阵列； l片内看门狗守时器、VDD监视器和温度传感器； l两种可以设备编辑的电源治理方案空位方案和停电方案； lC8051F020生产压力为2.7V-3.6V，接口I/O、/RST和JTAG引脚都允许5V的输入信息压力； l64个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可分别满足桥和三相运动构造图框如下：图3.8BTS7960图框引脚的界说和功用表3.3BTS7960引脚的界说和功用以下是其驱动电机的使用实例：图3.9BTS7960驱动电机电路综上所述，咱们可得出体系硬件的体系框图为图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所表示。选用并行作业方法的同步操控体系其长处在于发动和间断阶段体系的同步功能极好，可是因为全部体系适当于开环操控，当作业进程中某一台电机遭到扰动时，电机之间将会发生同步倾向，同步功能较差。图4.4 并行操控结构图4.2.2主从操控 主从操控是一种根据盯梢随动原理的串联作业方法。根据双电机为例子，关键从同步操作系统的构造图如图1.2所表示。 在这种操作方案中，主电机的输出转动速度当做从电机的转动速度参考值。由此可以判断，所有增加在主电机上的速率命令或是负荷打扰都会被电机反馈并且随从，但是所有从电机上遇到的打扰却不会反馈回给主电机，也不会导致别的从电机。 主从式特性是从体系盯梢主体系的输出，大大添加了其操控战略的安稳性，但存在盯梢滞后。这种操控方法恳求伺服体系具有杰出的盯梢功能，首先运用在对速率或别的位置同步密度不是很高的产业消费中。图4.5 主从操控结构图 本体系规划的电机同步操控为了前进抗搅扰才华，在一台电机速度遭到外部扰动或人为搅扰时两台电机仍能坚持速度的同步，选用了带速度负反响的主从式操控结构，因为其安稳性极好，所以这对爬楼轮椅是特别有用的，速度负反应可以保证对应的操作密度。盯梢滞后疑问可以通过pid算法和构建操控电路校对网络电路间断改进。5轮椅车操控算法规划5.1 速度检查电路 测速零件是关闭调节系统中的危害零件，为了发展调节范围，改变电动机的低速稳定性，要求测速零件低速输出平稳，波纹小，线性度好。常用的测速零件有模仿式测速零件和数字式测速零件。模仿式测速零件通常采用测量速度发电机；数字式测速零件采用光电式冲击发电器。数字测速零件具备低惯性低杂音高判断率和高密度的特点，有助于操作直流电机。在如今的驱动操作系统中，为了增进速度反馈检测密度，正准备放弃直流测速发电机加A/D转换器的方法，来采用光电码盘直接数字测量速度的方法。 本系统采用增加式光电转动编辑器测试电机的速率。把光电编辑器与电动机结合，当电动机翻转时，编辑码回转动，并且宣布对应的信息。光电编辑器由光源，光电磁盘，光敏零件和光电整体加大电路组成。光电磁盘与被测量的轴连接，光源经过光电磁盘的透光孔照射到光敏零件上，当磁盘翻转时，光敏零件便宣告与转动速度成正比的冲击信息，为了分开电机的转动位置，光电编辑器输出两路隔开90度电脉冲视点的正交冲击。 运用光电编辑器切断数字测量速度的常用方案有两个：M方案和T方案。 （1）M法测速：M法又名守时计数法，是运用计算器记录规定时间内光电编辑器输出的冲击个数来反馈转动值，就是在规定的时间隔开T内，测试编辑器光栅所产生的冲击数来获取被测的速率值。设定编辑器光栅每转动一圈宣告的冲击数为Z，并且在规定的时间T内，测量出的冲击数为M，则电机每分钟转动数为：n=60M/ZT 将转速实习值和测量值之差与实习值之比界说为测量差错率，反映了测速方法的精确性，越小精确度越高。M法测量速度的差距率决定于编辑器的制作密度和编辑器输出冲击前沿和测量速度时间采取冲击前沿不齐所导致的差距等，顶多可以发生一个冲击的差距。所以M法测量速度的差距率的最大值为： 由上式可知，差错率与M成反比，即脉冲数越大，差错越小，故M法测速适用于高速段。 （2）T法测量速度：T法又名定位计算法，是采用定时器记录光电编辑器输出冲击一个周期内的高频率基数，然后取其倒数来反响速度值，即测量相邻两个脉冲的时刻间隔来必定被测速度。设置编辑器的光栅每转动一圈宣告的冲击数为Z，定时器的时基是已知道的频率为F的高频冲击，定时器的开始和切断由编辑器光栅冲击的两个相应冲击的开始沿操作。如果定时器的码数为M，则电机每分钟的转动速度为： T法测量速度的差距产生因素与M法相同，守时器的计数M最多存在一个脉冲的差错，因此T法测速差错率的最大值为： 减速时编辑器相对冲击隔开时间长，测量的高频冲击数量多，差距小，所以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操控规律为:式中u ( t ) 操控器的输出e( t ) 操控量的倾向Kp 份额系数Ti 积分时刻常数Td 微分时刻常数 (1)份额环节 份额环节对倾向是即时反响的，倾向一旦出现，调度器马上发生操控造用，使输出量朝减小倾向的方向改变，操作选用的强弱决定于额定参数Kp。份额调度器当然简略迅速，但对于体系呼应为有限值的操控目标存在静差。增加额定参数Kp可以降低静差，但是过大又会让系统的动态质量变差，引起输出量振动,以导致系统的不安全。 (2)积分环节 为了消弭在份额调度中的剩下静差，可在份额调度的基础上参与积分调度。积分调节具有积分成果，只需要转向e不为零，它就可以经过积累的效果反应操作量u，然后降低转向，直到转向为零。如果积分时间数据Ti大，所以积分效果弱，反之就很强。增大Ti将减缓消弭静差的程序，但可降低超调，增加平稳性。推进积分步骤的价值是下降系统的快速性。(3) 微分环节 为了加快操控进程，有必要在倾向出现或改变的瞬间，按倾向改变的趋向间断操控，使倾向消除在萌芽情况，这即是微分调度的原理。微分效果的参加将有利于降低超调，控制振动，使系统处于平稳，格外对高阶体系十分有利，它加快了体系的盯梢速度，但对噪声十分灵敏，运用前需要对输入信号间断滤波。5.2.2 数字式增量PID操控算法 计算机操作是一种取样操作，它只有按照取样时间的转向值来计算操作量。所以连接PID操作方法不能直接使用，必须要采用分离化方案，按照取样时间的转向值来计算操作量，分离化得： 式中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算法的改进 在实习进程中，操控变量因遭到履行元件机械和物理功能的约束而约束在有限规模内，即Uminuumax，假设由核算机给出的操控量u在上述规模内，那么操控可以按预期的成果间断。一旦超过上面的范围，比如超出最大阀门开度或走进履行零件的充足区，那么实习履行的操控量就不再是核算值，由此将惹起不期望的效应，这类反应通常称为充足反应。这类现象在给定值发生骤变时格外简略发生，所以有时也称为发动效应。下面我们来判断这类反应在pid计算法中带来的问题及控制的方法： 若给定值w从0骤变到w0，且根据PID方位算法算出的操控量超出约束规模，那么实践上的操作量只能取上面值Umax，而不是计算值。此刻体系输出y虽不时上升，但因为操控量遭到约束,其添加要比没有约束时慢。倾向e将比正常情况下继续更长的时刻坚持在正值，而使PID方法计算中的积分项目有比较大的积累值。当输出逾越给定值w0后，初步出现负倾向，但因为积分项的累积值很大，还要通过适当一段时刻后操控变量u才华脱离饱满区，这么，就使体系出现了显着的超调。 明显在PID方位算法中“饱满作用”首要是由积分项惹起的，故称为”积分饱满”。抑制积分饱满的方法有： 1.遇到限制减弱积分法。这一次计算法的目的思路是：一经操作变量进入满足区，就只有实行减弱积分项目的计算而切断增加积分项目的计算。仔细的说在计算ui时，将区分上一时辰的操控量ui-1能否已超出约束规模，如果已经超出，那么就把按照转向的信号区分系统输出可不可以在调节范围，由此决定可不可以把相对的转向算入积分项目。 2.积分别离法。减小积分饱满的要害在于不能使积分项累积过大。上面的方法是一初步就积分，但进入约束规模后即间断累积。积分分离法与它相反，它在开始时不积分，直到转向达到预定阀值后才可以切断积分累积。这么，一方面避免一初步有过大的操控量，另一方面即使进入饱满后，由于积分累积小，而且也可以迅速退出，减弱了超调。5.2.4 搅扰的遏止 PID操作计算方法的输入量是转向e，也就是设定值与系统输出的值。在进入正常调度后，因为输出已挨近给定，e的值不会太大。所以相对而言，搅扰对调度有较大的影响，除了从体系硬件及环境方面采纳方法外，在操控算法上也可采纳必定的方法，以遏止搅扰的影响。 对于作用时刻较为时刻短的迅速搅扰，例如采样器，A/D改换器的偶然犯错等，咱们可以简略地选用接连多次采样求均匀值的方法予以滤除。如果围绕着取样时间ti接连取样N次，可得到ei1、ei2、eiN。因为迅速搅扰常常比较剧烈，只需有一个采样数据遭到迅速随机搅扰，即使对它们求均匀值，搅扰的影响也会反映出来。因此，应除掉其间的最大最小值，对别的的N-2次采样求均匀值。因为在N次中接连偶然犯错的也许很小，故这么做已足以消弭这类迅速随机搅扰的影响。5.2.5 PID调度器的参数整定PID调度器的规划一般来说可分为两个部分，首要是挑选调度器的结构，以确保闭环体系的安稳，并尽也许消弭稳态差错。如过要求系统稳定差距为零，就应该选择包含积分步骤的调节器如PI，PID等。对于有滞后性质的目标，常常引进微分环节等。别的，根据目标和对操控功能的恳求，还可选用一些改进的PID算法。一旦调度器的结构必定下来，下一步的使命即是调度器参数的整定。采样周期的选定。间断数字PID操控器参数整守时，首要应当处理的一个疑问是必定合理的采样周期T。采样周期T必需满足短，才华确保有满足的精度。但采样周期短则会加剧核算机的使命，影响作业效率，因此应合理挑选采样周期。 取样周期T应该足足小于系统中其它的时间常数，不然也许会因为采样的频带宽度不行而无法反映体系的动态进程。通常来说取样周期T的最大值受系统平稳性要求和香农取样理论的限制而不能太大。T的最小值则遭到核算机在一个采样周期内能完结的核算作业量的约束，实践中常常可以选2PAI/T为系统有用信息最高功率的410倍。系统的设定功率比较高时，取样周期T相对减弱，以让设定的变化得反馈。取样周期还可以根据所采用的操作计算方法和实行组织的类别相关。当选用数字PID操控算法时，积分作用和微分作用都与采样周期有关。挑选T太小时，e（k）改变就很小，积分和微分作用将都不显着。此外，一般履行组织惯性较大，采样周期T应能与之相适应。假设体系的搅扰是高频的，则要恰当的挑选采样周期，使得搅扰信号的频率处入采样器频带以外，然后使体系具有满足的抗搅扰才华。假设搅扰是频率已知低频搅扰，为了可以选用滤波的方法打扫搅扰信号，采样频率应当与搅扰信号的频率成整数倍的联系。 PID参数的整定 取样周期T通常足足小于系统的时间差距，所以PID参数的整定可以按仿照调度器的方法来间断。参数整定一般有两种：理论规划法和试验必定法。前者首先必须要有被掌控标准的精密模型，然后采用最简单的方式设定PID的各个数据。被掌控标准的模型可以经过物理模型或系统识别方式得到，但是这样通常只能得到相似的造型。所以通过试验必定法（如试凑法，工程整定法）来挑选PID参数是常常选用又行之有效的方法。本方法采用了试验法。试验前首先要知道PID各个调节数据对系统反应的变化。 试凑法是通过核算机仿真或实习作业，检查系统对普通输入效果的呼应曲线，按照各个调节数据（Kp，Ti，Td）对系统的变化，反复调节试验，一直到满足为止然后设定PID数据。 增大份额系数Kp将加快体系呼应并减小体系稳态差错，但过大会发生较大的超调量，发生震动，破坏体系的安稳性。增大积分时刻常数Ti可使减小超调，前进体系安稳性，但体系差错的消弭将随之变慢。 增大微分时间差距Td可加速系统的反应，使超出量降低，增加系统的平稳性，但是系统的抗扰能力下降。 试凑时可参阅以上参数对操控体系功能的影响趋向，实施先份额，后积分，再微分的重复调整。 （1）首先只调节额外参数，把Kp由小到大，让反应曲线稍有超出。此刻体系若无稳态差错或稳态差错已小到规范内，并且认定反应曲线属于合格，那么只需要用额外调节器就可以。 （2）若在份额调度的基础上，体系稳态差错太大，则必需参与积分环节。整守时先将第一步所整定的份额系数略为削减（如0.8倍），再将积分时刻常数Ti置为一较大值并接连减小，使得在坚持杰出动态功能的前提下消弭稳态差错。这一步可重复间断。 （3）若运用PI调度器消弭了稳态差错，但是系统动态反应经过反复调节后还是不能让人满足，就可以参加微分步骤，组成PID控制器。在整守时先将微分时刻常数Td设定为零，再逐步添加Td并一起间断前面两步的调整，以获得满意的调度作用和操控参数。需要指出PID调度器的参数对操控体系功能的影响一般并不十分灵敏，数据设定结果可以不统一。6轮椅车操控模块的数学模型 对于双电机同步驱动操控在负载发生扰动时同步操控功能较差的疑问，创建了两台直流电动机同步操作系统的数学模型。首要处理的疑问是对两台直流电动机同步操控体系结构图间断分析，画出结构框图，算出传送函数，对于国度标准有着严峻恳求的操控器标准，由此可以对其间止校对，构建校对网络电路，然后使得体系可以得到较好的功能指标。可有效处理操控体系迅速性战役稳性的对立，使体系具有更高的同步操控精度。这篇文章仅仅创建轮椅车操作模式的数学模型，对于操控器的优化疑问已是抱负的花费实习疑问不在这篇文章研讨规模内，故没有间断论述。 本方法是一个双直流电机同步传动操作系统。主电机转动速度由操作者经过加减速按钮直接设定，然而从电机对其终止和跟着同步翻转，咱们只需通过操控器调整加于从电机上的pwm波来操控从电机。在该体系中，直流电机的转速由测速传感器间断改换，按照电源直接系统供应输入量，并且经过操作器和传动电路之后，当做电机的传动信息以传动电机加工，再经过两个测量感应器的差距对系统不断反应，当测速传感器的差值不等于零时，通过反响间断调度。如果差距为零，那么就坚持电机生产。6.1体系作业方框图图6.1体系作业方框图6.2体系作业原理 在设定电压输入下，电机1在操作器1以及驱动电路1的反应下首先作业，操作器1将设定转动速度转变为信息使传动电路反应直流电机，使之抵达预定转速。同样的直流电机2在操作器2以及传动电路2的用途下生产，测量速度感应器2把电机1的速率参数与电机1测量速度感应器测量得的速度参数切断对比，把电机1和电机2的速度差距当做反应系统的输入量，通过调度使电机1和电机2完结同步操控的意图。6.3建立数学模型（1）操控器图6.2 操控器电路图可得式中 本方案的操控器，承当着对输入信号间断操控的使命，除了对搅扰信号的肃清作用以外，还兼具有整流作用。在全部操控进程傍边，也会对输入信号的别的一些要素起到必定的影响。扩大功用即是其间之一，因为在操控器之后会再直接接上驱动电路，起到实际的扩大信息的要求，终究完结对电机的驱动。所以操控器仍是以完结操控造用为主。所以在思索参数的挑选的时分，应当尽量思索到对输入信号的操控和整流等，而不是使信号扩大。所以应留心恰当选择份额，微分，积分参数（通过试验可获得较好的作用）。由此可得操控器框图：图6.3操控器框图（2）驱动器图6.4驱动器电路图 咱们选择驱动电路的意图，是为了对输入信号间断扩大，输入一个较小的信号，通过驱动电路扩大之后，使之可以抵达对电机驱动的意图。分别相应的实习情况，可以选择驱动器傍边的两个扩大器材，串联。由此可得驱动器框图：图6.5驱动器框图（3）直流电机图6.6直流电机的等效电路图由直流电机的等效电路图可得：为电枢反电动势，方向与电枢电压相反为反电枢系数，电磁矩方程为电机转矩系数，为电枢发生电磁转矩转矩均衡方程：为粘性摩擦系数；为翻滚惯量联立上式：电感La一般较小，此处做忽略处置得其间电机时刻常数电动机传送系数拉普拉斯改换后得：由此可得电动机框图：图6.7电动机框图（4）测数传感器图6.8测数传感器电路图传感器将电机的转速转化为电信号并给予输出所以测验传感器框图为：图6.9试传感器框图（5）体系函数方框图图6.10体系函数方框图算出体系的传送函数由此可以推出体系的传送函数为：式中 两个电机分别由单片机发生的两个pwm操控，通过pid算法调整pwm的占空比即可两个电机同步抵达预定的转速。7.1 单片机片内的资本装备7.1.1单片机内各功用模块装备程序规划中所需要的单片机内部各功用模块如表7.1，包含2个守时计数器。表7.1单片机内部功用模块运用情况说明表守时器Timer0:PCA0守时/计数器时基Timer1:UART0运用Timer2:计主电机的速度脉冲Timer3:计从电机的速度脉冲Timer4:25ms守时器，循环4次构成采样时刻和核算时刻PCA0PCA0:发生主电机PWM波PCA1:发生从电机PWM波UART0单片机与上位机串行通讯操控器 T2、T3和T4的功用是一样的，不能作为8位守时/计数器，只能作业在16位方法下，可主动重载、捕捉和发生50%占空比的频率可调脉冲方波，并且可以操作计算的位置。它们的时钟源可以是体系时钟及其分频、外部时钟或它们输入引脚的脉冲。这些都是通过格外功用寄存器TMRnCN和TMRnCF设置的。双向计数方法对电机速度操控很便利，可计电机的正回转。捕捉方法常用来测量脉宽。方波输出方法可发生50%占空比的频率可调脉冲方波。 PCA0供给了一个16位守时/计数器和6个捕捉/比较模块。每个追捕对比模式都有单独的I./O接口，可以经过相交开关配置到CEXn。PCA定时计算器时钟源可分为系统时钟4频率、系统时钟12频率、外面时钟8频率、T0漏出和ECI。ECI可配置到P口上，当做PCA时钟的一个进展。6个模块共用一个时钟，可分别独立作业在以下6种方法：边缘触发捕捉；软件守时；高速输出；频率输出；8位PWM脉宽调制；16位PWM脉宽调制。其中在8位PWM脉宽调节方案下的输出波形频率为PCA时钟频率的256分频，8位PWM占用空间比的公式为： 此刻只需将PCA0敞开，为PCA装备一个时钟源，将相应模块设在8位PWM方法下，并将PWM输出敞开，再将该模块装备到一个I/O口上，则不再需要处置器的干涉，PCA会自动地向外面接口输出PWM波，只需要改变占用空间比的时间，修改一下该模型的追捕对比存储器PCA0CPHn就可以。7.1.2单片机的端口装备 单片机的表面输入输出接口配置如表7.2。C8051F020单片机由于面积小，不可以把每一个作用都设置成一个关口，而是采用相交开关的设置方案，通过优先级解码，将各个功用按优先级次第装备到P0P3接口上。P0P3接口既可以当做一般常用输入/输出口，又可以当做特别作用的接口，比如UART、PWM、守时器输入输出口及外部作业中缀等，由相交开关储存器XBR0,XBR1,XBR2和XBR3装置选取。首先高级的模式会主动分布到前面的接口上。大多数被相交开关装置的接口其输出方式任然受PnMDOUT控制，有推进和遗漏两种输出方案。表7.2.单片机I/O端口装备表资本分配I/O管脚P0.2:CEX0,PWM0输出P0.3：CEX1,PWM1输出P0.4:T2主电机速度冲击输入P0.5:T3从电机速度冲击输入P3.6 减速按钮P3.7 加快按钮7.2 程序模块引见 系统是操作器的生命，在数字操作系统中，主从式操控结构以及PID操控算法都要有相应的软件才华够完结。在本规划中，软件需要完结以下使命：(1)各功用模块初始化；(2)测量并核算主从两电机速度；(3)按倾向信号间断PID核算，得出摆布电机的操控量并顺次改动两路PWM的占空比。所以总的过程可以分为以下步骤：开始模型；测速子过程；操作过程；键盘浏览过程。下面分别给予推引。7.2.1初始化模块 初始化子程序段是通过在主程序中调用来完结初始化功用的。因为本体系运用的是片上体系（SOC）单片机，与别的类型的单片机比较，其内部有着更多的数字资本，作业方法多样，对所用到的内部资本必需逐一间断初始化以确保正常作业，所以初始化是十分首要的一环。开始步骤图如图7.1所示。 各数字模块设置的作业方法如下： (1)端口装备情况如表2。其间P0.0口，P0.2口和P0.3口均设为推挽输出，P0.1口、P0.4口和P0.5口均设为开漏输出。系统时间采用内部晶振1分频率，所以24.5MHZ,密度高达2%； (2)PCA定时计算器时钟源采用T0漏出率，模型CEX0、CEX1生产，8位PWM输出方案,在本策划中操作直流电机的两路PWM波频率设置在1KHZ； (3)Timer0作业在守时器方法2下即8位主动重载方法下，以体系时钟作为自己的时钟源，在程序中T0的溢出率作为PWM0和PWM1的时基，图7.1 初始化流程图 (4)Timer1作业在守时器方法2下即8位主动重载方法下，以体系时钟作为自己的时钟源，在程序中T1作为UART0的波特率发生器， (5)Timer2作业在计数方法下，通过查询可得到与左电机相联接的光电编码器在25ms内宣布的脉冲数； (6)Timer3作业方法与 Timer2一样，计量右电机的速度脉冲； (7)Timer4作业在主动重载守时方法下，以体系时钟的12分频作为自己的时钟源，守时25ms, 守时时刻一到宣布中缀信号，程序初步呼应T4中缀。7.2.2 测速子程序 测速子程序是通过调用Timer4中缀来完结的。Timer4中缀子程序流程图如图7.2所示。 T4循环守时，守时时刻是25ms,作为速度采样的底子周期。T4守时时刻一到，程序就进入中缀，分别读取一次主从电机的速度。在T4中缀子程序中，变量i作为T4守时循环象征，当循环4次抵达0.1秒，变量j被置1，变量j是主程序运算象征，当j等于1时，主程序进入if句子间断一次操控核算。所以本程序的操作周期为0.1秒。电机的速率是每25ms取样一次，在0.1秒内每个电机的速度冲击都计算了4次，分别依次储存在两个四维数组CS1和CS2中，4个数据相加就是0.1秒内电机的实际测量冲击数。本程序在核算中选用了必定的抗搅扰方法，即舍去四个脉冲数据中的最大最小值，由剩下两数相加乘2作为全部时刻段（0.1s）内应计的脉冲个数，这能极好地抑制瞬时性的搅扰。 值得一提的是从电机在0.1秒内所计算的速度冲击数据cesu1和cesu2,它与电机以分钟为单元的实践转动速度是不同的，它们之间形成一对比的关系，设摆布电机的实习速度分别是speed1和speed2，它们之间的换算联系如下： 因为本规划中所选用的直流电机额外速度抵达500转/分，从前超出了一个字节的规模，用这个数值间断倾向核算仍然需要界说一个16位的整形变量来表明，并不能简化核算量。在500转/分的额外转速下能测到的脉冲个数能抵达834，输出操作量是8位PWM的占用空间比，其范围是0到255，为了增进操作密度，在计算左电机速度倾向时选用了测量脉冲数，这就恳求将左电机的设定速度转化成0.1秒下单片机应计的标准脉冲个数shd间断倾向核算。例如恳求电机的转速为shj，其转化公式为：图7.2 测速子程序流程图7.2.3操控程序 PID操作方法是在控制系统中完成的。在操