智能機器人保姆
加入技術交流群
2.3.2 視頻設計
視頻采用的是已經(jīng)集成的模塊，其接線圖如下圖10所示：
圖10 視頻接線圖
設計中為了能夠提供很好的視頻效果，還專門設計了照明燈。其設計電路圖如圖11所示：
圖11 照明電路圖
同樣，為了使用者很好的視覺效果，攝像頭部分設計了移動云臺。攝像頭云臺的作用是通過遙控，控制云臺的兩個電機的轉動，帶動攝像頭運動，從而使得操作者能更好的觀察平臺端周圍的環(huán)境，獲得更多的信息，也能在一定程度上消除視覺死角，對機械手的運動操作更加方便。云臺的硬件如圖12所示，兩個小型直流減速電機成90度安裝，電機1的正反轉帶動攝像頭左右轉動，使攝像頭獲得可調(diào)的水平視角，電機2的正反轉帶動攝像頭的俯仰角度發(fā)生變化，使攝像頭獲得可調(diào)的俯仰視角，電機的控制和手臂驅動電機的控制方法和電路是一樣的。
圖12 云臺設計示意圖
2.3.3 智能機器人軟件設計
本設計采用結構化和模塊化的編程思想，二者相輔相成實現(xiàn)各模塊間的連接，各個模塊之間程序保持獨立，模塊之間通過入口參數(shù)和出口參數(shù)聯(lián)系，這樣有利于程序的調(diào)試與修改。
遙控端主程序設計
遙控端的主程序的任務是采集當前操作者的操作指令，對數(shù)據(jù)處理并發(fā)送給小車端，主程序完成遙控系統(tǒng)的初始化，AD轉換器初始化，串行數(shù)據(jù)端口初始化，IO口初始化，終端服務程序初始化，遙控端主程序流程圖如圖13所示。
串型數(shù)據(jù)傳輸程序
在遙控端，數(shù)據(jù)完成采集之后，需要無線發(fā)送給平臺端，作為控制信號來遙控平臺端的各個執(zhí)行機構完成操縱者的指令，單片機自帶兩個串行數(shù)據(jù)口，數(shù)據(jù)的傳輸使用到了單片機的串口0，將采集到的數(shù)據(jù)通過串行端口發(fā)送給無線收發(fā)模塊，模塊在接收到數(shù)據(jù)后，會自動的將數(shù)據(jù)轉存之后按照設定的波特率發(fā)送給接受端，接收端在接收到數(shù)據(jù)后會返回一個值給發(fā)送端，作為發(fā)確認接收和送下一數(shù)據(jù)的信號，這個過程由無線收發(fā)模塊自動完成。程序設計流程圖如圖14所示：
圖14串行數(shù)據(jù)發(fā)送程序流程圖
機械手控制程序設計
機械手的控制是通過分別控制5個舵機來控制的，在機械手控制程序中，根據(jù)舵機的控制原理，編程使得單片機能根據(jù)串口得到的遙控數(shù)據(jù)，計算出控制舵機的PWM波的占空比，并輸出這個占空比，由此來控制電機。程序設計框圖如圖15所示：
平臺端驅動程序設計
平臺端的驅動電機采用12V電壓供電的直流減速電機，電機控制信號通過光電隔離器，加載在LM298芯片上，實現(xiàn)單片機對電機的控制，對電機的控制也采用控制PWM波的占空比方式。程序設計框圖如圖16所示：
圖16 平臺驅動電機控制程序流程圖
總結
本次設計在開始采用的是模塊設計的思想，在設計過程遇到了不少的問題。同時最后沒有能夠最后完成所有模塊的組裝調(diào)試。遇到的主要問題有：
肌電檢測不準確，通過本文設計的電路和軟件檢測肌電信號很不準確，主要是由于設計原理過于簡單，所有器件誤差大，同時軟件上沒有很好的處理。從而導致機器人的控制部分沒有得到很好的解決，因此在機器人設計部分我們只有采用電位器的方式來進行調(diào)試。
在對機械手硬件制作的時候，先測試了用一塊單片機采集遙控臂上的電位器電壓信號，采用同一塊單片機的定時器B輸出PWM波來控制機械手，這個過程實現(xiàn)起來沒有太大的問題，但后當用一塊單片機A采集遙控信號，并通過無線模塊將數(shù)據(jù)發(fā)送至另一塊單片機B，單片機B根據(jù)接收到的數(shù)據(jù)產(chǎn)生PWM波來控制機械手，這時出現(xiàn)機械手控制失靈甚至失效的問題，從理論上來講，只要數(shù)據(jù)一致，定時器B產(chǎn)生的PWM波一致，就不會存在這個問題，但是在實際測試中結果卻不如同理論分析結果。
在對機器人軟件設計上很多BUG沒有處理的很好，比如機器人在得到控制命令后會有誤操作的情況，這是由于控制命令發(fā)來后，由于數(shù)據(jù)量相對較大，就造成了誤判的產(chǎn)生。同時在舵機的設計上沒有很好的硬件設計，有些時候給一個小幅度動作信號，但是手臂運動幅度很大。
評論