多姿态调整的电动轮椅车控制系统的制作方法

文档序号:10705683阅读:744来源:国知局
多姿态调整的电动轮椅车控制系统的制作方法
【专利摘要】本发明公开了一种多姿态调整的电动轮椅车控制系统,包括手操器模块,CAN通讯模块、控制器模块、差速电机驱动模块,电动推杆驱动模块,电源模块,其中:手操器模块用于对轮椅进行操作控制;手操器模块和控制器模块之间通过CAN通讯模块进行通信;控制器模块控制差速电机驱动模块驱动电机差速运行以及控制电动推杆驱动模块驱动电动推杆进行姿态调整;电源模块用于给手操器模块、控制器模块、CAN通讯模块、差速电机驱动模块,电动推杆驱动模块供电。通过本发明,能够解决电动轮椅车操纵杆分区控制、电动轮椅车多姿态调整和电机位置信息反馈监测的问题,使之更具有功能多样性、加减速平稳性,转弯运行舒适性和安全性、闭环柔滑的特性。
【专利说明】
多姿态调整的电动轮椅车控制系统
技术领域
[0001] 本发明涉及电动轮椅车控制系统,用于控制电动轮椅车的姿态调整和轮椅车双电 机差速运行。
【背景技术】
[0002] 我国老龄化社会正在加速发展,截止到2014年底,我国80岁以上的老年人达2400 多万,失能、半失能老人近4000万人;残疾人8000多万左右,肢体残疾人约877万人。这些失 能、半失能老人和肢体残疾人的行走和康复是面临最大的问题。轮椅车作为老年人和残疾 人最主要代步工具,方便失能老人和肢体残疾人的行走。但普通手动轮椅和电动轮椅都没 有姿态调整转换功能,长期以一个姿态乘坐轮椅车,容易导致使用者的皮肤褥疮发生。
[0003] 现在国内外对轮椅车控制器研究很多,但大多停留在无刷电机的控制驱动研究。 根据电动轮椅车控制器国家标准GB/T 18029.14《电动轮椅车动力和控制系统一要求和测 试方法》标准要求,电动轮椅车控制器需带有电子刹车的制动器,而且由于电动轮椅车启动 和运行速度偏低,有刷电机在低速具有较好的稳定性。加之电动轮椅车控制器缺少姿态调 整的控制功能,不能很好的实现轮椅车姿态转换的人体骨肌系统和血液循环系统力学变 化,导致使用者长期坐姿容易形成褥疮问题。
[0004] 本产品研制出的多姿态调整的轮椅控制系统,能够实现低速的车速0~12km/h (五 级别速度可调)、具有双CPU分离,CAN总线通信可靠、方便扩展,具备姿态坐到躺、躺到站和 坐到站的柔性转换和双电机差速运行的功能,通过多种故障检测反馈功能保障产品安全 性。

【发明内容】

