一種雙核三輪驅(qū)動高速機器人電動病床控制器的制造方法
【專利摘要】本發(fā)明公開了一種雙核三輪驅(qū)動高速機器人電動病床控制器，包括交流電源、電池、控制板、第一電機、第二電機、第三電機以及機器人電動病床，所述的控制板采用雙核控制器，包括ARM和FPGA，所述的FPGA內(nèi)部還設(shè)有伺服梯形發(fā)生器，由所述的FPGA經(jīng)過伺服梯形發(fā)生器發(fā)出第一控制信號和、第二控制信號和第三控制信號，通過磁電編碼器由所述的第一電機、第二電機和第三電機控制所述的機器人電動病床的前進、運行速度和運行方向。通過上述方式，本發(fā)明通過控制器改變其行走速度，通過兩輪差速行駛方式改變其方向；當爬坡需要更多能量時，開啟助力電機起到功率補償作用，可以很好的通過電動助力減少護工或者護士人員的勞動量和勞動強度。
【專利說明】
一種雙核三輪驅(qū)動高速機器人電動病床控制器
技術(shù)領(lǐng)域
[0001 ]本發(fā)明涉及一種雙核三輪驅(qū)動高速機器人電動病床自動控制系統(tǒng)，屬于自動電動 病床領(lǐng)域。
【背景技術(shù)】
[0002] 醫(yī)用病床系統(tǒng)是一種用于醫(yī)院病房內(nèi)提供承載患者的設(shè)備。目前發(fā)達國家醫(yī)院中 使用的醫(yī)用病床基本上全部自動化，家庭病床、社區(qū)醫(yī)院病床也已經(jīng)使用多功能電動床。部 分醫(yī)用病床可以通過外力改變形狀達到輔助調(diào)整患者體位的目的，其中有些附件具有促進 患者康復的效果;可控制電動病床是相對高級的自動化產(chǎn)品，具有省時省力的優(yōu)點。由于電 控制的特點，控制鍵可以安裝在任何允許病床接受到信號的范圍內(nèi)，提高了控制的自由度。 通過附件升級，還可以實現(xiàn)權(quán)限分配。電動驅(qū)動產(chǎn)品精度更高，便于流水線作業(yè)，已作為ICU 重癥監(jiān)護室、手術(shù)室、造影室等中使用的特種醫(yī)用病床。
[0003] 我國在醫(yī)用電動病床領(lǐng)域的研究開發(fā)相對滯后，整體水平不高，現(xiàn)國內(nèi)各級醫(yī)院 均是采用普通的機械病床：由床腿、床體和床面組成。為了移動方便移動，一般均在床腿上 設(shè)置機械滾動滑輪;為了方便病人坐起，均在床頭部分設(shè)置機械手動搖起裝置。對于這類型 病床，一般均需要護理人員幫助，很難獨自完成，同時病床功能單一，實用性能不強。
[0004] 長時間運行發(fā)現(xiàn)存在著很多安全隱患和不便，即： (1) 現(xiàn)有的部分病床通過四個固定站腳與地面接觸起到支撐作用，病人均被固定在某 一個封閉的環(huán)境中，隨著病人長時間的住院，對病人的身心造成了極大的傷害； (2) 雖然部分病床把固定站腳改為了機械萬向輪，可以通過醫(yī)護人員移動病床到某個 空間，但是由于病床移動隨意性較大，有時候會出現(xiàn)誤操作，甚至有時候會傷害到病人； (3) 隨著現(xiàn)代人類生活質(zhì)量的增加，肥胖病人大量增加，而護士人員一般又都比較瘦 小，通過機械萬向輪移動病人使得護士人員非常吃力，加重了勞動強度； (4) 隨著老齡化的加重，大量的老人也加重了對病床的需求，現(xiàn)在的護工人員又比較 少，基于機械萬向輪的病床加重了護工人員的勞動強度； (5) 所有的機械病床一般均固定在某個位置，一旦需要移動或者變換方向均需要外部 人員完成，加重了護工人員的勞動量； (6) 現(xiàn)在的機械病床即使可以通過外力通過病房門口被推到外部環(huán)境中，由于人為操 作的自動化程度比較低，通過病房門口都需要點時間調(diào)整病床的姿態(tài)才可以通過； (7) 現(xiàn)在的機械病床即使可以通過機械萬向輪的支撐到達病房以外的環(huán)境，在調(diào)節(jié)了 病人身心的同時，也加大了護工人員的勞動量，特別是通過爬坡的地方時，對護工人員的體 力提出了更高的要求； (8) 雖然單輪驅(qū)動的電動病床可以很好的滿足對病床速度和方向的解耦，但是單輪驅(qū) 動的行走電機功率較大，有時候會造成大馬拉小車的現(xiàn)象出現(xiàn)； (9) 由于單輪驅(qū)動的電動病床動力與地面的接觸點只有一個，造成人為很難精確控制 其移動的方向，輕微的一點干擾就能造成較大的方向改變； (10) 雖然雙輪驅(qū)動可以削弱單輪驅(qū)動的部分缺點，但是機器人電動病床在爬坡的時候 如果通過電機過載來滿足功率要求，長時間的運行會傷害電機的性能，造成系統(tǒng)的可靠性 大幅度降低； (11) 機器人電動病床在許多緊急狀態(tài)下需要快速加速和以較高的速度運行，在這種條 件下系統(tǒng)需求的功率較大，滿足正常行駛的兩輪電機功率無法滿足加速要求，系統(tǒng)無法滿 足緊急狀況下的功率要求； (12) 基于單核控制的機器人電動病床，由于既要處理多軸電機的伺服控制，又要處理 機器人病床的多種傳感器采樣數(shù)據(jù)，由于單核處理器處理的數(shù)據(jù)較多，運算速度不是很快， 不利于機器人高速運轉(zhuǎn)，且有時候由于處理數(shù)據(jù)較多導致機器人病床失控； (13) 由于機器人電動病床在運行過程中頻繁的剎車和啟動，加重了單核控制器的工作 量，單核控制器無法滿足機器人電動病床快速啟動和停止的要求； (14) 由于受周圍環(huán)境不穩(wěn)定因素干擾，單核機器人電動病床控制器經(jīng)常會出現(xiàn)異常， 引起機器人病床在行駛過程中失控，抗干擾能力較差； (15) 雖然基于專用伺服控制芯片可以生成多軸電機的PWM控制信號，但是需要主控制 器與專用芯片通訊后輸入控制參數(shù)才可以實現(xiàn)，造成整體運算速度降低； (16) 受專用伺服控制芯片內(nèi)部伺服程序的影響，一般情況下伺服控制PID參數(shù)不能實 時更改，滿足不了電動病床實時快速伺服控制系統(tǒng)的要求。

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

