單兵作戰(zhàn)用機(jī)器人控制系統(tǒng)設(shè)計(jì)
作者：
時(shí)間：2012-08-22
來(lái)源：網(wǎng)絡(luò)
收藏
加入技術(shù)交流群
掃碼加入
和技術(shù)大咖面對(duì)面交流
海量資料庫(kù)查詢(xún)
1．3 串 口
TMS320F2812的GPIOF4、GPIOF5配置成串口1，GPIOG4、GPIOG5配置成串口2。串口1接收GPS的信息，用來(lái)確定當(dāng)前機(jī)器人的位置信息；串口2連接機(jī)器人電臺(tái)，實(shí)現(xiàn)與遙操控終端電臺(tái)的無(wú)線傳輸。機(jī)器人電臺(tái)連接攝像頭和麥克之后，能夠把影音信息傳送到遙操控終端的電臺(tái)，遙操控終端的工作人員即可接收到機(jī)器人附近的視頻、音頻信息。
1．4 電機(jī)控制
機(jī)器人的前進(jìn)、后退、左轉(zhuǎn)、右轉(zhuǎn)由左履帶電機(jī)和右履帶電機(jī)控制。機(jī)器人上的武器通過(guò)做上下、左右調(diào)節(jié)來(lái)瞄準(zhǔn)目標(biāo)。
DSP的XINTF是其外部接口，這里使用了XD0-XD11共12根數(shù)據(jù)線，經(jīng)過(guò)電平轉(zhuǎn)換為5 V電平后，連接到D／A轉(zhuǎn)換芯片。D／A轉(zhuǎn)換芯片選用了12位的AD664，可輸出4路0～5V模擬電壓，4路模擬電壓作為控制電壓輸入到電機(jī)控制器，分別控制機(jī)器人左履帶電機(jī)、右履帶電機(jī)、武器上下調(diào)節(jié)電機(jī)、武器左右調(diào)節(jié)電機(jī)。
當(dāng)電壓為2．5 V時(shí)，電機(jī)停轉(zhuǎn)；電壓小于2．5 V時(shí)，電機(jī)反轉(zhuǎn)；電壓大于2．5 V時(shí)，電機(jī)正轉(zhuǎn)。對(duì)于左履帶和右履帶，通過(guò)輸出的控制電壓，可實(shí)現(xiàn)車(chē)體前進(jìn)、后退的無(wú)級(jí)變速，以及左、右轉(zhuǎn)彎的運(yùn)動(dòng)控制。
1．5 電源供電電路
鋰電池具有體積小、重量輕、容量大的特點(diǎn)。機(jī)器人內(nèi)置2組24 V供電電池。第1組24 V電池為左履帶電機(jī)、右履帶電機(jī)、武器上下調(diào)節(jié)電機(jī)、武器左右調(diào)節(jié)電機(jī)供電。第2組24 V電池經(jīng)過(guò)DC／DC模塊．轉(zhuǎn)換成12 V電壓和5 V電壓。12 V電壓用來(lái)給機(jī)器人上的無(wú)線電臺(tái)供電。5 V電壓為控制電路供電，同時(shí)經(jīng)過(guò)電源轉(zhuǎn)換電路，轉(zhuǎn)換成3．3 V和1．8 V電壓為DSP供電。為了監(jiān)測(cè)DSP芯片供電電壓是否正常，增加了電壓監(jiān)控電路，當(dāng)DSP芯片供電不正常時(shí)，可將此故障報(bào)送到電臺(tái)發(fā)送到遙操控終端。本文引用地址：http://www.butianyuan.cn/article/160068.htm
2 單兵作戰(zhàn)用機(jī)器人控制系統(tǒng)軟件設(shè)計(jì)
單兵作戰(zhàn)用機(jī)器人控制系統(tǒng)軟件分為主程序和中斷服務(wù)程序兩部分。主程序?qū)崿F(xiàn)的流程如圖5所示，上電初始化處理器的I／O端口、A ／D端口、串口等資源，初始化完畢開(kāi)始與遙操控終端軟件進(jìn)行通信，握手成功后，開(kāi)啟軟件定時(shí)器、中斷，定時(shí)采集機(jī)器人信息，包括超聲波避障、電量測(cè)量值、GPS信息。
評(píng)論