《電子技術應用》
您所在的位置:首頁 > 嵌入式技術 > 設計應用 > 單兵作戰(zhàn)用機器人控制系統(tǒng)設計
單兵作戰(zhàn)用機器人控制系統(tǒng)設計
摘要: 單兵作戰(zhàn)用機器人方便攜帶,、操控簡單、可代替人類到達危險環(huán)境作戰(zhàn),。機器人通過無線電臺接收遙操控終端發(fā)送的控制指令,,按照指令行動;同時機器人采集自身的狀態(tài)信息,,發(fā)回遙操控終端,。手持遙操控終端的士兵能夠方便的控制機器人,并實時掌握機器人的狀態(tài)信息,。文中詳細介紹了單兵作戰(zhàn)用機器人的控制系統(tǒng)硬件和軟件設計,。
Abstract:
Key words :

作者:張愛麗

    單兵作戰(zhàn)機器人體積小,方便單兵野外作戰(zhàn)時攜帶,,可完成偵察,、作戰(zhàn)、排爆等任務,。機器人能夠代替人類到達不方便到達或危險的環(huán)境,,確保了士兵的安全。車體是履帶式設計,,行動平穩(wěn),。

1 單兵作戰(zhàn)用機器人控制系統(tǒng)硬件設計

    為了實現士兵對機器人的實時控制,需要配合使用遙操控終端,。機器人與遙操控終端的工作原理如圖1所示,。

a.JPG

    遙操控終端通過按鈕,、開關、搖桿采集工作人員的操控指令,,將操控指令轉換成數據,,按照規(guī)定的格式通過串口發(fā)給無線電臺,無線電臺將該數據發(fā)送出去,;機器人控制系統(tǒng)的無線電臺接收到來自操控終端的控制指令后,,按照操控指令控制機器人運動、武器擊發(fā),,同時機器人控制系統(tǒng)采集機器人的GPS位置,、電池電量、超聲波避障信息等,,把機器人信息打包后通過機器人上的無線電臺發(fā)送給遙操控終端的電臺,,遙操控終端接收到機器人信息后,將其顯示在人機界面上,,以備士兵隨時掌握機器人的實時信息,。

    單兵作戰(zhàn)用機器人控制系統(tǒng)是基于DSP芯片及與其外圍電路、電源電路組成,。DSP芯片選用TMS320F2812,。TMS320F2812是美國TI公司推出的C2000平臺上的定點32位DSP芯片,主頻150 MHz,、處理性能可達150 MIPS,,每條指令周期6.67 ns。

TMS320F2812包括4M可尋址程序空間和4M可尋址數據空間,。同時片內具有128×16位的FLASH存儲器和18K×16位的SRAM,。TMS320F2812采用3_3 V和1.8 V供電,功耗低,。TMS320F28 12的外部接口非常豐富,,16路12位的ADC采集通道,SPI,、SCI通信模塊,多達56個復用I/O引腳,。

b.JPG

    單兵作戰(zhàn)用機器人控制系統(tǒng)組成如圖2所示,。

1.1 I/O端口

    TMS320F2812的GPIOA0-GPIOA3口設置成基本輸入輸出端口,端口配置及屬性如表1所示,。

c.JPG

    超聲波避障信號用于探測機器人前方0.5 m內是否有障礙物,,如遇到障礙物,機器人可自動轉彎避開,。武器擊發(fā)開關用于機器人上武器的擊發(fā)控制,,手電開關用于機器人上手電的開關控制,,攝像頭廣窄角選擇用于機器人上攝像頭的廣角與窄角的切換。

1.2 A/D端口

    TMS320F2812的A/D轉換器模塊共有16個通道,,模擬電壓的輸入范圍是0~3 V,。這里用了其中的2個通道,分別用來測量機器人上的2塊24 V鋰電池的電量,。圖3中電量測量電路分為3個部分:差分比例1:10電路,,把24 V電壓轉換到0~2.4 V區(qū)間;隔離比例1:1電路,,能有效的隔離輸入電壓與DSP的前端接口,;電壓鉗位電路,將輸入到DSP端口的電壓鉗位在3.3 V以內,,防止電源電壓意外浪涌時損壞DSP的A/D轉換端口,。2路24 V電池電壓分別經過2路電量測量電路后,輸入到DSP的ADCINA0,、ADCINA2兩個端口,,根據采集到的電壓值,可計算當前電池的電壓,,從而確定電池電量,。

