選用NI CompactRIO作為機器人的“小腦”。NI CompactRIO是美國NI公司的工業(yè)級嵌入式控制器，集成以太網(wǎng)接口和RS232串行接口，具有體積小，高可靠性，高性能，低功耗等優(yōu)點。

將各種設備的控制算法例如機械臂運動控制，頭部運動控制，導航算法，基于以太網(wǎng)的光雷達數(shù)據(jù)采集，與大腦通訊等程序部署在RT中；將數(shù)字信號采集，例如限位開關和緊急停止邏輯還有編碼器數(shù)據(jù)采集和處理，地盤運動伺服控制等算法部署在FPGA中。

選用工業(yè)嵌入式觸摸平板電腦IPC作為機器人的“大腦”。部署WinCE，具有人機界面功能以及觸摸屏交互功能，部署控制人臉識別模塊以及語音識別算法，智能家居監(jiān)控管理算法等。

用FSM來封裝每個設備對象：

Finite-state machine (FSM)稱為有限狀態(tài)機廣泛用于數(shù)字電路和計算機程序。我們使用了兩種狀態(tài)機來封裝設備。String Based Queued State Machine基于字符串隊列狀態(tài)機和普通基于枚舉的狀態(tài)機。使用狀態(tài)機作為一種機制來處理單個設備的狀態(tài)轉(zhuǎn)換，或者說，用狀態(tài)機這種行為模型來用于單個設備的事件處理。

圖 2 LIDAR 狀態(tài)機

例如光雷達的狀態(tài)機框圖，它具有4個狀態(tài)，Idle，Start，Running，Stop。在Running狀態(tài)中，程序不斷向光雷達發(fā)送指令讀取數(shù)據(jù)，然后由一個Shared Variable來傳出數(shù)據(jù)。使用一個LIRAR.vi來封裝這個狀態(tài)機。

圖 3 Remote Control ReacTIon 狀態(tài)機

圖3是一個遠程控制指令解析狀態(tài)機，它使用String Based Queued State Machine來實現(xiàn)。這樣的好處是，可以使用隊列來組織動作，較為靈活地實現(xiàn)各種不同組合以及復雜度。

每一個設備的狀態(tài)機都用一個獨立的vi來封裝，并且單獨進行測試，這樣也有利于工程化。

多狀態(tài)機的協(xié)作：

單個狀態(tài)機只能完成部分功能，我們需要把所有設備狀態(tài)機集成起來，按照一定的通訊機制拼裝成一個完整的機器人。

由于所有的設備狀態(tài)機都由一個VI來封裝，只需要把他們拖入一個主vi中，就能調(diào)用他們。如圖所示：

圖 4狀態(tài)機集成

狀態(tài)機之間是通過Shared Variable來實現(xiàn)接受外部指令輸入以及自身狀態(tài)輸出的。同樣，這些Shared Variable都用一個VI進行封裝以便進行管理。

這樣，一個狀態(tài)機便可視為一個子系統(tǒng)。既然是系統(tǒng)，自然有系統(tǒng)的輸入和輸出，通過get，set等方法的vi，外部系統(tǒng)便可對這些子系統(tǒng)進行操作或者交互。如圖所示，底盤狀態(tài)機使用getCommand.vi方法獲取外部命令。

圖 5 getCommand.vi

使用setCommand.vi方法讓外部系統(tǒng)傳輸命令給地盤狀態(tài)機。

圖6 MobileBase.lvlib:setCommand.vi

底盤使用sendState.vi發(fā)送底盤狀態(tài)機狀態(tài)信息。如圖所示：

圖 7 MobileBase.lvlib.sendState.vi

使用getState.vi方法獲取地盤狀態(tài)機信息。

圖 8 getState.vi

導航算法：

圖 9家居監(jiān)控機器人定位導航軟件控制框圖