電動輪椅輔助駕駛系統(tǒng)及方法
【專利摘要】本發(fā)明公開一種電動輪椅輔助駕駛系統(tǒng)及方法，主要由帶有操縱桿的電動輪椅、超聲波測距傳感器以及控制器組成，超聲波傳感器與控制器連接，控制器采用分組點火的策略控制超聲波傳感器并采集超聲波傳感器數(shù)據(jù)，當(dāng)用戶操作操縱桿控制輪椅運動時，控制器計算出輪椅安全行駛的控制指令，控制輪椅安全運動；將前方部位的所有超聲波傳感器進(jìn)行分組，每組內(nèi)的超聲波傳感器均不相鄰，每組內(nèi)的超聲波傳感器同時點火啟動，為避免連續(xù)兩組傳感器之間的干擾，在連續(xù)兩組點火之間插入一定的時間間隔。本系統(tǒng)及方法可以全方位的檢測輪椅的周邊環(huán)境，當(dāng)環(huán)境中出現(xiàn)障礙物或發(fā)生可能的碰撞時，主動躲避障礙物并為用戶計算出安全、可行的行駛方向。
【專利說明】電動輪椅輔助駕駛系統(tǒng)及方法【技術(shù)領(lǐng)域】
[0001]本發(fā)明涉及一種電動輪椅，特別涉及一種基于超聲波傳感器的智能電動輪椅輔助駕駛系統(tǒng)及方法。
【背景技術(shù)】
[0002]目前，公知的電動輪椅只能進(jìn)行開環(huán)控制，即用戶通過搖桿或其他交互設(shè)備控制輪椅的前后左右運動。但是，對于行動困難，控制能力有限或是手部抖動的病人，對于電動輪椅的控制會有很大的困難?，F(xiàn)有的電動輪椅在結(jié)構(gòu)設(shè)計、控制方式上尚未考慮涉及躲避障礙及避免會出現(xiàn)的碰撞等情況。

【發(fā)明內(nèi)容】

[0003]針對上述現(xiàn)有技術(shù)中存在的技術(shù)問題，本發(fā)明提供一種基于超聲波傳感器的電動輪椅駕駛輔助系統(tǒng)及方法，該系統(tǒng)及方法可以全方位的檢測輪椅的周邊環(huán)境，當(dāng)環(huán)境中出現(xiàn)障礙物或發(fā)生可能的碰撞時，主動躲避障礙物并為用戶計算出安全、可行的行駛方向。
[0004]為達(dá)到上述目的，本發(fā)明所采用的技術(shù)方案如下:
[0005]一種電動輪椅輔助駕駛系統(tǒng)，主要由帶有操縱桿的電動輪椅、超聲波傳感器以及控制器組成，輪椅上安裝若干超聲波傳感器，超聲波傳感器與控制器連接，控制器控制超聲波傳感器并采集超聲波傳感器數(shù)據(jù)，當(dāng)用戶操作操縱桿控制輪椅運動時，控制器計算出輪椅安全行駛的控制指令，控制輪椅安全運動。
[0006]所述超聲波傳感器包括呈均勻分布于輪椅前方部位向正前方和左右方探測的若干超聲波傳感器、安裝在輪椅前方部位向前下方探測的超聲波傳感器、安裝在輪椅后方部位向正后方探測的超聲波傳感器。
[0007]還包括一傳感器接口板，通過傳感器接口板，將所有的超聲波傳感器的控制及數(shù)據(jù)線路集成到總線上，超聲波傳感器通過總線的形式與控制器進(jìn)行通信，供控制器控制傳感器、采集傳感器數(shù)據(jù)。
[0008]一種電動輪椅輔助駕駛方法，采用上述的系統(tǒng)來完成，所述控制器采用分組點火的策略控制超聲波傳感器并采集超聲波傳感器數(shù)據(jù)，所述分組點火的策略如下:
[0009]將前方部位的所有超聲波傳感器進(jìn)行分組，每組內(nèi)的超聲波傳感器均不相鄰，前下方傳感器和后方傳感器參與分組或單獨成組，每組內(nèi)的超聲波傳感器同時點火啟動，根據(jù)傳感器的最大量程，避免連續(xù)兩組傳感器之間的干擾，在連續(xù)兩組點火之間插入一定的時間間隔。
[0010]所述控制器所運行的控制算法采用共享控制策略，具體如下: [0011]首先，控制器同時接受用戶操作操縱桿的指令和超聲波傳感器采集到的數(shù)據(jù)信息，控制器通過采集到的用戶指令分析得出用戶的運動意圖；
[0012]其次，在得到用戶的運動意圖后，通過超聲波傳感器采集到的數(shù)據(jù)判斷在此運動指令下輪椅的行駛是否安全，如果環(huán)境安全，則直接將用戶指令送給輪椅執(zhí)行；否則，通過控制器中的算法計算出輪椅行駛安全的運動指令，然后將安全指令下發(fā)給輪椅執(zhí)行，保證輪椅的行駛安全。
[0013]本發(fā)明技術(shù)方案,在電動輪椅的前后各安裝一套超聲波傳感器,傳感器信號被控制器所采集、處理。前方安裝的超聲波傳感器用以探測輪椅前方環(huán)境和輪椅前行過程中的樓梯臺階或地面凹陷等。當(dāng)輪椅行駛的前方地面出現(xiàn)樓梯或臺階時，停止輪椅的前進(jìn)運動以避免碰撞和危險。當(dāng)輪椅行駛前方地面狀況安全時，控制器通過前方超聲波傳感器判斷前進(jìn)方向是否存在障礙物，如果不存在障礙物，則判斷為環(huán)境安全，并將用戶的操作桿指令下發(fā)到輪椅的運動控制，操控輪椅運動。如果用戶前行的方向存在障礙物，則表明存在危險，控制器將傳感器獲取到的障礙物信息以及用戶操作操縱桿的指令信息進(jìn)行融合，尋找出輪椅運動安全的、可行方向，并控制輪椅按此方向運動、確保運行安全。電動輪椅后方安裝的超聲波傳感器用以判斷用戶在操縱輪椅倒行時，輪椅的后方環(huán)境是否存在障礙物、是否安全，安全時執(zhí)行用戶指令，危險的情況下停止輪椅運動。
[0014]本發(fā)明可以在用戶操縱、控制輪椅的同時，滿足、實現(xiàn)用戶意圖的情況下，通過超聲波傳感器對輪椅周邊環(huán)境的探測，保障輪椅行駛安全。
【專利附圖】