d.JPG

1.3 串 口

    TMS320F2812的GPIOF4、GPIOF5配置成串口1,,GPIOG4,、GPIOG5配置成串口2。串口1接收GPS的信息,,用來確定當前機器人的位置信息,;串口2連接機器人電臺,實現與遙操控終端電臺的無線傳輸,。機器人電臺連接攝像頭和麥克之后,,能夠把影音信息傳送到遙操控終端的電臺,遙操控終端的工作人員即可接收到機器人附近的視頻,、音頻信息,。

1.4 電機控制

    機器人的前進、后退,、左轉,、右轉由左履帶電機和右履帶電機控制。機器人上的武器通過做上下,、左右調節(jié)來瞄準目標,。

    DSP的XINTF是其外部接口,這里使用了XD0-XD11共12根數據線,,經過電平轉換為5 V電平后,,連接到D/A轉換芯片,。D/A轉換芯片選用了12位的AD664,可輸出4路0~5V模擬電壓,,4路模擬電壓作為控制電壓輸入到電機控制器,,分別控制機器人左履帶電機、右履帶電機,、武器上下調節(jié)電機,、武器左右調節(jié)電機。
    當電壓為2.5 V時,,電機停轉,;電壓小于2.5 V時,電機反轉,;電壓大于2.5 V時,,電機正轉。對于左履帶和右履帶,,通過輸出的控制電壓,,可實現車體前進、后退的無級變速,,以及左,、右轉彎的運動控制。

1.5 電源供電電路

    鋰電池具有體積小,、重量輕,、容量大的特點。機器人內置2組24 V供電電池,。第1組24 V電池為左履帶電機,、右履帶電機、武器上下調節(jié)電機,、武器左右調節(jié)電機供電,。第2組24 V電池經過DC/DC模塊.轉換成12 V電壓和5 V電壓。12 V電壓用來給機器人上的無線電臺供電,。5 V電壓為控制電路供電,,同時經過電源轉換電路,轉換成3.3 V和1.8 V電壓為DSP供電,。為了監(jiān)測DSP芯片供電電壓是否正常,,增加了電壓監(jiān)控電路,當DSP芯片供電不正常時,,可將此故障報送到電臺發(fā)送到遙操控終端。

e.JPG

2 單兵作戰(zhàn)用機器人控制系統(tǒng)軟件設計

    單兵作戰(zhàn)用機器人控制系統(tǒng)軟件分為主程序和中斷服務程序兩部分,。主程序實現的流程如圖5所示,,上電初始化處理器的I/O端口,、A /D端口、串口等資源,,初始化完畢開始與遙操控終端軟件進行通信,,握手成功后,開啟軟件定時器,、中斷,,定時采集機器人信息,包括超聲波避障,、電量測量值,、GPS信息。

f.JPG

當串口2即機器人無線電臺出現接收數據中斷時,,表明接受到來自遙操控終端的控制數據,,此時處理器進入中斷服務程序,如圖6所示,。中斷程序首先將串口2接收到的數據保存到寄存器,,然后將最新采集的機器人信息按照預定格式發(fā)送到串口2,通過機器人無線電臺發(fā)送給遙操控終端,。程序還需要根據串口2所接到的數據,,按照預定的格式分配到處理器的各個端口,實現遙操控終端的控制指令,,包括武器擊發(fā)開關,、手電開關、攝像頭廣角窄角切換,、左履帶電機轉動方向和速度,、右履帶電機轉動方向和速度、武器高低轉動方向和速度,、武器左右轉動方向和速度,。

g.JPG

3 結束語

    單兵作戰(zhàn)用機器人便于攜帶、操控簡單,、可廣泛應用于軍隊,、武警部隊。文中所設計的單兵作戰(zhàn)用機器人控制系統(tǒng)實時性高,、設計合理,,理論試驗驗證可行,在實際應用中得到了用戶的認可,。

此內容為AET網站原創(chuàng),,未經授權禁止轉載。