[0005] 本发明所要解决的技术问题是:提供一款双CPU模式,带有电压电流等故障检测和 姿态调整的电动轮椅车控制系统。本产品解决了电动轮椅车操纵杆分区控制、电动轮椅车 多姿态调整和电机位置信息反馈监测的问题,使之更具有闭环柔滑,控制驱动带电子刹车 的有刷直流电机差速运行,驱动两个电动推杆的姿态调整,实现电动轮椅车坐、卧、躺、站等 康复功能,促进轮椅车乘坐者骨肌系统和血液循环系统有效锻炼,很好的防止长期坐式的 皮肤褥疮问题。
[0006] 本发明解决该技术问题所采用的技术方案是:本文发明提出双CTU模式,采用双 ARM控制器,分别用于手操器和控制器开发,包括手操器模块、CAN通讯模块、控制器模块、差 速电机驱动模块、电动推杆驱动模块,电源模块。这些部件的连接方式是:手操器模块和控 制器模块之间采用CAN通讯模块进行通信。控制器模块的输出两路控制方法,一路驱动直流 有刷电机差速运行,一路驱动电动推杆电机姿态调整。电源模块给手操器模块和控制器模 块供电,为24V电池电源。
[0007] 为实现本发明之目的,采用以下技术方案予以实现:
[0008] -种多姿态调整的电动轮椅车控制系统,包括手操器模块,CAN通讯模块,控制器 模块,差速电机驱动模块,电动推杆驱动模块,电源模块,其中:
[0009] 手操器模块用于采集轮椅的操作控制信号,并将操作控制信号传输给控制器模 块;
[0010] 手操器模块和控制器模块之间通过CAN通讯模块进行通信;
[0011] 控制器模块用于根据接收到的操作控制信号控制差速电机驱动模块驱动电机差 速运行,或者用于控制电动推杆驱动模块驱动电动推杆进行轮椅姿态调整;
[0012] 电源模块用于为手操器模块、控制器模块、CAN通讯模块、差速电机驱动模块、电动 推杆驱动模块供电。
[0013] 所述的多姿态调整的电动轮椅车控制系统,优选的:
[0014] 手操器模块包括以下部件:手操器控制器、开关按键和电源指示灯模块、操纵杆、 速度调整按键及指示灯模块、座椅姿态调整按键和指示灯模块、扬声器、CAN总线接口;
[0015] 上述手操器模块各部件的连接方式是:开关按键和电源指示灯模块、操纵杆、速度 调整按键及指示灯模块、座椅调整按键和指示灯模块、扬声器、CAN总线接口均与手操器控 制器连接,操纵杆与手操器控制器进行单向A/D采样通信,按键采用I/O直接读写,CAN总线 接口与手操器控制器为双向通信。
[0016] 所述的多姿态调整的电动轮椅车控制系统,优选的:
[0017] 控制器模块包括控制器、左右电机驱动器、左右刹车控制器、位置反馈装置、故障 检测器、电动推杆驱动器和CAN总线接口;
[0018] 其中控制器用于同时产生4路的PffM输出,用于驱动左右电机驱动器和电动推杆驱 动器;
[0019] 位置反馈装置用于采集左右电机的转速,通过A/D转换输入到控制器,用于调整 PWM脉宽;
[0020] 故障检测器用于通过对采样点进行电压信号的A/D采样以进行故障检测。
[0021 ]所述的多姿态调整的电动轮椅车控制系统,优选的:
[0022] 操纵杆用于输出两路与操纵杆位置相关的电压信号Χ〇、Υ〇,手操器模块用于通过两 路A/D采样模块分别采集Χο、Υο信号,并计算得到分别代表轮椅车X轴和Y轴上的方向和速度 信号的计算值Χ、Υ,将采集值Χ、Υ通过通讯模块发送给控制器模块。
[0023] 所述的多姿态调整的电动轮椅车控制系统,优选的:
[0024]当手操器模块采集操纵杆的左右横坐标时,判断所述操纵杆电压信号Xo是否大于 中心位置的阈值,如果是,将采集的信号转化为Χ = Χ〇-2.5,否则将采集的信号转化为X = 2.5-Χο;
[0025] 当手操器模块采集操纵杆的前后纵坐标时,判断所述操纵杆Yo电压信号是否大于 等于中心位置的阈值,如果是,将采集的信号转化为Υ = Υ〇-2.5,否则将采集的信号转化为Y = 2.5-Υο〇
[0026] 所述的多姿态调整的电动轮椅车控制系统,优选的:
[0027] 控制器模块把操纵杆圆形操控分为8个区间,控制器模块按如下方式对轮椅的方 向和速度进行控制:
[0028] (1)当乂〇>2.5¥、¥()>2.5¥,而且乂<¥时,在区间1内,电动轮椅车前进;
[0029] VR = fl(Vx,VY)=Kv(Vx+VY)
[0030] VL = f2(Vx,VY) =Kv(Vy-Vx)
[0031] (2)当乂〇>2.5¥、¥()>2.5¥,而且父>¥时,在区间2内,电动轮椅车向前右转 ;
[0032] VR = fl(Vx,VY)=Kv(Vx+VY)
[0033] VL = f2(Vx,VY) =Kv(Vx-Vy)
[0034] (3)当乂〇>2.5¥、¥()<2.5¥,而且父>¥时,在区间3内,电动轮椅车向后右转 ;
[0035] Vr = H(VxjVy)=Kv(Vx-Vy)
[0036] VL = f2(Vx,VY)=Kv(Vx+VY)
[0037] (4)当乂〇>2.5¥、¥()<2.5¥,而且父<¥时,在区间4内,电动轮椅车向后退 ;
[0038] Vr = H(VxjVy)=Kv(Vy-Vx)
[0039] VL = f2(Vx,VY)=Kv(Vx+VY)
[0040] (5)当乂〇<2.5¥、¥()<2.5¥,而且父<¥时,在区间5内,电动轮椅车向后退 ;
[0041] VR = fl(Vx,VY)=Kv(VY+Vx)
[0042] VL = f2(Vx,Vy) =Kv(Vy-Vx)
[0043] (6)当乂〇<2.5¥、¥()<2.5¥,而且父>¥时,在区间6内,电动轮椅车向后左转 ;
[0044] VR = fl(Vx,VY)=Kv(Vx+VY)
[0045] VL = f2(Vx,Vy) =Kv(Vx-Vy)
[0046] (7)当乂〇<2.5¥、¥()>2.5¥,而且父>¥时,在区间7内,电动轮椅车向前左转 ;
[0047] Vr = H(VxjVy)=Kv(Vx-Vy)
[0048] VL = f2(Vx,VY)=Kv(Vx+VY)
[0049] (8)当乂〇<2.5¥、¥()>2.5¥,而且父<¥时,在区间8内,电动轮椅车前进。
[0050] Vr = H(VxjVy)=Kv(Vy-Vx)
[0051] VL = f2(Vx,VY)=Kv(Vx+VY)
[0052] 其中,Kv为速度比例,Vl是轮椅车左后轮驱动电机转速,Vr是轮椅车右后轮驱动电 机转速,Vx是操纵杆X坐标值对于的X方向的速度参考值,Vy是操纵杆Y坐标值对于的Y方向的 速度参考值。
[0053]所述的多姿态调整的电动轮椅车控制系统,优选的:
[0054]控制器模块按下式控制轮椅车的运行速度和方向:
[0055]
[0056] 其中V表示轮椅车的速度,Ω表示轮椅车的行进角度速度,d表示操纵杆到轮椅车 后轮中心线的直线距离,M表示轮椅车后轮中心线到轮椅车中心线之间的直线距离。
[0057]所述的多姿态调整的电动轮椅车控制系统,优选的:
[0058]控制器模块按如下方式对电动推杆进行驱动以完成轮椅车姿态调整:
[0059]控制器模块输出SD3A信号实现使能开关,高电平为使能开启,SD3A信号使能变化 实现三极管Qll、场效应管Q9和QlO的截止和导通,当SD3A为高电平时,Qll导通,输出高电 平,Q9和QlO则导通,当SD3A为低电平时,Qll截止,输出低电平,Q9和QlO则截止;当SD3A使能 开启,P丽1输出脉冲高电平,PWM3输出脉冲低电平,则电流方向路线顺序为Vbus、Ql、Mla、 Q9、电动推杆、QIO、M2a,Q6、GND,实现电动推杆的正转;反之,PWMl输出脉冲低电平,P丽3输 出脉冲高电平,电路方向路线顺序为¥131^、〇5、]\123、〇10、电动推杆、〇9、]\113、〇2、6冊,实现电 动推杆的反转。
【附图说明】
[0060]图1是多姿态调整的电动轮椅车控制系统的构成示意框图;
[0061 ]图2是手操器模块的构成示意框图;
[0062] 图3是控制器模块的构成示意框图;
[0063] 图4是手操器分区调制控制方法图;
[0064]图5是轮椅车行进示意图;
[0065]图6是本产品双模式控制驱动流程图;
[0066] 图7a和7b是差速电机驱动电路图;
[0067] 图8是电动推杆驱动电路图。
[0068] 图中,附图标记对应的技术特征如下:
[0069] 1.手操器模块,2.控制器模块,3 . CAN通信模块,4.电源模块,5 .差速电机驱动模 块,6.电动推杆驱动模块;
[0070] 101.手操器ARM控制器,102.操纵杆,103.速度调整按键及指示灯模块,104.座椅 姿态调整按键和指示灯模块,105.扬声器,106.开关按键和电源指示灯模块,107. CAN总线 接口;
[0071] 201.控制器ARM,202.左右电机驱动器,203.位置反馈装置,204.故障检测器,205. 电动推杆驱动器,206.左右刹车控制器,207. CAN总线接口。
【具体实施方式】
[0072] 如图1所示,多姿态调整的电动轮椅车控制系统,包括手操器模块1,CAN通讯模块 3、控制器模块2、差速电机驱动模块5,电动推杆驱动模块6,电源模块4。
[0073] 其中,手操器模块1和控制器模块2之间通过CAN通讯模块3进行通信,控制器模块2 输出两路控制信号,一路信号驱动直流有刷电机差速运行,一路信号驱动电动推杆电机进 行轮椅车姿态调整。电源模块4用于给手操器模块1和控制器模块2供电,为24V电池电源。 [0074] 如图2所示,手操器模块1,包括手操器ARM控制器101、开关按键和电源指示灯模块 106、操纵杆102、速度调整按键及指示灯模块103、座椅姿态调整按键和指示灯模块104、扬 声器105、CAN总线接口 107。上述手操器模块的各部件连接方式是:开关按键和电源指示灯 模块106、操纵杆102、速度调整按键及指示灯模块103、座椅调整按键和指示灯模块104、扬 声器105、CAN总线接口 107均与手操器ARM控制器101连接,操纵杆102与手操器ARM控制器 1 〇 1进行单向A/D采样通信,CAN总线接口为双向通信。
[0075] 如图3所示,控制器模块2,包括控制器ARM 201、左右电机驱动器202、左右刹车控 制器206、位置反馈装置203、故障检测器204、电动推杆驱动器205和CAN总线接口 207。其中 控制器ARM 201采用STM32芯片,STM32自带有通用定时器,每个通用定时器能同时产生多达 4路的P丽输出。本发明使用定时器??Μ3输出4路P丽信号,用于驱动左右电机驱动器202,位 置反馈装置203采集左右电机的转速,通过A/D转换输入到控制器ARM 201,用于调整PWM脉 宽,故障检测器204通过对采样点进行电压信号的A/D采样以检测电池故障、电机故障、驱动 故障、刹车故障、通讯故障等。例如,当A/D采样信号为OV时,说明发生断开故障,当A/D采样 信号为5V时,说明发生短路故障。因为是有刷电机,控制器ARM 201的一路I/O信号输出用于 控制器左右电子刹车器206,实现电动轮椅车的制动性;两路PWM信号发送给电动推杆驱动 器206,实现轮椅车姿态转换。
[0076] 通过按键的选择,可以选择不同的驱动模式,此时控制器ARM 201输出的所述PWM 信号的作用也不同。按键选择方式、指示灯、驱动模式的对照表如下:
[0078]本发明按如下方式实现对多姿态电动轮椅车的控制:
[0079]首先开启开关按键,启动电源,电源指示灯显示,表示系统已经启动,其数码指示 灯指示电池的电量,通过AD采样显示电池的电量等级,电量越高,发光的指示灯越多。而后 通过按键选择驱动模式,当电源指示灯和速度指示灯显示时,控制器模块2选择双差速电机 驱动模式,使用者通过操纵操纵杆和手操器速度档位按键共同完成速度和大小的设定。操 纵杆优选的是两轴霍尔操纵杆,其输出两路与操纵杆位置成正比例关系的而且正交的电压 信号(每一路信号的范围均为〇~5V),当控制器模块2处于双差速电机驱动模式时,手操器 模块1采集操纵杆102输出的Xo、Yo两路信号,操纵杆摆动方向表示轮椅的运行方向,摆动的 幅度大小表示轮椅的运行速度。当操控操纵杆时,操纵杆输出Χο、Υο两路信号,其Χο、Υο的值 在0~5V之间,2.5V是操纵杆处于中间位置时Xo、Yo的值,则以此为中心位置的阈值。
[0080] 当手操器模块采集操纵杆的左右横坐标时,判断所述操纵杆Xo电压信号是否大于 中心位置的阈值,如果是,则采集的模拟信号为x=x『2.5,否则采集的模拟信号为Χ = 2.5-Χο;
[0081] 当手操器模块采集操纵杆的前后纵坐标时,判断所述操纵杆Yo电压信号是否大于 等于中心位置的阈值,如果是,则采集的模拟信号为Υ = Υ〇-2.5,否则采集的模拟信号为Y = 2.5-Υο;
[0082] 手操器模块根据Χο、Υο两路信号是否大于中心位置阈值,计算轮椅车在X轴和Y轴上 的方向信号的计算值Χ、γ并通过两路A/D采样模块采集操纵杆模拟信号Χ、Υ,Χ、Υ代表着轮椅 车速度和方向。
[0083] 同时确定操纵杆转弯方向,方向角度为
(、Υ转换成数字信号的 值,通过CAN通信模块3发送给控制器模块2,电池施加电源于手操器模块、控制器模块和轮 椅的电机。
[0084] 手操器模块根据A / D采样的X、Y的数值,转换成数字信号值
控制器模块根据adcX和adcY来设定PWM的脉宽, 电压信号越高,adcX和adcY则越高,对应的速度参考信号为Vx,VY,则相应的Vx、VY速度数值 越大(adcX和adcY与Vx、Vy之间分别成正比例关系)。轮椅车左右电机速度(Vl,Vr)根据摇杆 信号转换的数值建立函数。
[0085] Vr = H(VxjVy)
[0086] VL = f2(Vx,VY)
[0087] 控制器模块2接收到计算得到的X、Y的值,分析解剖X、Y的轨迹即操纵杆轨迹,统计 出如图4所述,是一个圆形,为了更好的控制电动轮椅车,我们采用把操纵杆圆形轨迹操控 分为8个区间控制。Kv为速度比例,共5个档位,分别为33.3%、55%、66.6%、83.3%、100%, 可通过按压速度调整按键进行选择,控制器模块2的控制策略如下:
[0088] (1)当乂〇>2.5¥、¥()>2.5¥,而且乂<¥时,在区间1内,电动轮椅车前进 ;
[0089] VR = fl(Vx,VY)=Kv(Vx+VY)
[0090] VL = f2(Vx,Vy) =Kv(Vy-Vx)
[0091] (2)当乂〇>2.5¥、¥()>2.5¥,而且父>¥时,在区间2内,电动轮椅车向前右转 ;
[0092] VR = fl(Vx,VY)=Kv(Vx+VY)
[0093] VL = f2(Vx,Vy) =Kv(Vx-Vy)
[0094] (3)当乂〇>2.5¥、¥()<2.5¥,而且父>¥时,在区间3内,电动轮椅车向后右转 ;
[0095] Vr = H(VxjVy)=Kv(Vx-Vy)
[0096] VL = f2(Vx,VY)=Kv(Vx+VY)
[0097] (4)当乂〇>2.5¥、¥()<2.5¥,而且父<¥时,在区间4内,电动轮椅车向后退;
[0098] Vr = H(VxjVy)=Kv(Vy-Vx)
[0099] VL = f2(Vx,VY)=Kv(Vx+VY)
[0100] (5)当乂〇<2.5¥、¥()<2.5¥,而且乂<¥时,在区间5内,电动轮椅车向后退;
[0101] VR = fl(Vx,VY)=Kv(VY+Vx)
[0102] VL = f2(Vx,Vy) =Kv(Vy-Vx)
[0103] (6)当乂〇<2.5¥、¥()<2.5¥,而且乂>¥时,在区间6内,电动轮椅车向后左转;
[0104] VR = fl(Vx,VY)=Kv(Vx+VY)
[0105] VL = f2(Vx,Vy) =Kv(Vx-Vy)
[0106] (7)当乂〇<2.5¥、¥()>2.5¥,而且乂>¥时,在区间7内,电动轮椅车向前左转:
[0107] Vr = H(VxjVy)=Kv(Vx-Vy)
[0108] VL = f2(Vx,VY)=Kv(Vx+VY)
[0109] (8)当乂〇<2.5¥、¥()>2.5¥,而且乂<¥时,在区间8内,电动轮椅车前进。
[0110] Vr = H(VxjVy)=Kv(Vy-Vx)
[0111] VL = f2(Vx,VY)=Kv(Vx+VY)
[0112] 控制器模块按如下公式实现轮椅车的运行速度和方向的:
[0113]
[0114] 其中V表示轮椅车的速度,Ω表示轮椅车的行进角度速度,d表示操纵杆到轮椅车 后轮中心线的直线距离,M表示轮椅车后轮中心线到轮椅车中心线之间的直线距离。
[0115] 安全策略:
[0116] 根据电动轮椅车的安全要求,我们设置电动轮椅车的最大速度为12km/h,根据安 全策略,设置每档位的前进最大速度分别为4km/h、6km/h、8km/h、10km/h、12km/l^ii^4f 弯的最大速度不超过6km/h。
[0117] 加速度变化不能超过1.5m2/s.
[0118] 刹车距离,即减速度到电动轮椅车停止的距离不超过lm。
[0119] 操纵杆用于控制轮椅的速度和方向。将操纵杆推得离中心位置越远,轮椅就行驶 的越快。操纵杆左右移动时,轮椅转弯。当释放操纵杆时,X和Y路信号为〇,控制器模块2输出 高电平给驱动刹车电路将自动施加刹车。
[0120] 速度调整按键每按一下按键速度增加或减少一个档位,共五个档位。该指示灯显 示的轮椅的最大速度设置。有五档速度设置-第1档是最低的速度,第5档是最大速度,每按 一次加速按键,档位自动增加1档,每按一次减速按键,档位自动减少1档。
[0121] 座椅姿态调整按键每按一次按键,则座椅以一定的角度进行调整,共三个档位和2 个指示灯,模式如下表。
[0123] CAN通讯模块,用于收发手操器模块和控制器模块的数据。
[0124] 如图6所示,电动轮椅车控制器模块的控制过程如下:当双差速电机驱动模式时, 开关按键开启_>操纵杆转动_>速度调整按键驱动_>A/D采集操纵杆计算出的X,Y信号_>手 操器ARM模块封装数据,转化为CAN总线通信协议数据进行CAN总线发送-> 控制器模块CAN总 线接收_>控制器模块根据速度档位和方向,并根据电机位置反馈信号比例调制,进行算法 调整,产生4路PffM驱动信号->4路可调PWM信号驱动H桥电路实现差速电机的驱动。当电动推 杆驱动姿态调整模式时,开关按键开启_>操纵杆转动_>姿态调整按键驱动_>A/D采集操纵 杆计算出的Y信号_>手操器ARM模块封装数据,转化为CAN总线通信协议数据进行CAN总线发 送_>控制器模块CAN总线接收->控制器模块根据方向,产生2路定速P丽驱动信号->直接驱 动电动推杆工作。
[0125] 控制器模块通过如图7a和7b所示PffM控制的H桥的通断来实现差速电机运转:
[0126] 电机驱动电路H桥解释:四路PWM分别是PffMl、PWM2、PWM3、PWM4,四路PWM分别驱动 四个半桥功率放大芯片(111-1]4)。3014、3018、302六、3028为使能选择端口。输出端口为!10, LO,HO为输出PffM同向电压,LO为输出PffM反向电压。
[0127] 场效应管叭、〇2、〇3、〇4组成!1桥,用于驱动右侧直流有刷电机,端子組&、1113分别接 直流有刷电机的正负极。控制器模块通过改变PWM信号的脉宽,从而改变输出电压的大小来 调节电机的转速,改变H桥输出方向来改变输出极性,从而控制电机的正反转的方向。所以 控制了差速电机的速度和方向。
[0128] 当PWMl输出高电平时,半桥功率放大芯片Ul的HO输出高电平,LO输出低电平,驱动 Ql导通,Q2截止;PWM2输出低电平时,半桥功率放大芯片U2的HO输出低电平,LO输出高电平, 驱动Q4导通,Q3截止,因此电流从电源Vbus经过Ql,Mla、电机、Mlb、Q4,至IjGND,驱动直流电机 前进方向工作。相反当PWMl输出低电平时,半桥功率放大芯片Ul的HO输出低电平,LO输出高 电平,驱动Q2导通,Ql截止;PWM2输出高电平时,半桥功率放大芯片U2的HO输出高电平,LO输 出低电平,驱动Q3导通,Q4截止,因此电流从电源Vbus经过Q3,Mlb、电机、Mla、Q2,至IjGND,驱 动直流电机相反方向工作,电机的转速则通过PWM输出的脉宽来控制,脉宽越大,导通时间 越长,施加给电机电压越高,电机转速越大。同理,?丽3、?丽4、1]3、1]4、〇5、〇6、〇7、〇8控制左直 流有刷电机速度和方向。
[0129]手操器模块中其速度调整按键和指示灯用于控制双差速电机驱动模式,其座椅姿 态调整灯用于控制电动推杆驱动姿态调整模式,两模式不能同时工作,通过按键选择用于 两模式切换。多姿态调整的工作如下:A/D采集Y-路信号,并设定恒定的HVM输出,当Y>0 时,电动推杆正转,当Υ<〇时,电动推杆反转。电动推杆驱动一个电机运行实现坐到躺的姿 态调整。当电动推杆驱动另一个电机运行时,实现躺到站的姿态调整;当驱动电动推杆二个 电机同时运行,实现坐到站的一体化工作。
[0130] 如图8所示,电动推杆电路图原理解释如下:控制器ARM模块I /0 口输出SD3A实现使 能开关,SD3A高低电平变化实现三极管Ql 1、场效应管Q9和QlO的截止和导通,当SD3A为高电 平时,Qll导通,输出高电平,Q9和QlO则导通,当SD3A为低电平时,Qll截止,输出低电平,Q9 和QlO则截止,所以SD3A是使能端口。当SD3A使能开启,PffMl输出脉冲高电平,PWM3输出脉冲 低电平,则电流方向路线顺序为Vbus、Ql、M1 a、Q9、电动推杆、Q10、M2a,Q6、GND,实现电动推 杆的正转,反之,P丽1输出脉冲低电平,P丽3输出脉冲高电平,电路方向路线顺序为Vbus、 Q5、M2a、Ql0、电动推杆、Q9、Mla、Q2、GND,实现电动推杆的反转。同理:同样的方法实现另一 个电动推杆的正转和反转。
[0131]通过本发明,能够解决电动轮椅车操纵杆分区控制、电动轮椅车多姿态调整和电 机位置信息反馈监测的问题,使之更具有功能多样性、加减速平稳性,转弯运行舒适性和安 全性、闭环柔滑的特性。
【主权项】
1. 一种多姿态调整的电动轮椅车控制系统,包括手操器模块,CAN通讯模块,控制器模 块,差速电机驱动模块,电动推杆驱动模块,电源模块,其特征在于: 手操器模块用于采集轮椅车的操作控制信号,并将操作控制信号传输给控制器模块; 手操器模块和控制器模块之间通过CAN通讯模块进行通信; 控制器模块用于根据接收到的操作控制信号控制差速电机驱动模块驱动电机差速运 行,或者用于控制电动推杆驱动模块驱动电动推杆进行轮椅车姿态调整; 电源模块用于为手操器模块、控制器模块、CAN通讯模块、差速电机驱动模块、电动推杆 驱动模块供电。2. 根据权利要求1所述的多姿态调整的电动轮椅车控制系统,其特征在于: 手操器模块包括以下部件:手操器控制器、开关按键和电源指示灯模块、操纵杆、速度 调整按键及指示灯模块、座椅姿态调整按键和指示灯模块、扬声器、CAN总线接口; 上述手操器模块各部件的连接方式是:开关按键和电源指示灯模块、操纵杆、速度调整 按键及指示灯模块、座椅调整按键和指示灯模块、扬声器、CAN总线接口均与手操器控制器 连接,操纵杆与手操器控制器进行单向A/D采样通信,按键采用I/O直接读写,CAN总线接口 与手操器控制器为双向通信。3. 根据权利要求1所述的多姿态调整的电动轮椅车控制系统,其特征在于: 控制器模块包括控制器、左右电机驱动器、左右刹车控制器、位置反馈装置、故障检测 器、电动推杆驱动器和CAN总线接口; 其中控制器用于同时产生4路的PWM输出,用于驱动左右电机驱动器和电动推杆驱动 器; 位置反馈装置用于采集左右电机的转速,通过A/D转换输入到控制器,用于调整HVM脉 宽; 故障检测器用于通过对采样点进行电压信号的A/D采样以进行故障检测。4. 根据权利要求2所述的多姿态调整的电动轮椅车控制系统,其特征在于: 操纵杆用于输出两路与操纵杆位置相关的电压信号Χ〇、Υ〇,手操器模块用于通过两路A/ D采样模块分别采集电压信号Χο、Υο,并计算得到分别代表轮椅车X轴和Υ轴上的方向和速度 信号的计算值Χ、Υ,将采集值Χ、Υ通过通讯模块发送给控制器模块。5. 根据权利要求4所述的多姿态调整的电动轮椅车控制系统,其特征在于: 当手操器模块采集操纵杆的左右横坐标时,判断所述操纵杆电压信号Χο是否大于中心 位置的阈值,如果是,将采集的信号转化为Χ=Χ〇-2.5,否则将采集的信号转化为X=2.5-Χ〇; 当手操器模块采集操纵杆的前后纵坐标时,判断所述操纵杆电压信号Υο是否大于等于 中心位置的阈值,如果是,将采集的信号转化为Υ = Υ〇-2.5,否则将采集的信号转化为Υ = 2.5-Υ〇〇
【文档编号】A61N5/10GK106075746SQ201610431341
【公开日】2016年11月9日
【申请日】2016年6月16日
【发明人】单新颖, 闫和平, 王喜太, 田中林, 马岩, 王强, 潘国新, 杨荣
【申请人】国家康复辅具研究中心
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1