基于上肢外骨骼助力機器人的嵌入式控制系統的制作方法
【專利摘要】本發明公開了一種基于上肢外骨骼助力機器人的嵌入式控制系統。主要由兩個結構相同的單臂部件和背部支架組成，單臂部件從下至上依次由肘關節和肩關節構成的上肢外骨骼助力機器人。還包括ARM微處理器模塊、DSP微控制器模塊、ARM信號調理模塊、DSP信號調理模塊、電源模塊、兩個操作員運動意圖檢測傳感器、四個角位移傳感器和四個結構相同的驅動單元；ARM微處理器模塊與DSP微控制器模塊通過CAN總線相連，四個驅動單元與外骨骼機構相連并驅動外骨骼機構運動。本發明功能完備、易于開發和維護的外骨骼助力機器人嵌入式控制平臺，實時響應速度快、實時多任務性能高、驅動能力強、功耗低、通用可擴展性好、小型化等特點。
【專利說明】基于上肢外骨骼助力機器人的嵌入式控制系統
【技術領域】
[0001]本發明涉及外骨骼機器人，尤其是涉及一種基于上肢外骨骼助力機器人的嵌入式控制系統。
【背景技術】
[0002]外骨骼機器人技術實質上可以理解為一種可穿戴式機器人技術，模仿生物界的外骨骼開發一種新型機電一體化裝置，可穿戴在操作者的身體外部，為操作者提供諸如保護、身體支撐、運動輔助等功能。同時結合了傳感、控制、信息融合、移動計算等機器人技術，將人類的智力和機器人的“體力”結合在一起，使得外骨骼能夠在操作者參與的控制模式下完成僅靠操作者自身能力無法獨立完成的任務。因此，將人的智能與機器人所具有的強大機械能量結合起來，綜合為一個系統，將會帶來前所未有的變化，這便是外骨骼助力機器人的設計思想。
[0003]外骨骼技術的研究始于I960年的美國，最早的研究成果是美國通用公司研發的Hardiman外骨骼系統，研究的首要目的是緩解士兵長距離負重行軍所引起的疲勞。雖然Hardiman的研究最終停止，但是它對后來外骨骼技術的研究與發展起到了重要的指導作用。進入21世紀后，由于能源技術、微驅動技術、材料科學、信息技術的發展，各種類型的外骨骼如雨后春筍般浮現，外骨骼也逐步向實用化方向發展。
[0004]在控制方面，目前世界上比較主流先進的控制方法和思路很多，例如主從控制、肌電控制、ZMP控制、直接力反饋控制等等，而這些控制往往涉及到復雜的控制算法，如PID控制算法、模糊神經網絡控制算法和滑模控制算法等，需要進行大量的數據計算和傳輸，這就對采用普通單片機的嵌入式控制平臺造成沉重的工作負擔，從而進一步影響電路執行效率以及最終的控制效果。而采用通用計算機作為核心的控制平臺，雖然具有強大的計算和控制能力，但其體積和功耗較大。
【發明內容】
[0005]針對上述【背景技術】中存在的問題和不足，本發明的目的是提供一種外骨骼助力機器人嵌入式控制系統，可以優化外骨骼助力機器人控制系統的控制結構，完善整個控制系統的功能，降低開發和維護難度，提高整個控制系統的執行效率，改善控制系統的控制效
果O
[0006]為實現上述發明目的，本發明采用的技術方案是:
本發明主要兩個結構相同的單臂部件和背部支架組成，單臂部件從下至上依次由肘關節和肩關節構成的上肢外骨骼助力機器人；其特征在于:還包括ARM微處理器模塊、DSP微控制器模塊、ARM信號調理模塊、DSP信號調理模塊、電源模塊、兩個操作員運動意圖檢測傳感器、四個角位移傳感器和四個結構相同的驅動單元；ARM微處理器模塊與DSP微控制器模塊通過CAN總線相連，上肢外骨骼助力機器人上的兩個操作員運動意圖檢測傳感器經ARM信號調理模塊與ARM微處理器模塊相連，上肢外骨骼助力機器人上的四個角位移傳感器經DSP信號調理模塊與DSP微控制器模塊相連，四個結構相同的驅動單元，均包括氣動肌肉、氣壓傳感器和兩個氣動高速開關閥，每個驅動單元中的氣動肌肉的一端分別與上肢外骨骼助力機器人相連，每個驅動單元中的氣動肌肉的另一端分別與各自氣壓傳感器和各自兩個氣動高速開關閥相連，每個驅動單元中的氣動高速開關閥分別與DSP信號調理模塊相連，每個驅動單元中的氣壓傳感器分別與DSP信號調理模塊相連，電源模塊分別與ARM微處理器模塊、DSP微控制器模塊、ARM信號調理模塊和DSP信號調理模塊連接。
[0007]所述ARM微處理器模塊，包括ARM微處理器、RS232串口、RJ45網口、CAN總線接口、USB接口和AD輸入接口 I ;RS232串口用于調試時PC機與ARM微處理器模塊之間的通訊，RJ45網口用于將PC機上的文件系統掛載到ARM微處理器模塊上，CAN總線接口用于與DSP微控制器模塊進行通訊，USB接口用于將內核與文件系統的鏡像文件下載到ARM微處理器模塊上，上肢外骨骼助力機器人上的操作員運動意圖檢測傳感器獲得的模擬量信號經過ARM信號調理模塊進入AD輸入接口 1，再進入ARM微處理器進行數據轉換。
[0008]所述DSP微控制器模塊，主要由DSP微控制器、JTAG調試接口、CAN總線接口、AD輸入接口 2和PWM輸出接口組成；JTAG調試接口用于現場調試和程序下載，CAN總線接口用于與ARM微處理器模塊進行通訊，信號從DSP微控制器出發，經過DSP信號調理模塊，DSP信號調理模塊輸出的模擬量信號通過PWM輸出接口控制氣動高速開關閥，進而驅動氣動肌肉使上肢外骨骼助力機器人運動，上肢外骨骼助力機器人上的氣壓傳感器和角位移傳感器獲得的模擬量信號經過DSP信號調理模塊進入AD輸入接口 2，再進入DSP微控制器進行數據轉換。
[0009]所述電源模塊，由外部電源將220V交流電轉換為24V直流電，24V直流電為氣動高速開關閥和氣壓傳感器供電；24V直流電轉換為+5V直流電和±5V直流電，+5V直流電為ARM微處理器模塊、DSP微控制器模塊和角位移傳感器供電，±5V直流電為操作員運動意圖檢測傳感器供電。
[0010]所述ARM信號調理模塊，主要包括AD輸出接口 1、操作員運動意圖檢測傳感器信號調理電路和操作員運動意圖檢測傳感器接口，所述AD輸出接口 I和所述ARM微控制器模塊的AD輸入接口 I相連，上肢外骨骼助力機器人上的操作員運動意圖檢測傳感器獲得的模擬量信號經過所述操作員運動意圖檢測傳感器信號調理電路，由AD輸出接口 I進入所述ARM微處理器模塊的AD輸入接口 I，AD輸入接口 I與ARM微控制器內部的AD功能模塊相連，所述模擬量信號經過AD輸入接口 I轉化為數字量信號進入ARM微控制器。
[0011]所述操作員運動意圖檢測傳感器信號調理電路，主要由降壓電路、壓控電壓源二階低通濾波電路和電壓跟隨器組成，操作員運動意圖檢測傳感器獲得的模擬量信號在進入ARM微處理器模塊的AD輸入接口 I之前，首先經過降壓電路后進入壓控電壓源二階低通濾波電路，然后經過電壓跟隨器，最后由所述ARM信號調理模塊的AD輸出接口 I進入ARM微處理器模塊的AD輸入接口 I。
[0012]所述DSP信號調理模塊，主要包括AD輸出接口 2、氣壓傳感器信號調理電路、氣壓傳感器接口、角位移傳感器信號調理電路、角位移傳感器接口、PWM輸入接口、氣動高速開關閥驅動電路和氣動高速開關閥接口 ；所述AD輸出接口 2與所述DSP微控制器模塊的AD輸入接口 2相連，上肢外骨骼助力機器人上的氣壓傳感器與角位移傳感器獲得的模擬量信號分別經過所述氣壓傳感器信號調理電路與角位移傳感器信號調理電路，由AD輸出接口 2進入所述DSP微控制器模塊的AD輸入接口 2，AD輸入接口 2與DSP微控制器內部的AD功能模塊相連，所述模擬量信號經過AD輸入接口 2轉化為數字量信號進入DSP微控制器；所述PWM輸入接口與所述DSP微控制器模塊的PWM輸出接口相連，PWM輸出接口與DSP微控制器內部的PWM功能模塊相連，數字量信號經過PWM功能模塊轉化為模擬量信號由PWM輸入接口進入氣動高速開關閥驅動電路，所述氣動高速開關閥驅動電路將模擬信號隔離放大后控制氣動高速開關閥，進而驅動氣動肌肉使上肢外骨骼助力機器人運動。
[0013]所述氣動高速開關閥驅動電路，主要由光耦隔離芯片PC817和場效應管IRF740N組成，信號從DSP微控制器模塊的PWM輸出接口出發，經過光耦隔離芯片PC817，接著由場效應管IRF740N通過所述DSP信號調理模塊的PWM輸入接口驅動氣動高速開關閥進行動作。
[0014]所述氣壓傳感器信號調理電路，主要由電流電壓轉換電路、壓控電壓源二階低通濾波電路和電壓跟隨器組成，氣壓傳感器獲得的模擬量信號在進入DSP微控制器模塊的AD輸入接口 2之前，首先經過電流電壓轉換電路后進入壓控電壓源二階低通濾波電路，然后經過電壓跟隨器，最后由所述DSP信號調理模塊的AD輸出接口 2進入DSP微控制器模塊的AD輸入接口 2。
[0015]所述角位移傳感器信號調理電路，主要由降壓電路、壓控電壓源二階低通濾波電路和電壓跟隨器組成，角位移傳感器獲得的模擬量信號在進入DSP微控制器模塊的AD輸入接口 2之前，首先經過降壓電路后進入壓控電壓源二階低通濾波電路，然后經過電壓跟隨器，最后由所述DSP信號調理模塊的AD輸出接口 2進入DSP微控制器模塊的AD輸入接口2。
[0016]與【背景技術】相比，【背景技術】具有的有益效果是:
采用本發明外骨骼助力機器人嵌入式控制平臺，可以優化外骨骼助力機器人控制系統的控制結構，完善整個控制系統的功能，降低開發和維護難度，提高整個控制系統的執行效率，改善控制系統的控制效果。另外，本外骨骼助力機器人嵌入式控制平臺克服了傳統單片機、DSP或者PC+單片機/DSP在速度、處理能力、體積、方便性、功耗、人機接口以及復雜網絡接口等方面的不足，保證了硬件系統具有良好的擴展性、實時性、靈活性、低功耗等特點，既發揮了 ARM微處理器高穩定性能和強大的任務管理的優點，又發揮了 DSP微控制器高速交換數據和快速處理數字信號的能力。
[0017]本發明是一套結構簡單、功能完備、易于開發和維護的上肢外骨骼助力機器人嵌入式控制系統，它具有魯棒性高、實時響應速度快、實時多任務性能高、驅動能力強、功耗低、通用可擴展性好、小型化等特點。
【專利附圖】
【附圖說明】
[0018]圖1是本發明的系統結構示意圖。
[0019]圖2是本發明的ARM微處理器模塊的邏輯框圖。
[0020]圖3是本發明的DSP微控制器模塊的邏輯框圖。
[0021]圖4是本發明的電源模塊的邏輯框圖。
[0022]圖5是本發明的ARM信號調理模塊的邏輯框圖。
[0023]圖6是本發明的操作員運動意圖檢測傳感器信號調理電路圖。
[0024]圖7是本發明的DSP信號調理模塊的邏輯框圖。[0025]圖8是本發明的氣動高速開關閥驅動電路圖。
[0026]圖9是本發明的氣壓傳感器信號調理電路圖。
[0027]圖10是本發明的角位移傳感器信號調理電路圖。
【具體實施方式】
[0028]下面結合附圖和具體實施例對本發明作進一步說明。
[0029]如圖1所示，本發明的一種外骨骼助力機器人嵌入式控制平臺，主要由兩個結構相同的單臂部件和背部支架組成，單臂部件從下至上依次由肘關節和肩關節構成的上肢外骨骼助力機器人；其特征在于:還包括ARM微處理器模塊、DSP微控制器模塊、ARM信號調理模塊、DSP信號調理模塊、電源模塊、兩個操作員運動意圖檢測傳感器、四個角位移傳感器和四個結構相同的驅動單元；ARM微處理器模塊與DSP微控制器模塊通過CAN總線相連，上肢外骨骼助力機器人上的兩個操作員運動意圖檢測傳感器經ARM信號調理模塊與ARM微處理器模塊相連，上肢外骨骼助力機器人上的四個角位移傳感器經DSP信號調理模塊與DSP微控制器模塊相連，四個結構相同的驅動單元，均包括氣動肌肉、氣壓傳感器和兩個氣動高速開關閥，每個驅動單元中的氣動肌肉的一端分別與上肢外骨骼助力機器人相連，每個驅動單元中的氣動肌肉的另一端分別與各自氣壓傳感器和各自兩個氣動高速開關閥相連，每個驅動單元中的氣動高速開關閥分別與DSP信號調理模塊相連，每個驅動單元中的氣壓傳感器分別與DSP信號調理模塊相連，電源模塊分別與ARM微處理器模塊、DSP微控制器模塊、ARM信號調理模塊和DSP信號調理模塊連接。
[0030]如圖2所示的是ARM微處理器模塊的邏輯框圖。ARM微處理器模塊，包括ARM微處理器、RS232串口、RJ45網口、CAN總線接口、USB接口和AD輸入接口 I ;RS232串口用于調試時PC機與ARM微處理器模塊之間的通訊，RJ45網口用于將PC機上的文件系統掛載到ARM微處理器模塊上，CAN總線接口用于與DSP微控制器模塊進行通訊，USB接口用于將內核與文件系統的鏡像文件下載到ARM微處理器模塊上，上肢外骨骼助力機器人上的操作員運動意圖檢測傳感器獲得的模擬量信號經過ARM信號調理模塊進入AD輸入接口 1，再進入ARM微處理器進行數據轉換。
[0031 ] 如圖3所示的是DSP微控制器模塊的邏輯框圖。DSP微控制器模塊，主要由DSP微控制器、JTAG調試接口、CAN總線接口、AD輸入接口 2和PWM輸出接口組成；JTAG調試接口用于現場調試和程序下載，CAN總線接口用于與ARM微處理器模塊進行通訊，信號從DSP微控制器出發，經過DSP信號調理模塊，DSP信號調理模塊輸出的模擬量信號通過PWM輸出接口控制氣動高速開關閥，進而驅動氣動肌肉使上肢外骨骼助力機器人運動，上肢外骨骼助力機器人上的氣壓傳感器和角位移傳感器獲得的模擬量信號經過DSP信號調理模塊進入AD輸入接口 2，再進入DSP微控制器進行數據轉換。
[0032]如圖4所示的是電源模塊的邏輯框圖。電源模塊由外部電源將220V交流電轉換為24V直流電，24V直流電為氣動高速開關閥和氣壓傳感器供電；24V直流電轉換為+5V直流電和±5V直流電，+5V直流電為ARM微處理器模塊、DSP微控制器模塊和角位移傳感器供電，±5V直流電為操作員運動意圖檢測傳感器供電。
[0033]如圖5所示的是ARM信號調理模塊的邏輯框圖。ARM信號調理模塊，主要包括AD輸出接口 1、操作員運動意圖檢測傳感器信號調理電路和操作員運動意圖檢測傳感器接口，所述AD輸出接口 I和所述ARM微控制器模塊的AD輸入接口 I相連，上肢外骨骼助力機器人上的操作員運動意圖檢測傳感器獲得的模擬量信號經過所述操作員運動意圖檢測傳感器信號調理電路，由AD輸出接口 I進入所述ARM微處理器模塊的AD輸入接口 1，AD輸入接口 I與ARM微控制器內部的AD功能模塊相連，所述模擬量信號經過AD輸入接口 I轉化為數字量信號進入ARM微控制器。
[0034]如圖6所示的是操作員運動意圖檢測傳感器信號調理電路圖。操作員運動意圖檢測傳感器信號調理電路主要由降壓電路、壓控電壓源二階低通濾波電路和電壓跟隨器組成，操作員運動意圖檢測傳感器獲得的模擬量信號在進入ARM微處理器模塊的AD輸入接口I之前，首先經過降壓電路后進入壓控電壓源二階低通濾波電路，然后經過電壓跟隨器，最后由所述ARM信號調理模塊的AD輸出接口 I進入ARM微處理器模塊的AD輸入接口 I。具體實現方式詳見圖6。
[0035]如圖7所示的是DSP信號調理模塊的邏輯框圖。DSP信號調理模塊，主要包括AD輸出接口 2、氣壓傳感器信號調理電路、氣壓傳感器接口、角位移傳感器信號調理電路、角位移傳感器接口、PWM輸入接口、氣動高速開關閥驅動電路和氣動高速開關閥接口 ；所述AD輸出接口 2與所述DSP微控制器模塊的AD輸入接口 2相連，上肢外骨骼助力機器人上的氣壓傳感器與角位移傳感器獲得的模擬量信號分別經過所述氣壓傳感器信號調理電路與角位移傳感器信號調理電路，由AD輸出接口 2進入所述DSP微控制器模塊的AD輸入接口 2，AD輸入接口 2與DSP微控制器內部的AD功能模塊相連，所述模擬量信號經過AD輸入接口 2轉化為數字量信號進入DSP微控制器；所述PWM輸入接口與所述DSP微控制器模塊的PWM輸出接口相連，PWM輸出接口與DSP微控制器內部的PWM功能模塊相連，數字量信號經過PWM功能模塊轉化為模擬量信號由PWM輸入接口進入氣動高速開關閥驅動電路，所述氣動高速開關閥驅動電路將模擬信號隔離放大后控制氣動高速開關閥，進而驅動氣動肌肉使上肢外骨骼助力機器人運動。
[0036]如圖8所示的是氣動高速開關閥驅動電路圖。氣動高速開關閥驅動電路主要由光耦隔離芯片PC817和場效應管IRF740N組成，信號從DSP微控制器模塊的PWM輸出接口出發，經過光耦隔離芯片PC817，接著由場效應管IRF740N通過所述DSP信號調理模塊的PWM輸入接口驅動氣動高速開關閥進行動作。具體實現方式詳見圖8。
[0037]如圖9所示的是氣壓傳感器信號調理電路圖。氣壓傳感器信號調理電路主要由電流電壓轉換電路、壓控電壓源二階低通濾波電路和電壓跟隨器組成，氣壓傳感器獲得的模擬量信號在進入DSP微控制器模塊的AD輸入接口 2之前，首先經過電流電壓轉換電路后進入壓控電壓源二階低通濾波電路，然后經過電壓跟隨器，最后由所述DSP信號調理模塊的AD輸出接口 2進入DSP微控制器模塊的AD輸入接口 2。具體實現方式詳見圖9。
[0038]如圖10所示的是角位移傳感器信號調理電路圖。角位移傳感器信號調理電路主要由降壓電路、壓控電壓源二階低通濾波電路和電壓跟隨器組成，角位移傳感器獲得的模擬量信號在進入DSP微控制器模塊的AD輸入接口 2之前，首先經過降壓電路后進入壓控電壓源二階低通濾波電路，然后經過電壓跟隨器，最后由所述DSP信號調理模塊的AD輸出接口 2進入DSP微控制器模塊的AD輸入接口 2。具體實現方式詳見圖10。
[0039]本發明具體實施過程:
上位機ARM微處理器模塊主要負責系統的初始化、組織管理、任務規劃、任務調度、操作員運動意圖檢測傳感器信號的采集以及與下位機DSP微控制器模塊的通訊任務等。ARM微處理器模塊上運行有實時操作系統(Linux)，負責多任務的調度和任務的執行，并通過CAN總線向下位機DSP微控制器模塊發送有特定數據格式的控制指令和控制參數。同時ARM微處理器模塊還接受下位機DSP微控制器模塊返回的上肢外骨骼助力機器人各關節的運動狀態、位置參數、姿態等相關參數。上位機ARM微處理器模塊將這些接收到的數據進行處理，結合減小人類的負重期望對上肢外骨骼助力機器人的各個氣動高速開關閥給出相應的控制指令，保證人類承受的重量在允許的偏差范圍內保持一致，從而達到預定控制的目標。下位機DSP微控制器模塊負責接收來自上位機的控制指令和控制參數，按照規定的協議將數據進行轉換，結合固化在DSP微控制器模塊中的運動控制算法得出要發送給各電磁閥的控制參數。DSP微控制器模塊在執行運動控制指令的同時還要實時讀取上肢外骨骼助力機器人各驅動關節的實際位置、狀態信息，并將這些信息實時反饋給上位機ARM微處理器模塊，與上位機進行信息交換，以便上位機根據當前的運動狀態和各關節的位姿決策下一步的運動指令和運動參數。
[0040]上述【具體實施方式】用來解釋說明本發明，而不是對本發明進行限制，在本發明的精神和權利要求的保護范圍內，對本發明作出的任何修改和改變，都落入本發明的保護范圍。
【權利要求】
1.一種基于上肢外骨骼助力機器人的嵌入式控制系統，主要由兩個結構相同的單臂部件和背部支架組成，單臂部件從下至上依次由肘關節和肩關節構成的上肢外骨骼助力機器人；其特征在于:還包括ARM微處理器模塊、DSP微控制器模塊、ARM信號調理模塊、DSP信號調理模塊、電源模塊、兩個操作員運動意圖檢測傳感器、四個角位移傳感器和四個結構相同的驅動單元；ARM微處理器模塊與DSP微控制器模塊通過CAN總線相連，上肢外骨骼助力機器人上的兩個操作員運動意圖檢測傳感器經ARM信號調理模塊與ARM微處理器模塊相連，上肢外骨骼助力機器人上的四個角位移傳感器經DSP信號調理模塊與DSP微控制器模塊相連，四個結構相同的驅動單元，均包括氣動肌肉、氣壓傳感器和兩個氣動高速開關閥，每個驅動單元中的氣動肌肉的一端分別與上肢外骨骼助力機器人相連，每個驅動單元中的氣動肌肉的另一端分別與各自氣壓傳感器和各自兩個氣動高速開關閥相連，每個驅動單元中的氣動高速開關閥分別與DSP信號調理模塊相連，每個驅動單元中的氣壓傳感器分別與DSP信號調理模塊相連，電源模塊分別與ARM微處理器模塊、DSP微控制器模塊、ARM信號調理模塊和DSP信號調理模塊連接。
2.根據權利要求1所述一種基于上肢外骨骼助力機器人的嵌入式控制系統，其特征在于:所述ARM微處理器模塊，包括ARM微處理器、RS232串口、RJ45網口、CAN總線接口、USB接口和AD輸入接口 I ;RS232串口用于調試時PC機與ARM微處理器模塊之間的通訊，RJ45網口用于將PC機上的文件系統掛載到ARM微處理器模塊上，CAN總線接口用于與DSP微控制器模塊進行通訊，USB接口用于將內核與文件系統的鏡像文件下載到ARM微處理器模塊上，上肢外骨骼助力機器人上的操作員運動意圖檢測傳感器獲得的模擬量信號經過ARM信號調理模塊進入AD輸入接口 1，再進入ARM微處理器進行數據轉換。
3.根據權利要求1所述一種基于上肢外骨骼助力機器人的嵌入式控制系統，其特征在于:所述DSP微控制器模塊，主要由DSP微控制器、JTAG調試接口、CAN總線接口、AD輸入接口 2和PWM輸出接口組成；JTAG調試接口用于現場調試和程序下載，CAN總線接口用于與ARM微處理器模塊進行通訊，信號從DSP微控制器出發，經過DSP信號調理模塊，DSP信號調理模塊輸出的模擬量信號通過PWM輸出接口控制氣動高速開關閥，進而驅動氣動肌肉使上肢外骨骼助力機器人運動，上肢外骨骼助力機器人上的氣壓傳感器和角位移傳感器獲得的模擬量信號經過DSP信號調理模塊進入AD輸入接口 2，再進入DSP微控制器進行數據轉換。
4.根據權利要求1所述一種基于上肢外骨骼助力機器人的嵌入式控制系統，其特征在于:所述電源模塊，由外部電源將220V交流電轉換為24V直流電，24V直流電為氣動高速開關閥和氣壓傳感器供電；24V直流電轉換為+5V直流電和±5V直流電，+5V直流電為ARM微處理器模塊、DSP微控制器模塊和角位移傳感器供電，±5V直流電為操作員運動意圖檢測傳感器供電。
5.根據權利要求1所述一種基于上肢外骨骼助力機器人的嵌入式控制系統，其特征在于:所述ARM信號調理模塊，主要包括AD輸出接口 1、操作員運動意圖檢測傳感器信號調理電路和操作員運動意圖檢測傳感器接口，所述AD輸出接口 I和所述ARM微控制器模塊的AD輸入接口 I相連，上肢外骨骼助力機器人上的操作員運動意圖檢測傳感器獲得的模擬量信號經過所述操作員運動意圖檢測傳感器信號調理電路，由AD輸出接口 I進入所述ARM微處理器模塊的AD輸入接口 I，AD輸入接口 I與ARM微控制器內部的AD功能模塊相連，所述模擬量信號經過AD輸入接口 I轉化為數字量信號進入ARM微控制器。
6.根據權利要求5所述ARM信號調理模塊，其特征在于:所述操作員運動意圖檢測傳感器信號調理電路，主要由降壓電路、壓控電壓源二階低通濾波電路和電壓跟隨器組成，操作員運動意圖檢測傳感器獲得的模擬量信號在進入ARM微處理器模塊的AD輸入接口 I之前，首先經過降壓電路后進入壓控電壓源二階低通濾波電路，然后經過電壓跟隨器，最后由所述ARM信號調理模塊的AD輸出接口 I進入ARM微處理器模塊的AD輸入接口 I。
7.根據權利要求1所述一種基于上肢外骨骼助力機器人的嵌入式控制系統，其特征在于:所述DSP信號調理模塊，主要包括AD輸出接口 2、氣壓傳感器信號調理電路、氣壓傳感器接口、角位移傳感器信號調理電路、角位移傳感器接口、PWM輸入接口、氣動高速開關閥驅動電路和氣動高速開關閥接口 ；所述AD輸出接口 2與所述DSP微控制器模塊的AD輸入接口 2相連，上肢外骨骼助力機器人上的氣壓傳感器與角位移傳感器獲得的模擬量信號分別經過所述氣壓傳感器信號調理電路與角位移傳感器信號調理電路，由AD輸出接口 2進入所述DSP微控制器模塊的AD輸入接口 2，AD輸入接口 2與DSP微控制器內部的AD功能模塊相連，所述模擬量信號經過AD輸入接口 2轉化為數字量信號進入DSP微控制器；所述PWM輸入接口與所述DSP微控制器模塊的PWM輸出接口相連，PWM輸出接口與DSP微控制器內部的PWM功能模塊相連，數字量信號經過PWM功能模塊轉化為模擬量信號由PWM輸入接口進入氣動高速開關閥驅動電路，所述氣動高速開關閥驅動電路將模擬信號隔離放大后控制氣動高速開關 閥，進而驅動氣動肌肉使上肢外骨骼助力機器人運動。
8.根據權利要求7所述DSP信號調理模塊，其特征在于:所述氣動高速開關閥驅動電路，主要由光耦隔離芯片PC817和場效應管IRF740N組成，信號從DSP微控制器模塊的PWM輸出接口出發，經過光耦隔離芯片PC817，接著由場效應管IRF740N通過所述DSP信號調理模塊的PWM輸入接口驅動氣動高速開關閥進行動作。
9.根據權利要求7所述DSP信號調理模塊，其特征在于:所述氣壓傳感器信號調理電路，主要由電流電壓轉換電路、壓控電壓源二階低通濾波電路和電壓跟隨器組成，氣壓傳感器獲得的模擬量信號在進入DSP微控制器模塊的AD輸入接口 2之前，首先經過電流電壓轉換電路后進入壓控電壓源二階低通濾波電路，然后經過電壓跟隨器，最后由所述DSP信號調理模塊的AD輸出接口 2進入DSP微控制器模塊的AD輸入接口 2。
10.根據權利要求7所述DSP信號調理模塊，其特征在于:所述角位移傳感器信號調理電路，主要由降壓電路、壓控電壓源二階低通濾波電路和電壓跟隨器組成，角位移傳感器獲得的模擬量信號在進入DSP微控制器模塊的AD輸入接口 2之前，首先經過降壓電路后進入壓控電壓源二階低通濾波電路，然后經過電壓跟隨器，最后由所述DSP信號調理模塊的AD輸出接口 2進入DSP微控制器模塊的AD輸入接口 2。
【文檔編號】B25J13/08GK103786157SQ201410024182
【公開日】2014年5月14日 申請日期:2014年1月20日 優先權日:2014年1月20日
【發明者】劉昊, 李智壽, 張丹婷, 趙勇, 李超, 陶國良 申請人:浙江大學