自行走轮椅设计.docx
《自行走轮椅设计.docx》由会员分享,可在线阅读,更多相关《自行走轮椅设计.docx(20页珍藏版)》请在冰豆网上搜索。
自行走轮椅设计
自动走轮椅
摘要:
为实现高性能和低成本的自行走轮椅,开发了全数字自行走轮椅控制器;采用先进的无速度传感器测速技术,设计了带电流补偿的电压负反馈加负载不平衡补偿的双电机协调控制方案。
驱动部分采用有刷幅条电机的后轮驱动。
幅条电机传动具有转矩大、噪音低、效率高、耗电少、寿命长、绿色环保等优点,克服了链传动噪声大、冲击大、传动不平稳等缺点,且外观新颖,控制部分采用采用平等四边形连杆机构,结构简单,并实现了大角度的转向控制和两轮同步运动,同时增加轮椅在行进中的稳定性,而且起到防倒的功能,遇上下坡也能自主掌控,安全性高;制动部分采用特制的涨刹机构,达到前后手柄都可以制动,安全性高。
给出了软硬件结构和单元电路的设计及参数选择方法;分析了操纵杆工作原理;给出了轮椅速度和运动方向信息合成计算公式和提高运行舒适度的S曲线生成策略。
关键词:
自行走轮椅;控制器;双电机;协调控制;S曲线;误差检测;幅条电机;连杆机构;涨刹机构;电动控制;辅助装置
Automaticwalkawheelchair
Abstract:
Toachievehighperformanceandlowcosttowalkthewheelchair,developedbydigitalcontroller;walkwheelchairs,Usingadvancedspeedsensorlessspeedtechnology,designwiththecurrentcompensationvoltagefeedbackandcompensationofunbalancedloadmotorcoordinationcontrolscheme.Drivingpartadoptsabrushpaintingoftherearwheeldrivemotor.Thepicturehasgreattorquemotordrive,lownoise,highefficiency,energysaving.longlife,greenenvironmentalprotectionetc,andovercometheimpactnoise,largechaindrivenotsmooth,novelappearanceanddefects,andcontrolpartadoptsUSESequalquadrilaterallinkagemechanism,simplestructure,andrealizethelargeAngleofsteeringcontrolandtwowheels,addingwheelchairssynchronousmovementinthestabilityandtravel,preventfallfunction,meetsthedownhillcanindependentlycontrol,highsecurity,Brakingpartadoptsspecialrose,andbraketohandleallcanapplythebrake,highsafety.
Thehardwareandsoftwarestructureandgiventheunitcircuitdesignandparameterselectionmethod,Theleverprincipleanalysis,GiventhespeedanddirectionofmovementwheelchairsyntheticformulasandimproveinformationgeneratedthecomfortoftheScurveoperationstrategy.
KeyWords:
EPW;Controller;Two2motor;Coordinatedcontrol;Scurve;Faultdetection;electromotivewheelchair;handcontrol;electriccontrol;auxiliaryunit
目录
1绪论............................................................................................................................2
1.1国内外发展情况.............................................................................................................4
1.2设计内容........................................................................................................................5
1.3设计思路........................................................................................................................5
2系统方案.......................................................................................................................7
2.1机械系统方案....................................................................................................................7
2.2控制方案........................................................................................................................9
2.3总体方案.......................................................................................................................10
3机械结构计.................................................................................................................11
3.1链条的传动设计............................................................................................................11
3.2电动机的选用..............................................................................................................11
3.3驱动电路设计................................................................................................................12
4控制系统设计...............................................................................................................13
4.1控制系统软件设计...........................................................................................................14
5总 结..........................................................................................................................14
5.1设计总结.......................................................................................................................14
5.2展望...........................................................................................................................14
参考文献...........................................................................................................................15
附录...................................................................................................................................18
致谢.....................................................................................................................................19
一、绪论
1.1自行走轮椅国内外发展情况
随着社会的发展和人类文明程度的提高,人们特别是残疾人愈来愈需要运用现代高新技术来改善他们的生活质量和生活自由度。
因为各种交通事故、天灾人祸和种种疾病,每年均有成千上万的人丧失一种或多种能力(如行走、动手能力等)。
随着人口的增长和医疗技术的进步,社会老龄化问题已成为很多国家不得不认真对待的重要问题之一。
智能轮椅能够帮助老年人和残障人士独立的生活,节省家庭护理费用,减轻社会负担。
许多国家投入较多资金研究智能轮椅,涌现出许多成果,但由于价格和实用性的原因使它们暂时只能作为实验产品。
智能轮椅作为移动机器人的一种,主要用来辅助老年人和残疾人的日常生活和工作,是对他们弱化的机体功能的一种补偿.智能轮椅在作为代步工具的同时又可以使用携带的机器手臂完成简单的日常活动.使他们重新获得生活能力,找回自立、自尊的感觉,重新融入社会.因而,智能轮椅的研究得到越来越多的关注
本设计的研究目标:
在最经济的条件下,设计出一件最实用、最简易操作的自行走轮椅,功能齐全、结构简单、适用于伤残人士、且能达到消费者需求水准的一件市场普及化产品。
主要特色:
功能齐全、结构简便、使用方便、价格适当、安全系数强
电动轮椅技术及其产业化
1.产品特点
电动轮椅作为一种安装有传感器,具有良好的智能控制功能的电动轮椅,不但具有普通的当前市面上电动轮椅所具有的所有功能,而且可以实现更加友好的人机接口和良好的操作性能。
例如,可以实现避碰功能和导航功能,甚至可以实现利用无线方式将使用者的位置和基本状态传送给医护人员和家人实现实时监控。
国内外研究现状及发展趋势(含文献综述):
自动轮椅作为医疗护理领域的服务机器人,其应用大量使用了移动机器人技术
在自动轮椅的研究中涉及到的关键技术有导航系统、控制和能源系统、人机接口
但由于整个轮椅系统以人为中心,所以在研究中要解决的核心是轮椅的安全导航问题
所谓导航即是指移动机器人按照预先给定的任务命令,根据已知的地图信息作出全局路径规划,并在行进过程中,不断感知周围的局部环境信息,自主地作出各种决策,并随时调整自身位姿,引导自身安全行驶到达目标位置
智能轮椅作为医疗护理领域的服务机器人,其应用大量使用了移动机器人技术。
在智能轮椅的研究中涉及到的关键技术有导航系统、控制和能源系统、人机接口,但由于整个轮椅系统以人为中心,所以在研究中要解决的核心是轮椅的安全导航问题。
所谓导航即是指移动机器人按照预先给定的任务命令,根据已知的地图信息作出全局路径规划,并在行进过程中,不断感知周围的局部环境信息,自主地作出各种决策,并随时调整自身位姿,引导自身安全行驶到达目标位置。
随着社会的发展和人类文明程度的提高,人们特别是残疾人愈来愈需要运用现代高新技术来改善他们的生活质量和生活自由度。
因为各种交通事故、天灾人祸和种种疾病,每年均有成千上万的人丧失一种或多种能力(如行走、动手能力等)。
因此,对用于帮助残障人行走的机器人轮椅的研究已逐渐成为热点,如西班牙、意大利等国,中国科学院自动化研究所也成功研制了一种具有视觉和口令导航功能并能与人进行语音交互的智能轮椅。
近几年来我国轮椅车的生产近几年有了较大的发展,据中商情报网监测数据显示,目前全国规模以上轮椅生产企业约有30多家企业,主要集中在东部及沿海发达地区,外商投资轮椅生产企业在中国轮椅行业占绝对领导地位。
近年来随着人口老龄化到来及我国残疾人康复事业的发展,这为轮椅生产企业提供了良好的空间和广阔的市场前景。
。
3.同国外产品的综合比较
技术水平方面:
与国外相比国内已经基本上没有差距,在某些方面甚至还具有一定优势。
生产工艺方面:
虽然与国外相比还有一定差距,但通过分析解剖国外产品特点,利用自身优势可以在较短时间内缩小这种差距。
研发和生产成本方面:
与国外相比,国内具有相当大的优势。
市场潜力方面:
国内电动轮椅市场刚刚启动,尚没有强有力的竞争对手,市场潜力非常大。
4.国内现有企业情况介绍
首先,国内尚无具备智能轮椅生产的企业,现有的轮椅生产企业还主要定位在电动轮椅的生产上。
且由于国内目前上不具备研制开发高性能电动轮椅控制器的能力,国内的生产企业的电动轮椅产品基本上都采用了国外的电动轮椅控制器,甚至部分企业的电动驱动总成也采用了外购方式,因此国内现有企业的产品成本居高不下,影响了市场购买能力的形成。
同时由于不得不采用价格昂贵的进口控制器,国内电动轮椅产品的市场售价长期以来居高不下,难以为普通用户接受,也直接影响了电动轮椅市场的启动。
5.国家产业支持
国家科技发展部门已经看到智能轮椅产业的发展契机,已经从国家的产业发展角度来对其未来的发展进行支持。
下图是普通轮椅图
下图为设计的自行走轮椅产品图
1.2设计内容
本设计的是为残疾人士和老年人设计一款自行走轮椅。
自行走轮椅作为老年人和残疾人的代步工具,有着严格的技术要求。
轮椅优良的驱动性能和严格的安全性保障是首要的技术要求。
技术要求主要如下
1.基本驱动功能
轮椅的模拟给定是由操纵杆发出的,由速度档位设置按键来设定轮椅最高和最低运行速度。
轮椅在起/制动时必须平滑稳定和安全。
自行走轮椅对电机的起/制动快速性没有特殊要求,但对机械特性有相对较高的要求。
轮椅必须能够至少爬行5°的坡,能够在草地等比较糟糕的路况下运行,能够在左/右驱动轮处于不同路面时正常运行。
2.故障检测及保护
控制器应能自动进行故障诊断、定位和报警,并对一些常见故障进行显示。
当轮椅运行时如果检测出故障,系统能够使轮椅安全停止并锁定;当轮椅静止时出现故障,系统应能够立即锁定轮椅
1.3设计思路
本品设计的路线是在普通轮椅上增加电路和电动机,用电能来取代手动,从而使伤残人士和老年人更方便使用轮椅。
电机选择的是Y160M1,连接电路来带动链条连接机构。
用单片机输出、输入信号,连接到轮椅扶手上的控制器,当控制器给出命令的时候,单片机驱动电路,再通过电机带动链条,使整个轮椅能运动起来。
本款自行走轮椅最快速度为10km/h,具备转向、加速、减速、刹车功能。
二、系统方案
2.1机械系统方案
图1 自行走轮椅运动控制系统示意图
上图1为轮椅运动控制系统组成。
可见,自行走轮椅运动控制系统主要由操纵杆信号处理部分、电机控制部分和轮椅状态检测分组成。
操纵杆输出的信号经过操纵杆信号处理部分后被合成为带起/制动S曲线和死区的轮椅的速度和方向给定值。
这个给定值就是用户给控制器的控制指令。
电机控制部分接收用户的指令和反馈信号来合成电机驱动信号和其他控制信号。
这部分是轮椅运动控制系统的核心部分。
电机检测部分检测电机和控制器的工作状态。
这些检测信号被用作电机的控制信号和其它部分的控制信号。
1.1 操纵杆输出信号速度给定合成由于操纵杆输出是二维的随着位置变化而成比例变化的电压信号,故非常适合用来控制自行走轮椅。
用户前后推动操纵杆可以控制轮椅的运行速度,左/右推动可以控制轮椅的转向方向和转向速度的大小。
下面介绍怎样把一个二维的操纵杆
输出信号转换为速度和转向控制指令。
如果把操纵杆的信号看作是二维输出信号,分别在二维坐标系中用X轴和Y轴表示[1]。
图2 操纵杆输出信号矢量合成示意图
可以将X轴信号看作是轮椅的转向速度给定信号,而Y轴信号则可以看作是轮椅的前向和后向速度给定信号。
因此,如果用户想要转向和前进,则可将轮椅的运动方向看作是X和Y的矢量合成,如图2中所示F。
而左/右电机的速度给定Sl和Sr可从下式得出[2]:
Sl=CxFx+CyFy±Smax
(1)
Sr=-CxFx+CyFy±Smax
(2)
其中,设Smax为速度给定最大值,Cx代表轮椅的转向速度特性,而Cy则代表轮椅在前向和反向的速度特性。
如果以上公式的计算结果大于了轮椅最大转向速度,则用最大转向速度代替计算结果。
图3表示以不同角度旋转操纵杆时,轮椅的左/右轮速度给定曲线。
如果Sl和Sr的值都是正的,则轮椅向前前进转向,否则是后退转向。
当轮椅向左转时,右轮正向转动,左轮反向转动或保持不变;相反,当轮椅向右转时,左轮正向转动,右轮反向转动或保持不变。
当一个轮保持不转动而另外一个轮转动时,轮椅做原地360°转弯。
图3 以不同角度旋转操纵杆时轮椅的左/右轮的速度曲线
1.2 速度给定的S曲线设计
(1)设计思路。
S曲线本身是一个非线性函数,其合成和编程都非常复杂。
S曲线的形状如图4虚线所示。
在轮椅起动时应该是一个抛物线形状,然后是轮椅的加速过程,直至轮椅最大速度后,加速度为零,轮椅以恒定最大给定速度运行;制动时,轮椅先以直线的斜率减速,最后在抛物线段舒缓地停止。
本文用图4中的一个折线近似地代替S曲线,用三段折线用来模拟抛物线。
这使得编程非常简单,实践证明,控制效果非常理想。
图4 轮椅速度给定的S曲线示意图
(2)实现方法。
利用中断时间和人体对加速度变化率的敏感特性来实现。
根据人体对加速度和加速度变化率的敏感特性知,当加速度或减速度最大值不大于1.5m/s2、平均加减速度不低于0.5m/s2、加速度变化率小于1.5m/s3时,人体的舒适感比较好。
设系统的中断周期为T,直线的斜率为K,规定轮椅在t时间内加速到速度给定最大值Smax,则:
K=Smaxt/T=SmaxtT(3)
图4中,三段线段斜率比值为:
K1∶K2∶K3=1∶1.92∶2.6。
具体程序实现见第四节。
在本系统的设计中,K1、K2、K3都被设置为可编程调节参数,用户可以根据自己的舒适性要求来进行相应调整。
2.2控制方案设计
对调速系统来说,用转速负反馈可以获得比较满意的静、动态性能。
但是,在本文的自行走轮椅运动控制系统的设计中要实现转速负反馈是非常困难的,因为无法安装转速检测装置。
故在设计中采用电压负反馈和电流补偿的控制方法[3]。
如果忽略电枢压降,则直流电动机的转速近似与电枢两端电压成正比,所以电压负反馈基本上能够代替转速负反馈的作用。
采用电压负反馈和电流补偿控制的调速系统原理图如图5所示
图5 电压负反馈和电流补偿控制的调速系统原理图
其中,V+、V-分别为电动机两端的电压。
它们同时被送入DSP的AD采样通道中,在软件中对V+、V-进行差分得到电机两端的电压。
这样可以消除由于电源电压波动等因素引起的电机端电压的误差。
R1、R2是采样电阻,之所以有两个采样电阻,是因为文中所讨论的电动轮椅控制系统采用双极性模式,可在四象限运行。
由如图5所示的H桥可知,R2、R1可分别检测电机的正反向电流。
对应的系统控制方框图如图6所示。
2.3总体方案:
在多次观察了普通轮椅之后,发现在普通轮椅的座位底部安装双电动机,然后把链条安装在双电动机的连杆上,利用单片机来输出、输入信号,在单片机和双电动机的电路连接下,使整个设计机构有一个完整的回路。
从而实现这款自行走轮椅的运行。
整个设计思路其实比较是简单的,在安装了设计电路后,通过电动机做功来带动链条传动,来实现自行走轮椅行走、加速、减速、刹车的各项功能。
三、机械结构设计
3.1链条传动设计
双电机组合带动链条,以电动机产生动力,电带动电动机上的杆和锥齿轮,通过链条的连接机构,而带动车轮连杆上的链轮,这样形成一个整体机构过程。
开启电源后,当控制器发出运行命令时,信号通过单片机电路与电动机连接,电动机开始启动,通过链条的传动,带动车轮向前或者向后行驶。
3.2电动机的选用
本设计用的是双电机组合,所以在选择电动机时,依照自行走轮椅运行时最大速度10km/h,来选择电动机。
=
=
选择的电动机是Y160M1电动机转速720
车轮的转速:
则:
实际功率:
传动比:
3.3驱动电路设计
在本设计系统中,选用的是ST公司的L298N电机专用驱动芯片。
该芯片的主要特点是:
工作电压高,最高工作电压可达46V;输出电流大,瞬间峰值电流可达3A,持续工作电流为2A;内含两个H桥的高电压大电流全桥式驱动器,可以用来驱动直流电动机和步进电动机、继电器、线圈等感性负载;采用标准逻辑电平信号控制;具有两个使能控制端,在不受输入信号影响的情况下允许或禁止器件工作有一个逻辑电源输入端,使内部逻辑电路部分在低电压下工作;可以外接检测电阻,将变化量反馈给控制电路。
图中电源和地之间接入了去耦电容,在电机线圈两端分别接入二极管进行过流保护。
四、控制系统设计
4.1控制系统软件设计
轮椅运动控制系统总的