[0005] 本發(fā)明主要解決的技術(shù)問題是提供一種雙核三輪驅(qū)動高速機器人電動病床控制 器，為克服普通醫(yī)院病床不能滿足病人實際要求，在吸收國外先進控制思想的前提下，自主 研發(fā)了一款基于ARM(STM32F407)+FPGA(A3P250)的兩輪差速行駛單輪助力的三軸驅(qū)動機器 人電動病床。此機器人控制系統(tǒng)以FPGA(A3P250)為處理核心，實現(xiàn)三軸直流無刷電機的同 步伺服控制，STM32F407實現(xiàn)多種傳感器信號的數(shù)字信號實時處理，并實時相應(yīng)各種中斷保 護請求，并實現(xiàn)與FPGA(A3P250)數(shù)據(jù)通信。
[0006] 為解決上述技術(shù)問題，本發(fā)明采用的一個技術(shù)方案是：提供了一種雙核三輪驅(qū)動 高速機器人電動病床控制器，包括交流電源、電池、控制板、第一電機、第二電機、第三電機 以及機器人電動病床，所述的交流電源和電池提供電流驅(qū)動所述的控制板，所述的控制板 采用雙核控制器，包括ARM和FPGA，所述的ARM和FPGA進行通信連接，所述的FPGA內(nèi)部還設(shè)有 伺服梯形發(fā)生器，所述的機器人電動病床上設(shè)有傳感器，所述的FPGA接受傳感器反饋的傳 感器信號，由所述的FPGA經(jīng)過伺服梯形發(fā)生器發(fā)出第一控制信號和、第二控制信號和第三 控制信號，所述的第一控制信號、第二控制信號和第三控制信號經(jīng)驅(qū)動放大后驅(qū)動所述的 第一電機、第二電機和第三電機，所述的第一電機、第二電機和第三電機上均設(shè)置有磁電編 碼器，通過磁電編碼器由所述的第一電機、第二電機和第三電機控制所述的機器人電動病 床的前進、運行速度和運行方向。
[0007] 在本發(fā)明一個較佳實施例中，所述的電池采用鋰離子電池。
[0008]在本發(fā)明一個較佳實施例中，所述的第一電機、第二電機和第三電機均米用高速 直流無刷伺服電機。
[0009] 在本發(fā)明一個較佳實施例中，所述的ARM采用STM32F407;所述的FPGA采用A3P250。
[0010] 在本發(fā)明一個較佳實施例中，所述的傳感器包括加速度計和陀螺儀。
[0011] 在本發(fā)明一個較佳實施例中，所述的第一控制信號、第二控制信號和第三控制信 號均為PffM波控制信號。
[0012] 在本發(fā)明一個較佳實施例中，所述的雙核三輪驅(qū)動高速機器人電動病床控制器還 設(shè)置有人機界面程序和運動控制系統(tǒng)，所述的人機界面程序包括人機界面、路徑規(guī)劃以及 在線輸出，所述的運動控制系統(tǒng)包括基于FPGA三軸直流無刷電機伺服控制、數(shù)據(jù)存儲以及 I/O控制，其中，所述的基于FPGA三軸直流無刷電機伺服控制包括磁電編碼器模塊、加速度 計和陀螺儀加速度模塊、基于磁電傳感器速度模塊以及基于磁電傳感器位移模塊。
[0013] 本發(fā)明的有益效果是:本發(fā)明的雙核三輪驅(qū)動高速機器人電動病床控制器，設(shè)計 了一款基于FPGA的雙核三輪驅(qū)動高速機器人電動病床，這種病床在保證快速性、穩(wěn)定性和 安全性的前提下，通過控制器改變其行走速度，通過兩輪差速行駛方式改變其方向；當爬坡 需要更多能量時，開啟助力電機起到功率補償作用，可以很好的通過電動助力減少護工或 者護士人員的勞動量和勞動強度，機器人病床攜帶的多種傳感器組合使得其具有多種功 能，可以滿足不同條件下病人對病床的需求。
【附圖說明】
[0014] 為了更清楚地說明本發(fā)明實施例中的技術(shù)方案，下面將對實施例描述中所需要使 用的附圖作簡單地介紹，顯而易見地，下面描述中的附圖僅僅是本發(fā)明的一些實施例，對于 本領(lǐng)域普通技術(shù)人員來講，在不付出創(chuàng)造性勞動的前提下，還可以根據(jù)這些附圖獲得其它 的附圖，其中： 圖1為本發(fā)明基于ARM+ FPGA雙核三輪驅(qū)動醫(yī)用病床原理圖； 圖2為本發(fā)明基于ARM+ FPGA雙核三輪驅(qū)動機器人電動病床程序框圖； 圖3為基于ARM+ FPGA雙核三輪驅(qū)動機器人電動病床運動原理框圖； 圖4為基于ARM+ FPGA雙核三輪驅(qū)動機器人電動病床通過病房門口自動導航原理圖。
【具體實施方式】
[0015] 下面將對本發(fā)明實施例中的技術(shù)方案進行清楚、完整地描述，顯然，所描述的實施 例僅是本發(fā)明的一部分實施例，而不是全部的實施例?；诒景l(fā)明中的實施例，本領(lǐng)域普通 技術(shù)人員在沒有做出創(chuàng)造性勞動前提下所獲得的所有其它實施例，都屬于本發(fā)明保護的范 圍。
[0016] 如圖1所示，本實施例包括： 一種雙核三輪驅(qū)動高速機器人電動病床控制器，包括交流電源、電池、控制板、第一電 機、第二電機、第三電機以及機器人電動病床，所述的交流電源和電池提供電流驅(qū)動所述的 控制板，所述的控制板采用雙核控制器，包括ARM和FPGA，所述的ARM和FPGA進行通信連接， 所述的FPGA內(nèi)部還設(shè)有伺服梯形發(fā)生器，所述的機器人電動病床上設(shè)有傳感器，所述的 FPGA接受傳感器反饋的傳感器信號，由所述的FPGA經(jīng)過伺服梯形發(fā)生器發(fā)出第一控制信號 和、第二控制信號和第三控制信號，所述的第一控制信號、第二控制信號和第三控制信號經(jīng) 驅(qū)動放大后驅(qū)動所述的第一電機、第二電機和第三電機，所述的第一電機、第二電機和第三 電機上均設(shè)置有磁電編碼器，通過磁電編碼器由所述的第一電機、第二電機和第三電機控 制所述的機器人電動病床的前進、運行速度和運行方向。
[0017] 本實施例中，所述的電池采用鋰離子電池;所述的第一電機、第二電機和第三電機 均采用高速直流無刷伺服電機。
[0018] 進一步的，所述的ARM采用STM32F407;所述的FPGA采用A3P250。
[0019] STM32F4系列除引腳和軟件兼容高性能的F2系列外，F(xiàn)4的主頻（168MHz)高于F2系 列（120MHz)，并支持單周期DSP指令和浮點單元、更大的SRAM容量（192 KB，F(xiàn)2為128 KB)、 512KB-1MB的嵌入式閃存以及影像、網(wǎng)絡(luò)接口和數(shù)據(jù)加密等更先進的外設(shè)。STM32F4系列基 于最新的STM32F407 Cortex M4內(nèi)核，在現(xiàn)有出色的STM32微控制器產(chǎn)品組合中新增了信 號處理功能，并提高了運行速度;STM32F405X集成了定時器、3個ADC、2個DAC、串行接口、外 存接口、實時時鐘、CRC計算單元和模擬真隨機數(shù)發(fā)生器在內(nèi)的整套先進外設(shè)。STM32F407在 STM32F405產(chǎn)品基礎(chǔ)上增加了多個先進外設(shè)。這些性能使得F4系列可以較容易滿足控制和 信號處理功能混合的數(shù)字信號控制需求。高效的信號處理功能與C 〇rteX-M4處理器系列的 低能耗、低成本和易于使用的優(yōu)點的組合，使得STM32F407性能遠遠優(yōu)越于一般的DSP芯片， 并且STM32F407可以極大地簡化外圍電路設(shè)計，降低系統(tǒng)成本和系統(tǒng)復雜度，也大大提高了 數(shù)據(jù)的存儲處理能力。
[0020] FPGA是在PAL、GAL、EPLD等可編程器件的基礎(chǔ)上進一步發(fā)展的產(chǎn)物，F(xiàn)PGA使得用戶 可以根據(jù)自己的設(shè)計需要，通過特定的布局布線工具對其內(nèi)部進行重新組合連接，在最短 的時間內(nèi)設(shè)計出自己的專用集成電路，這樣就減小成本、縮短開發(fā)周期。由于FPGA采用軟件 化的設(shè)計思想實現(xiàn)硬件電路的設(shè)計，這樣就使得基于FPGA設(shè)計的系統(tǒng)具有良好的可復用和 修改性，這種全新的設(shè)計思想已經(jīng)逐漸應(yīng)用在高性能的交、直流驅(qū)動控制上，并快速發(fā)展。 它是作為專用集成電路(ASIC)領(lǐng)域中的一種半定制電路而出現(xiàn)的，即解決了定制電路的不 足，又克服了原有可編程器件門電路數(shù)有限的缺點，可以說，F(xiàn)PGA芯片是小批量系統(tǒng)提高系 統(tǒng)集成度、可靠性的最佳選擇之一。綜合本發(fā)明的需要，選用FPGA作為多軸直流無刷伺服電 機的伺服控制調(diào)節(jié)器，把STM32F407從復雜的多軸伺服控制算法中解脫出來。
[0021] 為了能夠更好的移動機器人電動病床，本發(fā)明電動病床驅(qū)動部分采用輪式結(jié)構(gòu)， 因為相對于步行、爬行或其它非輪式的移動機器人，輪式機器人具有行動快捷、工作效率 高、結(jié)構(gòu)簡單、可控性強、安全性好等優(yōu)勢。
[0022] 由于本機器人電動病床既要考慮其運行速度，又要考慮其運行方向以及加速和爬 坡時功率需求，為了優(yōu)化系統(tǒng)能源利用率且滿足不同狀況下的功率需求，本發(fā)明采用三個 電機來完成系統(tǒng)對功率的不同需求:通過兩軸電機差速行駛來實現(xiàn)速度和方向的調(diào)控，并 且兩輪差速行駛的兩個電機功率大小相等，功率加起來可以滿足正常行駛時的功率要求； 加速和爬坡需要電動助力時，系統(tǒng)開啟助力電機滿足爬坡功率滿足。這樣既不傷害兩輪差 速電機，也可以進一步減少其功率。在正常行駛條件下，為了調(diào)整機器人電動病床的行駛方 向，通常改變兩臺電機的速度大小就可以隨意實現(xiàn)方向的改變。由于直流電機在高速旋轉(zhuǎn) 時偶爾會產(chǎn)生火花，而醫(yī)院病房又是一個特殊的場合，任何火花都可能會對病人的氧氣瓶 和吸氧裝置產(chǎn)生潛在的危險，因此，本發(fā)明中負責機器人電動病床行走功能的兩臺差速行 駛電機和爬坡助力電機均采用直流無刷伺服電機，由于直流無刷伺服電機采用霍爾傳感器 進行電子換向，高速旋轉(zhuǎn)不會產(chǎn)生任何火花，有效消除了安全隱患。
[0023] 由于本發(fā)明中的機器人電動病床既要適應(yīng)病房中相對干凈的環(huán)境，又要適應(yīng)病房 外相對灰塵較多的骯臟環(huán)境，為了減少灰塵對電機攜帶速度和位移傳感器的影響，本發(fā)明 舍棄了傳統(tǒng)系統(tǒng)中常用的光電編碼器，而采用基于磁電傳感器AS5040H的編碼器，磁電編碼 器可以有效測量出三軸直流無刷伺服電機運動時的速度和位移，為機器人電動病床三軸同 步三閉環(huán)伺服控制提供了可靠反饋。
[0024] 本實施例中，所述的傳感器包括加速度計和陀螺儀;所述的第一控制信號、第二控 制信號和第三控制信號均為PWM波控制信號。
[0025] 加速度計傳感器在較長時間的測量值是正確的，而在較短時間內(nèi)由于信號噪聲的 存在，而有一定誤差。陀螺儀在較短時間內(nèi)則比較準確，而較長時間則會隨著漂移的存在而 產(chǎn)生一定誤差，因此，需要加速度計和陀螺儀相互調(diào)整來確保航向的正確。為了提高機器人 電動病床在行走過程中導航的穩(wěn)定性，實現(xiàn)姿態(tài)的自動精確調(diào)整以及計算加速爬坡時需要 的功率，本發(fā)明在機器人電動病床伺服硬件系統(tǒng)中加入了三軸加速度計和三軸陀螺儀。在 機器人電動病床行走期間全程開啟加速度計和陀螺儀，加速度計和用來測量機器人病床三 個前進方向的加速度和速度，控制器根據(jù)測量值然后通過積分就可以得到其位移，為機器 人的三閉環(huán)控制提供可靠判據(jù)；當機器人病床的姿態(tài)發(fā)生變化時，控制器就可以得到其大 致傾斜角度，一方面根據(jù)角度改變其功率需求，另一方面當姿態(tài)發(fā)生較大變化時，控制器在 一個新的采樣周期立即對其位置補償，避免機器人電動病床在行走過程中因為傾斜過大而 發(fā)生危險，提高了其快速行走導航時的穩(wěn)定性;如果對加速度計和陀螺儀的值進行連續(xù)積 分和匹配，且把它變換到導航坐標系中，機器人電動病床可以不依賴于任何外部信息就能 夠得到其在醫(yī)院導航坐標系中的加速度、速度、偏航角和位置等信息，所產(chǎn)生的導航信息連 續(xù)性好而且噪聲非常低，可以和磁電編碼器傳感器相互匹配然后為多軸伺服控制提供加速 度、速度和位移反饋，極大增強了機器人病床的行走的安全性和準確性。
[0026] 本發(fā)明為克服普通醫(yī)院病床不能滿足病人實際要求，在吸收國外先進控制思想的 前提下，自主研發(fā)了一款基于ARM(STM32F407)+FPGA(A3P250)的兩輪差速行駛單輪助力的 三軸驅(qū)動機器人電動病床。此機器人控制系統(tǒng)以FPGA(A3P250)為處理核心，實現(xiàn)三軸直流 無刷電機的同步伺服控制，STM32F407實現(xiàn)多種傳感器信號的數(shù)字信號實時處理，并實時相 應(yīng)各種中斷保護請求，并實現(xiàn)與FPGA(A3P250)數(shù)據(jù)通信 如圖2所示，所述的雙核三輪驅(qū)動高速機器人電動病床控制器還設(shè)置有人機界面程序 和運動控制系統(tǒng)，所述的人機界面程序包括人機界面、路徑規(guī)劃以及在線輸出，所述的運動 控制系統(tǒng)包括基于FPGA三軸直流無刷電機伺服控制、數(shù)據(jù)存儲以及I/O控制，其中，所述的 基于FPGA三軸直流無刷電機伺服控制包括磁電編碼器模塊、加速度計和陀螺儀加速度模 塊、基于磁電傳感器速度模塊以及基于磁電傳感器位移模塊。
[0027]為達上述目的，本發(fā)明采取以下技術(shù)方案，為了提高運算速度，保證醫(yī)用機器人 電動病床控制系統(tǒng)的穩(wěn)定性和可靠性，本發(fā)明采用32位高性能ARM(STM32F407 )和FPGA (A3P250)，舍棄了傳統(tǒng)采用的單一單片機或單一 16位的DSP芯片，此控制器充分考慮蓄電池 在這個系統(tǒng)的作用，實現(xiàn)雙核控制器同步控制三軸直流無刷伺服電機的功能。機器人電動 病床充分發(fā)揮FPGA(A3P250 )作為伺服處理器數(shù)據(jù)處理速度較快的特點，而由ARM (STM32F407)實現(xiàn)人機界面、I/O控制、路徑導航、在線輸出、數(shù)據(jù)采集與存儲等功能，同時實 時相應(yīng)各種中斷。
[0028] 對于本文設(shè)計的基于ARM(STM32F407)+ FPGA(A3P250)雙核機器人電動病床控制 器，在電源打開狀態(tài)下，人機界面先工作，如果確實需要移動電動病床，護工人員、護士人員 輸入各自的權(quán)限密碼，ARM(STM32F407)使能FPGA(A3P250)機器人電動病床才可能在屋子里 移動，否則機器人電動病床就待在原地等待權(quán)限開啟命令;如果機器人電動病床需要推出 病房，此時醫(yī)院負責人需要開啟自己的權(quán)限密碼，否則機器人電動病床一旦移動到門口位 置被門口監(jiān)控傳感器探測到，檢測系統(tǒng)會觸發(fā)控制器上的傳感器，F(xiàn)PGA(A3P250)鎖死當前 的機器人電動病床并發(fā)出誤操作警報。在正常運動狀態(tài)下，機器人電動病床通過各種傳感 器讀取外部環(huán)境比反饋參數(shù)給FPGA(A3P250)，由FPGA(A3P250)經(jīng)內(nèi)部伺服梯形發(fā)生器生成 兩軸差速行駛的直流無刷伺服電機的同步控制PWM信號，PWM波信號經(jīng)驅(qū)動放大后驅(qū)動直流 無刷電機X和直流無刷電機Y向前運動，其運動速度和位移被相對應(yīng)的磁電編碼器反饋給 FPGA(A3P250)，由FPGA(A3P250)根據(jù)運行狀態(tài)參數(shù)二次調(diào)整兩軸同步PffM控制信號以滿足 實際工作需求;在加速行駛或爬坡狀態(tài)下，機器人電動病床通過各種傳感器讀取外部環(huán)境 比反饋參數(shù)給FPGA(A3P250)，由FPGA(A3P250)經(jīng)內(nèi)部伺服梯形發(fā)生器生成三軸直流無刷伺 服電機的同步控制PWM信號，PWM波信號經(jīng)驅(qū)動放大后驅(qū)動直流無刷電機X、直流無刷電機Y 和直流無刷伺服電機Z向前運動，其運動速度和位移被相對應(yīng)的磁電編碼器反饋給FPGA (A3P250)，由FPGA(A3P250)根據(jù)運行狀態(tài)參數(shù)二次調(diào)整三軸同步HVM控制信號以滿足實際 工作需求。機器人電動床在運行過程中，基于STM32F407的人機界面在線存儲并輸出當前狀 態(tài)，使得處理比較直觀。
[0029]參照圖2,具體實施步驟是： 把醫(yī)用電動床控制系統(tǒng)分為兩部分:人機界面系統(tǒng)和運動控制系統(tǒng)。其中人機界面系 統(tǒng)完成人機界面、路徑規(guī)劃、在線輸出等功能;基于FPGA(A3P250)運動控制系統(tǒng)完成電動病 床的多軸伺服控制，而ARM(STM32F407)實現(xiàn)數(shù)據(jù)存儲、I/O控制等功能，系統(tǒng)充分發(fā)揮FPGA (A3P250)處理數(shù)據(jù)較快的優(yōu)點，同時由ARM(STM32F407)實時處理各種中斷信號和數(shù)據(jù)存 儲。
[0030]參照圖2、圖3和圖4,其具體的功能實現(xiàn)如下： 1) 在機器人電動病床未接到任何指令之前，它一般會和普通醫(yī)用病床沒有區(qū)別，被固 定在某一個區(qū)域，交流電源對系統(tǒng)中的蓄電池充電，保證機器人電動病床有足夠的能源完 成任務(wù)； 2) -旦接到主控器發(fā)出的工作命令后，為了防止機器人電動病床的移動損害充電連接 線，STM32F407控制器會自動斷開連接線與交流電源的連接，機器人電動病床轉(zhuǎn)為蓄電池 供電狀態(tài)； 3) 為了防止誤操作，本發(fā)明采用三級啟動權(quán)限，當確定需要移動機器人電動病床時，如 果只是在病房內(nèi)部移動機器人電動病床，則需要護工人員和護士先后通過人機界面輸入權(quán) 限密碼開啟屋內(nèi)行走模式;如果是需要推動機器人電動病床走出病房，則需要護工人員、護 士和醫(yī)院負責人先后通過人機界面輸入權(quán)限密碼開啟屋外行走模式； 4) 當機器人電動病床開啟行走模式后，一旦啟動鍵SS按下，系統(tǒng)首先完成初始化并檢 測電源電壓，如果蓄電池電源不正常，將向ARM(STM32F407)和FPGA(A3P250)發(fā)出中斷請 求，STM32F407和A3P250會對中斷做第一時間響應(yīng)，如果STM32F407和A3P250的中斷響應(yīng) 沒有來得及處理，車體上的自鎖裝置將被觸發(fā)，進而達到自鎖的功能，防止誤操作；如果電 源正常，電動床機器人將開始正常工作； 5) 當FPGA(A3P250)控制器檢測到啟動鍵SS按下，F(xiàn)PGA(A3P250)控制器將檢測側(cè)向轉(zhuǎn) 彎按鈕SK是否被觸發(fā);如果側(cè)向轉(zhuǎn)彎按鈕SK被觸發(fā)，F(xiàn)PGA(A3P250)根據(jù)機器人運動部分需 要旋轉(zhuǎn)角度沒=M lt和其內(nèi)部梯形發(fā)生器，把直流無刷伺服電機X和Y要運轉(zhuǎn)的距離SX轉(zhuǎn)化 為加速度、速度和位置參考指令值，然后FPGA(A3P250)再結(jié)合電機X和電機Y的磁電傳感器 Ml、M2的反饋生成驅(qū)動直流無刷伺服電機X和電機Y的驅(qū)動信號，驅(qū)動信號經(jīng)功率橋放大后 驅(qū)動直流無刷伺服電機X和電機Y以相反的方向運動，在運動過程Ml和M2實時反饋電機的運 行參數(shù)給FPGA(A3P250)，F(xiàn)PGA(A3P250)根據(jù)反饋參數(shù)二次微調(diào)電機X和電機Y的PffM控制信 號，使得旋轉(zhuǎn)系統(tǒng)在規(guī)定時間內(nèi)完成側(cè)轉(zhuǎn)90 n任務(wù)，由于在此過程中只是電機X和電機Y組成 的旋轉(zhuǎn)部分旋轉(zhuǎn)90度，并未改變電動病床的方向，提高了機器人電動病床在狹小空間的實 用性;在運動過程中，F(xiàn)PGA根據(jù)外界情況實時調(diào)整伺服控制程序的PID參數(shù)以滿足實際需 要，ARM實時記錄電動病床的運行參數(shù)并在人機界面顯示； 6) 當FPGA(A3P250)控制器檢測到啟動鍵SS按下，如果此時前進按鈕SF被觸發(fā)，系統(tǒng)會 對加速按鍵SA進行判斷，如果系統(tǒng)確定加速按鍵SA已經(jīng)觸發(fā)，說明機器人電動病床需要加 速或者是爬坡，此時ARM控制器會根據(jù)需要對機器人所需要的功率進行優(yōu)化分配，然后開啟 三軸電機同步伺服控制模式;根據(jù)加速度和速度要求，F(xiàn)PGA(A3P250)結(jié)合直流無刷電機X、 電機Y和電機Z配備的磁電編碼器M1、M2和M3的反饋經(jīng)內(nèi)部梯形發(fā)生器生成驅(qū)動三軸直流無 刷電機的PffM驅(qū)動信號，驅(qū)動信號經(jīng)驅(qū)動器放大后驅(qū)動三軸電機向前運動，在此過程中磁電 編碼器Ml、M2和M3實時向A3P250反饋其位移信號，F(xiàn)PGA(A3P250)把此位移信號轉(zhuǎn)化為機器 人電動病床的實際運行距離;在運動過程中，機器人攜帶的前方防撞超聲波傳感器S9和SlO 將工作，并向FPGA(A3P250)控制器時刻反饋其與前方障礙物的距離;如果防撞超聲波傳感 器S9或者是SlO讀取到前方有障礙物時，F(xiàn)PGA(A3P250)經(jīng)內(nèi)部伺服控制程序調(diào)整直流無刷 伺服電機X、電機Y、電機Z的PWM輸出，控制機器人電動病床在安全范圍內(nèi)停車，控制器并開 啟一個三秒的計時，如果三秒后控制器依舊讀取到障礙物則通知人機界面改換行走軌跡； 如果三秒后障礙物信號消息，則機器人電動病床將按照當前路徑繼續(xù)啟動前進;在機器人 電動病床運動過程中，磁電傳感器Ml、M2和M3會時刻檢測直流無刷伺服電機X、電機Y和電機 Z的運動速度和位移，并傳送給FPGA(A3P250)，由FPGA(A3P250)二次調(diào)整直流無刷電機X、電 機Y和電機Z的PffM波控制信號以滿足實際需求；在運動過程中，F(xiàn)PGA根據(jù)外界情況實時調(diào) 整伺服控制程序的PID參數(shù)以滿足實際需要，ARM實時記錄電動病床的運行參數(shù)并在人機界 面顯不； 7) 當FPGA(A3P250)控制器檢測到啟動鍵SS按下，如果此時只有前進按鈕SF被觸發(fā)，加 速按鍵SA未被觸發(fā)，機器人電動病床將開始向前按照正常速度運動：電機X和電機Y被啟動， 電機Z被釋放;在運動過程中，機器人攜帶的前方防撞超聲波傳感器S9和SlO將工作，并向 STM32F407控制器時刻反饋其與前方障礙物的距離；如果防撞超聲波傳感器S9或者是SlO 讀取到前方有障礙物時，F(xiàn)PGA(A3P250)經(jīng)內(nèi)部伺服控制程序調(diào)整直流無刷伺服電機X和電 機Y的PffM輸出，控制機器人電動病床在安全范圍內(nèi)停車，控制器并開啟一個三秒的計時，如 果三秒后控制器依舊讀取到障礙物則通知人機界面改換行走軌跡;如果三秒后障礙物信號 消息，則機器人電動病床將按照當前路徑繼續(xù)啟動前進;在機器人電動病床運動過程中，磁 電傳感器Ml、M2會時刻檢測直流無刷伺服電機X和電機Y的運動速度和位移，并傳送給FPGA (A3P250)，由FPGA(A3P250)二次調(diào)整直流無刷電機X和電機Y的P麗波控制信號以滿足實際 需求；在運動過程中，F(xiàn)PGA根據(jù)外界情況實時調(diào)整伺服控制程序的PID參數(shù)以滿足實際需 要，ARM實時記錄電動病床的運行參數(shù)并在人機界面顯示； 8) 當FPGA(A3P250)控制器檢測到啟動鍵SS按下，如果此時后退按鈕SB也被觸發(fā)，無論 加速按鍵SA是否被觸發(fā)，機器人電動病床都將以設(shè)定的正常速度開始后退運動，F(xiàn)PGA (A3P250)經(jīng)內(nèi)部伺服控制程序調(diào)整直流無刷伺服電機X和電機Y的PWM輸出，控制機器人電 動病床按照設(shè)定速度緩慢后退;在后退運動過程中，磁電傳感器M1、M2會時刻檢測直流無刷 伺服電機X和電機Y的運動速度和位移，并傳送給FPGA(A3P250)，F(xiàn)PGA(A3P250)根據(jù)磁電 傳感器Ml和M2的速度和位移反饋二次調(diào)整直流無刷伺服電機X和電機Y的P麗輸出，保證機 器人電動病床在安全速度范圍內(nèi)運行，防止速度過快機器人電動病床推倒護工人員；在運 動過程中，F(xiàn)PGA根據(jù)外界情況實時調(diào)整伺服控制程序的PID參數(shù)以滿足實際需要，ARM實時 記錄電動病床的運行參數(shù)并在人機界面顯示； 9) 當FPGA(A3P250)控制器檢測到啟動鍵SS按下，如果此時轉(zhuǎn)彎按鈕SK和前進按鈕SF被 觸發(fā)，無論加速按鍵SA是否被觸發(fā)，機器人電動病床都將以設(shè)定好的正常速度開始側(cè)向右 移，在運動過程中，機器人攜帶的側(cè)方防撞超聲波傳感器S6將工作，并向STM32F407控制器 時刻反饋其與前方障礙物的距離；如果防撞超聲波傳感器S6讀取到右方有障礙物時，F(xiàn)PGA (A3P250)經(jīng)內(nèi)部伺服控制程序調(diào)整直流無刷伺服電機X和電機Y的PWM輸出，控制機器人電 動病床在安全范圍內(nèi)停車，控制器并開啟一個三秒的計時，如果三秒后控制器依舊讀取到 障礙物存在將向人機界面發(fā)出停車報警;如果三秒后障礙物信號消息，則機器人電動病床 將按照當前軌跡繼續(xù)側(cè)向右移;在機器人電動病床側(cè)向右移過程中，磁電傳感器Ml、M2會時 刻檢測直流無刷伺服電機X和電機Y的運動速度和位移，并傳送給FPGA(A3P250)，由FPGA (A3P250)二次調(diào)整電機X和電機Y的運動參數(shù)，保證系統(tǒng)滿足行走要求；在運動過程中， FPGA根據(jù)外界情況實時調(diào)整伺服控制程序的PID參數(shù)以滿足實際需要，ARM實時記錄電動病 床的運行參數(shù)并在人機界面顯示； 10) 當FPGA(A3P250)控制器檢測到啟動鍵SS-旦按下，如果此時轉(zhuǎn)彎按鈕SK和前進按 鈕SB被觸發(fā)，無論加速按鍵SA是否被觸發(fā)，機器人電動病床都將以設(shè)定好的正常速度開始 側(cè)向左移；在運動過程中，機器人攜帶的側(cè)方防撞超聲波傳感器S7將工作，并向FPGA (A3P250)控制器時刻反饋其與前方障礙物的距離;如果防撞超聲波傳感器S7讀取到運動前 方有障礙物時，F(xiàn)PGA(A3P250)經(jīng)內(nèi)部伺服控制程序調(diào)整直流無刷伺服電機X和電機Y的PWM 輸出，控制機器人電動病床在安全范圍內(nèi)停車，控制器并開啟一個三秒的計時，如果三秒后 控制器依舊讀取到障礙物存在將向人機界面發(fā)出停車報警;如果三秒后障礙物信號消息， 則機器人電動病床將按照當前軌跡繼續(xù)側(cè)向左移;在機器人電動病床側(cè)向左移過程中，磁 電傳感器Ml、M2會時刻檢測直流無刷伺服電機X和電機Y的運動速度和位移，并傳送給FPGA (A3P250)，由FPGA(A3P250)二次調(diào)整電機X和電機Y的運動參數(shù)，保證系統(tǒng)滿足實際需求； 在運動過程中，F(xiàn)PGA根據(jù)外界情況實時調(diào)整伺服控制程序的PID參數(shù)以滿足實際需要，ARM 實時記錄電動病床的運行參數(shù)并在人機界面顯示； 11) 當機器人電動病床需要移出病房時，先有醫(yī)院負責人開啟行走權(quán)限密碼，可以有護 工人員推出房間，也可以有護工人員把機器人電動病床推到帶有地面導航標志的位置，機 器人電動病床進入自動導航狀態(tài):其導航的光電傳感器31、32、53、54、55將工作，地面標志 反射回來的光電信號反饋給FPGA(A3P250)，經(jīng)FPGA(A3P250)判斷處理后確定機器人偏移 導航軌道的偏差，F(xiàn)PGA(A3P250)經(jīng)內(nèi)部伺服控制程序把此偏差信號轉(zhuǎn)化為電機X和電機Y 要運行的加速度、速度和位移指令，再結(jié)合磁電編碼器Ml和M2的反饋生產(chǎn)驅(qū)動直流無刷伺 服電機X和電機Y的驅(qū)動信號，驅(qū)動信號放大后驅(qū)動直流無刷電機X和電機Y向前運動，快速 調(diào)整機器人電動病床迅速回到導航軌道中心；機器人電動病床沿著軌道行走過程，F(xiàn)PGA (A3P250)根據(jù)地面標志和磁電編碼器Ml和M2的反饋微調(diào)電機X和電機Y的驅(qū)動信號，使機 器人沿著設(shè)定好的軌道順利通過病房門口；當鋪設(shè)的軌道消失后，機器人電動病床就停在 原地等待人為移動信號，防止誤操作;在運動過程中，F(xiàn)PGA根據(jù)外界情況實時調(diào)整伺服控制 程序的PID參數(shù)以滿足實際需要，ARM實時記錄電動病床的運行參數(shù)并在人機界面顯示； 12) 本機器人電動病床在運動過程為了防止護士的誤操作以及遇到緊急狀況停車，加 入了緊急停車自動鎖車功能;如遇到緊急情況，當緊急按鍵ESWl按下后，控制器一旦檢測到 緊急中斷請求會發(fā)出原地停車指令，F(xiàn)PGA(A3P250)通過驅(qū)動器封鎖直流無刷伺服電機X、電 機Y和電機Z的PffM波信號，即使電動病床多個萬向輪都處于可以滑動狀態(tài)，由于行走電機X、 電機Y和電機Z處于鎖死狀態(tài)，這樣機器人電動病床也不會運動，保證了機器人在緊急狀況 下的安全性； 13) 本發(fā)明在機器人電動病床上加入了濕度檢測系統(tǒng);此濕度檢測系統(tǒng)由濕敏傳感器、 測量電路和顯示記錄裝置等幾部分組成，分別完成信息獲取、轉(zhuǎn)換、顯示和處理等功能，這 樣當病人大小便失控時，濕度檢測系統(tǒng)會工作，將發(fā)出報警信號，護工人員通過人機界面輸 出可以查出故障原因，然后更換床褥； 14) 本電動床裝備了多種防障礙物報警系統(tǒng)，機器人障礙物探測系統(tǒng)可以在機器人病 床碰撞到障礙物之前自動探測到障礙物的存在并通過控制器協(xié)助自動停車，并根據(jù)障礙物 的性質(zhì)確定二次啟動或是一直待在原地不動，這樣就保證了機器人病床在運動過程中對周 圍環(huán)境的適應(yīng)，減少了環(huán)境對其的干擾； 15) 在機器人電動病床行走過程中，直流無刷伺服電機經(jīng)常會受到外界因素干擾，為了 減少電機的脈動轉(zhuǎn)矩對機器人行走的影響，F(xiàn)PGA(A3P250)控制器在考慮電機特性的基礎(chǔ)上 加入了對電機轉(zhuǎn)矩的在線辨識，并利用電機力矩與電流的關(guān)系進行及時補償，削弱了外界 環(huán)境對機器人運動的影響； 15)在機器人電動病床行走期間伺服控制器全程開啟加速度計Al和陀螺儀Gl，加速度 計Al和陀螺儀Gl可以精確測量出機器人病床三個前進方向的加速度，根據(jù)測得的加速度和 速度控制器通過連續(xù)積分就可以得到其位移，為機器人的三閉環(huán)控制提供可靠判據(jù)；同時 當機器人病床的姿態(tài)發(fā)生變化時，控制器就可以得到其大致傾斜角度和加速度要求，控制 器根據(jù)傾斜角度和加速度需求就可以大致計算出功率需求，然后調(diào)整各臺直流無刷伺服電 機的功率以滿足爬坡和加速需要;控制器通過對加速度計Al和陀螺儀Gl進行連續(xù)積分，且 把它變換到醫(yī)院導航坐標系中，機器人電動病床可以不依賴于任何外部信息就能夠得到其 在醫(yī)院導航坐標系中的加速度、速度、偏航角和位置等信息，控制器實時進行存儲和顯示。
[0031]本發(fā)明具有的有益效果是： 1:在控制過程中，充分考慮了電池在這個系統(tǒng)中的作用，基于ARM(STM32F407)+ FPGA (A3P250)控制器時刻都在對機器人電動病床的運行狀態(tài)和電源來源進行監(jiān)測和運算，當交 流電源切斷時，病床會借助自攜帶蓄電池電源自鎖在固定位置，直至有移動病床的開關(guān)信 號輸入，保證了病床的自然狀態(tài)； 2:為了方便使用，減少外界對病床的干擾，護工人員、護士人員以及醫(yī)院管理人員均需 要開啟權(quán)限才可以啟動機器人電動病床，減少了誤操作的危險； 3:為了方便病人自理，減少對外界條件的依賴，本系統(tǒng)加入了人機界面功能，病人只要 通過電腦觸摸屏就可以自動控制病床機器人，這樣就可以不需要護理而自己解決部分簡易 的日常生活； 4:由于此電動病床加入了基于蓄電池的動力助力裝置，即使碰到病人身體肥胖或者護 理人員身體瘦弱時，病床本身在電源充足的條件下可以為護工人員和護士人員在屋子里移 動病床提供動力，減少了護士或者護工人員在屋子里移動病床的體力消耗和勞動強度； 5:由于此電動病床加入了基于直流無刷伺服電機的兩輪差速驅(qū)動系統(tǒng)，使得病床可以 在屋子里實現(xiàn)自由移動，減少了病人在某一個固定位置的壓抑感； 6:由于此電動病床加入了基于直流無刷伺服電機的兩輪差速驅(qū)動系統(tǒng)，使得單臺電機 的功率大大降低，并且動力與地面的接觸點有兩點，有利于提高電動病床行駛時的操控性； 7:由于此電動病床加入了基于直流無刷伺服電機的單軸加速助力系統(tǒng)，使得兩臺差速 行駛電機的功率可以進一步降低，并且動力與地面的接觸點有三點，在需要加速或者爬坡 時可以通過開啟助力電機滿足功率要求，在正常行駛時可以釋放加速電機，起到一個觸點 的左右，有利于提尚電動病床彳丁駛時的操控性； 8:由于加入了基于直流無刷伺服電機的兩輪差速驅(qū)動系統(tǒng)，在非常狹小的空間內(nèi)可以 使病床機器人側(cè)向移動，減少機器人旋轉(zhuǎn)帶來的負面問題； 9:當機器人電動病床遇到爬坡的時，由于自身攜帶的有動力能源，所以可以通過助力 電機很好的起到助力作用，并且三輪驅(qū)動的動力特性遠遠優(yōu)越于雙輪驅(qū)動，進一步減少了 對護工人員體力的要求； 10:由FPGA(A3P250)處理兩軸電機差速行駛和助力直流無刷伺服電機的全數(shù)字伺服控 制，大大提高了運算速度，解決了單單片機運行較慢的瓶頸，縮短了開發(fā)周期短，并且程序 可移植能力強； 11:本發(fā)明完全實現(xiàn)了單板控制，不僅節(jié)省了控制板占用空間，而且還完全實現(xiàn)了多軸 電機控制信號的同步，有利于提高醫(yī)用機器人電動病床的穩(wěn)定性和動態(tài)性能； 12:由于本控制器采用FPGA(A3P250)處理三軸直流無刷伺服控制系統(tǒng)大量的控制數(shù) 據(jù)與算法，并充分考慮了周圍的干擾源，把ARM從復雜的計算中解脫出來，有效地防止了程 序的"跑飛"，抗干擾能力大大增強； 13:本機器人電動病床加入了自動鎖車功能，當病床機器人在移動過程中，如遇到緊急 情況，F(xiàn)PGA(A3P250)控制器會發(fā)出原地停車指令，并鎖死兩輪差速行駛電機，即使多個萬向 輪都處于可以滑動狀態(tài)，但由于驅(qū)動輪處于鎖死狀態(tài)，這樣機器人也不會運動； 14:為了能夠使機器人病床能夠自由移出病房門口，控制器加入了多種導航傳感器，機 器人在移出病房過程中一旦讀到地面標志就會自動導航，減少人工移動病床帶來的誤差； 15:本電動床機器人裝備了多種報警系統(tǒng)，在碰撞到障礙物之前自動停車，這樣就保證 了在運動過程中的安全性，減少了環(huán)境對其的干擾； 16:由于本機器人電動病床系統(tǒng)采用直流無刷伺服電機替代了直流電機，不僅進一步 提高了系統(tǒng)的安全性，也可以提高能源的利用率，增加了機器人電動病床在攜帶能源一定 的條件下一次移動的距離； 17:由于本機器人電動病床系統(tǒng)采用直流無刷伺服電機，當電機受到外界干擾產(chǎn)生脈 動轉(zhuǎn)矩時，直流無刷伺服電機可以利用力矩與電流的關(guān)系迅速進行補償，極大減少了外界 干擾對機器人電動病床的影響； 18:本機器人電動病床加入了濕度檢測系統(tǒng);此濕度檢測系統(tǒng)由濕敏傳感器、測量電路 和顯示記錄裝置等幾部分組成，分別完成信息獲取、轉(zhuǎn)換、顯示和處理等功能，這樣當病人 大小便失控或者是床單潮濕時，濕度檢測系統(tǒng)會工作，發(fā)出更換請求； 18:由于由FPGA(A3P250)直接生產(chǎn)多軸直流無刷電機驅(qū)動信號，不需要DSP向其輸入任 何參數(shù)，使得系統(tǒng)的處理速度加快，有利于系統(tǒng)高速運行； 19:FPGA(A3P250)控制器根據(jù)外圍環(huán)境實時調(diào)整伺服控制系統(tǒng)的PID參數(shù)，滿足電動病 床不同狀況下快速伺服控制系統(tǒng)調(diào)整的要求； 20:加速度計Al和陀螺儀Gl用來測量機器人病床三個前進方向的加速度和速度，根據(jù) 測量值控制器通過連續(xù)積分就可以得到其速度和位移，為機器人的三閉環(huán)控制提供可靠判 據(jù)； 21:加速度計Al和陀螺儀Gl可以提高機器人電動病床在行走過程中導航的穩(wěn)定性，實 現(xiàn)姿態(tài)的自動精確調(diào)整、計算加速爬坡時需要的功率。
[0032]以上所述僅為本發(fā)明的實施例，并非因此限制本發(fā)明的專利范圍，凡是利用本發(fā) 明說明書內(nèi)容所作的等效結(jié)構(gòu)或等效流程變換，或直接或間接運用在其它相關(guān)的技術(shù)領(lǐng) 域，均同理包括在本發(fā)明的專利保護范圍內(nèi)。
【主權(quán)項】
1. 一種雙核三輪驅(qū)動高速機器人電動病床控制器，其特征在于，包括交流電源、電池、 控制板、第一電機、第二電機、第三電機以及機器人電動病床，所述的交流電源和電池提供 電流驅(qū)動所述的控制板，所述的控制板采用雙核控制器，包括ARM和FPGA，所述的ARM和FPGA 進行通信連接，所述的FPGA內(nèi)部還設(shè)有伺服梯形發(fā)生器，所述的機器人電動病床上設(shè)有傳 感器，所述的FPGA接受傳感器反饋的傳感器信號，由所述的FPGA經(jīng)過伺服梯形發(fā)生器發(fā)出 第一控制信號和、第二控制信號和第三控制信號，所述的第一控制信號、第二控制信號和第 三控制信號經(jīng)驅(qū)動放大后驅(qū)動所述的第一電機、第二電機和第三電機，所述的第一電機、第 二電機和第三電機上均設(shè)置有磁電編碼器，通過磁電編碼器由所述的第一電機、第二電機 和第三電機控制所述的機器人電動病床的前進、運行速度和運行方向。2. 根據(jù)權(quán)利要求1所述的雙核三輪驅(qū)動高速機器人電動病床控制器，其特征在于，所述 的電池采用鋰離子電池。3. 根據(jù)權(quán)利要求1所述的雙核三輪驅(qū)動高速機器人電動病床控制器，其特征在于，所述 的第一電機、第二電機和第三電機均采用高速直流無刷伺服電機。4. 根據(jù)權(quán)利要求1所述的雙核三輪驅(qū)動高速機器人電動病床控制器，其特征在于，所述 的ARM采用STM32F407;所述的FPGA采用A3P250。5. 根據(jù)權(quán)利要求1所述的雙核三輪驅(qū)動高速機器人電動病床控制器，其特征在于，所述 的傳感器包括加速度計和陀螺儀。6. 根據(jù)權(quán)利要求1所述的雙核三輪驅(qū)動高速機器人電動病床控制器，其特征在于，所述 的第一控制信號、第二控制信號和第三控制信號均為PWM波控制信號。7. 根據(jù)權(quán)利要求1所述的雙核三輪驅(qū)動高速機器人電動病床控制器，其特征在于，所述 的雙核三輪驅(qū)動高速機器人電動病床控制器還設(shè)置有人機界面程序和運動控制系統(tǒng)，所述 的人機界面程序包括人機界面、路徑規(guī)劃以及在線輸出，所述的運動控制系統(tǒng)包括基于 FPGA三軸直流無刷電機伺服控制、數(shù)據(jù)存儲以及I/O控制，其中，所述的基于FPGA三軸直流 無刷電機伺服控制包括磁電編碼器模塊、加速度計和陀螺儀加速度模塊、基于磁電傳感器 速度模塊以及基于磁電傳感器位移模塊。
【文檔編號】A61G7/018GK106074048SQ201610600791
【公開日】2016年11月9日
【申請日】2016年7月28日 公開號201610600791.0, CN 106074048 A, CN 106074048A, CN 201610600791, CN-A-106074048, CN106074048 A, CN106074048A, CN201610600791, CN201610600791.0
【發(fā)明人】張好明
【申請人】江蘇若博機器人科技有限公司