【附圖說明】
[0015]通過閱讀參照以下附圖對非限制性實施例所作的詳細(xì)描述，本發(fā)明的其它特征、目的和優(yōu)點將會變得更明顯:
[0016]圖1是本發(fā)明所提供的系統(tǒng)中超聲波傳感器安裝結(jié)構(gòu)側(cè)視圖；
[0017]圖2是圖1的俯視圖；
[0018]圖3是本發(fā)明中傳感器接口板連接示意圖；
[0019]圖4是本發(fā)明的傳感器分組點火策略示意圖；
[0020]圖5是本發(fā)明的共享控制策略流程圖。
【具體實施方式】
[0021]下面結(jié)合具體實施例對本發(fā)明進(jìn)行詳細(xì)說明。以下實施例將有助于本領(lǐng)域的技術(shù)人員進(jìn)一步理解本發(fā)明，但不以任何形式限制本發(fā)明。應(yīng)當(dāng)指出的是，對本領(lǐng)域的普通技術(shù)人員來說，在不脫離本發(fā)明構(gòu)思的前提下，還可以做出若干變形和改進(jìn)。這些都屬于本發(fā)明的保護(hù)范圍。
[0022]如圖1、2所示，本發(fā)明所提供的電動輪椅輔助駕駛，包括:安裝在輪椅I前方的超聲波傳感器2均勻分布于輪椅I的前方部位,在前方部位同時安裝有向前下方探測的超聲波傳感器3。在輪椅的后方部位，安裝有超聲波傳感器4直接向后方探測。
[0023]由于超聲波傳感器的輸出和控制信號為數(shù)字I/O信號，多個傳感器的同時使用需要占用大量的數(shù)字I/o資源，在本發(fā)明中設(shè)計了超聲波傳感器接口電路板。接口電路板將所有傳感器的I/o信號收集、匯總到一起，通過或門芯片實現(xiàn)總線功能。具體原理如圖3所示。[0024]為降低傳感器之間的相互干擾，對超聲波傳感器的點火策略做優(yōu)化。以輪椅共安裝16個超聲波傳感器為例，如圖4所示，正前方逆時針依次編號為1-13。前方向下探測傳感器編號為14,后方傳感器編號為15、16。為降低超聲波傳感器相互之間的噪聲干擾,尤其是1-13號超聲波傳感器之間的干擾，制定如下的分組點火策略:1，5，9，13為組一，2,6,10,15為組二，3，7，11，14為組三，4，8，12，16為組四。下方和后方的傳感器由于之間的相互干擾較少，可按照以上方法分組，也可以單組點火。根據(jù)傳感器的最大量程，為避免連續(xù)兩組傳感器之間的干擾，在連續(xù)兩組點火之間應(yīng)插入一定的時間延時。
[0025]本發(fā)明所運行的算法采用共享控制策略。共享控制的含義是指人、自主控制系統(tǒng)之間進(jìn)行協(xié)調(diào)，共同對機器人進(jìn)行控制的一種控制策略。
[0026]本發(fā)明的控制流程如圖5所示:
[0027]根據(jù)圖5的控制流程，對本發(fā)明中共享控制策略的具體描述如下:
[0028]首先，控制器同時接受用戶操作操縱桿的指令和超聲波傳感器采集到的數(shù)據(jù)信息，控制器通過采集到的用戶指令分析得出用戶的運動意圖。
[0029]其次，在得到用戶的運動意圖后，通過超聲波傳感器采集到的數(shù)據(jù)判斷在此運動指令下輪椅的行駛是否安全，如果環(huán)境安全，則直接將用戶指令送給輪椅執(zhí)行；否則，通過控制器中的算法計算出輪椅行駛安全的運動指令，然后將安全指令下發(fā)給輪椅執(zhí)行，保證輪椅的行駛安全。
[0030]盡管本發(fā)明的內(nèi)容已經(jīng)通過上述實施例作了詳細(xì)介紹，但應(yīng)當(dāng)認(rèn)識到上述的描述不應(yīng)被認(rèn)為是對本發(fā)明的限制。在本領(lǐng)域技術(shù)人員閱讀了上述內(nèi)容后，對于本發(fā)明的多種修改和替代都將是顯而易見的。因此，本發(fā)明的保護(hù)范圍應(yīng)由所附的權(quán)利要求來限定。
【權(quán)利要求】
1.一種電動輪椅輔助駕駛系統(tǒng),其特征在于,主要由帶有操縱桿的電動輪椅、超聲波傳感器以及控制器組成，輪椅上安裝若干超聲波傳感器，超聲波傳感器與控制器連接，控制器控制超聲波傳感器并采集超聲波傳感器數(shù)據(jù)，當(dāng)用戶操作操縱桿控制輪椅運動時，控制器計算出輪椅安全行駛的控制指令，控制輪椅安全運動。
2.根據(jù)權(quán)利要求1所述的電動輪椅輔助駕駛系統(tǒng)，其特征在于，所述超聲波傳感器包括均勻分布于輪椅前方部位向正前方和左右方探測的若干超聲波傳感器、安裝在輪椅前方部位向前下方探測的超聲波傳感器、安裝在輪椅后方部位向正后方探測的超聲波傳感器。
3.根據(jù)權(quán)利要求1所述的電動輪椅輔助駕駛系統(tǒng)，其特征在于，還包括一傳感器接口板，通過傳感器接口板，將所有的超聲波傳感器的控制及數(shù)據(jù)線路集成到總線上，超聲波傳感器通過總線的形式與控制器進(jìn)行通信，供控制器控制傳感器、采集傳感器數(shù)據(jù)。
4.一種電動輪椅輔助駕駛方法，其特征在于，采用如權(quán)利要求1、2或3所述的系統(tǒng)來完成，所述控制器采用分組點火 的策略控制超聲波傳感器并采集超聲波傳感器數(shù)據(jù)，所述分組點火的策略如下: 將前方部位的所有超聲波傳感器進(jìn)行分組，每組內(nèi)的超聲波傳感器均不相鄰，前下方傳感器和后方傳感器參與分組或單獨成組，每組內(nèi)的超聲波傳感器同時點火啟動，根據(jù)傳感器的最大量程，避免連續(xù)兩組傳感器之間的干擾，在連續(xù)兩組點火之間插入一定的時間間隔。
5.根據(jù)權(quán)利要求4所述的電動輪椅輔助駕駛方法，其特征在于，所述控制器所運行的控制算法采用共享控制策略，具體如下: 首先，控制器同時接受用戶操作操縱桿的指令和超聲波傳感器采集到的數(shù)據(jù)信息，控制器通過采集到的用戶指令分析得出用戶的運動意圖； 其次，在得到用戶的運動意圖后，通過超聲波傳感器采集到的數(shù)據(jù)判斷在此運動指令下輪椅的行駛是否安全，如果環(huán)境安全，則直接將用戶指令送給輪椅執(zhí)行；否則，通過控制器中的算法計算出輪椅行駛安全的運動指令，然后將安全指令下發(fā)給輪椅執(zhí)行，保證輪椅的行駛安全。
【文檔編號】A61G5/10GK104000694SQ201410228199
【公開日】2014年8月27日 申請日期:2014年5月27日 優(yōu)先權(quán)日:2014年5月27日
【發(fā)明者】王景川, 張建飛, 陳衛(wèi)東 申請人:上海交通大學(xué)