本項目基於FPGA，以FPGA為核心
，製作一個電動小車控製器，使小車能夠自動沿一個寬30cm

，長160cm的de翹qiao翹qiao板ban尋xun跡ji行xing駛shi，並bing能neng調tiao節jie小xiao車che位wei置zhi使shi翹qiao翹qiao板ban傾qing斜xie某mou一yi設she定ding角jiao度du


，保bao持chi靜jing止zhi平ping衡heng。當dang另ling有you外wai力li使shi翹qiao翹qiao板ban失shi衡heng時shi
，小xiao車che自zi動dong尋xun找zhao新xin的de平ping衡heng點dian
，使shi翹qiao翹qiao板ban重zhong新xin達da到dao平ping衡heng。如ru圖tu1、圖2所示。係統靜態誤差小於1度，超調量小於10％。xiangmuzhizuozhong
，jiangtongguolilunyanjiuhefanfushiyanduikongzhisuanfahekongzhicanshujinxingyouhualiqiudadaozuikuaitiaojiesuduhezuixiaowucha，weikongzhigongchengtigongyigezhenshidewulifangzhenshiyanzhuangzhi。

 

圖一
 

圖二

 

 

 

benxiangmuyuqianqiyizuolejiaoweichongfendelilunzhunbeigongzuo，jingguoliluntuidao，jianlileshoukongduixianghekongzhixitongdeshuxuemoxing，yanjiuhebijiaolexitongdexiangguankongzhisuanfa。xiangmuchetibufen、光電傳感器部分、電機驅動部分

、角度傳感器部分
、信號調理放大電路、電機驅動電路、xitonggongdiandianludengbujianjunyishejizhizuowancheng，youguandewaiweidianluyinzhibanyeyihanjietiaoshichenggong，bingfenbietongguotiaoshi。muqianzhengzaiduixitongjinxingyouhuahegaijin
，bingzheshoubianxiechengxu，daihuodeFPGA開發平台後，即可開始程序調試及係統聯調實驗。

 

 

本項目的關鍵技術在於利用FPGAdekuaisushujuchuligongnenghefengfulinghuodejiekouziyuan，jianliyigenengduixiaocheqiaoqiaobanxitongjinxingkongzhideyingjianpingtai，zaicijichushangyanjiugezhongkongzhisuanfa，yingyongshiyanpingtaiduikongzhisuanfajinxingyanzheng
，duiqiaoqiaobandefeiwendingpinghengzhuangtaijinxingyouxiaodekongzhi
，shizhichuyupinghengjingzhizhuangtaibingnenggoubaochi。benxiangmudeshoukongduixiangshiyigefeixianxinggaojiexitong
，zaikongzhilingyuzhongshirenmenganxingqueryounanyibeikongzhideguocheng，qixiangguanyanjiujielunkeyingyongyufeixingqizitaikongzhi、機器人平衡控製等方麵，涉及非線性信號處理、非線性控製、控製參數自動優化等技術。

 

本項目的創新點在於

，把FPGA的高速並行數據處理特性綜合應用到了一個在控製領域中人們所感興趣而又難以被控製的非穩定受控過程中，利用FPGA為(wei)控(kong)製(zhi)係(xi)統(tong)研(yan)究(jiu)提(ti)供(gong)了(le)一(yi)個(ge)通(tong)用(yong)性(xing)好(hao)，廉(lian)價(jia)而(er)實(shi)用(yong)的(de)實(shi)驗(yan)平(ping)台(tai)，為(wei)理(li)論(lun)研(yan)究(jiu)結(jie)果(guo)建(jian)立(li)一(yi)個(ge)實(shi)驗(yan)物(wu)質(zhi)條(tiao)件(jian)，增(zeng)強(qiang)理(li)論(lun)和(he)實(shi)踐(jian)的(de)相(xiang)結(jie)合(he)。同(tong)時(shi)，該(gai)項(xiang)目(mu)富(fu)有(you)趣(qu)味(wei)性(xing)和(he)知(zhi)識(shi)性(xing)，可(ke)以(yi)激(ji)發(fa)更(geng)多(duo)電(dian)子(zi)愛(ai)好(hao)者(zhe)的(de)興(xing)趣(qu)，擴(kuo)大(da)FPGA的應用層麵。

 

 

小xiao車che平ping衡heng態tai的de控kong製zhi類lei似si於yu倒dao立li擺bai，但dan又you有you所suo不bu同tong。倒dao立li擺bai控kong製zhi已yi經jing有you較jiao多duo的de研yan究jiu，並bing已yi應ying用yong於yu機ji器qi人ren平ping衡heng，飛fei行xing器qi姿zi態tai控kong製zhi等deng。理li論lun和he實shi踐jian都dou證zheng明ming係xi統tong是shi可ke實shi現xian的de。小xiao車che的de控kong製zhi采cai樣yang周zhou期qi大da約yue毫hao秒miao數shu量liang級ji就jiu可ke滿man足zu基ji本ben要yao求qiu，所suo以yi
，FPGA的速度完全可以滿足要求。而FPGA所suo具ju有you的de靈ling活huo的de邏luo輯ji組zu合he配pei置zhi，足zu以yi完wan成cheng小xiao車che運yun行xing所suo需xu要yao的de控kong製zhi邏luo輯ji和he運yun行xing協xie調tiao。係xi統tong所suo使shi用yong的de各ge傳chuan感gan器qi及ji其qi信xin號hao調tiao理li電dian路lu已yi經jing調tiao試shi成cheng功gong。這zhe些xie先xian行xing工gong作zuo和he已yi成cheng熟shu技ji術shu為wei係xi統tong的de成cheng功gong實shi現xian提ti供gong聯lian保bao證zheng條tiao件jian。在zai可ke靠kao性xing方fang麵mian，係xi統tong各ge部bu件jian之zhi間jian的de連lian接jie將jiang采cai用yong高gao可ke靠kao的de連lian接jie器qi件jian
，並bing用yong熱re封feng膠jiao密mi封feng
，機ji械xie緊jin固gu件jian采cai取qu鎖suo緊jin措cuo施shi。由you於yu係xi統tong不bu與yu外wai界jie電dian氣qi連lian接jie
，不bu存cun在zai共gong模mo電dian壓ya幹gan擾rao，因yin此ci不bu考kao慮lv使shi用yong光guang電dian隔ge離li。在zai軟ruan件jian方fang麵mian，采cai用yong看kan門men狗gou定ding時shi器qi
，保bao證zheng係xi統tong程cheng序xu跑pao飛fei後hou能neng夠gou自zi動dong恢hui複fu運yun行xing。

 

圖3

 

 

 

係統框圖如圖3所示，主控循環程序每隔一個采樣周期從FPGAjiekouzhongduqugegechuanganqideshuzhi，bingjingguochulihouhuodexiaochedeyunxingzhuangtai，genjuxiaochededangqianzhuangtaicaiquxiangyingdekongzhisuanfajisuanchudianjisuoxudekongzhidianyazhi，jiner
，gaikongzhidianyazhijingguoPMWchulihoushuchudaoxiaochequdongdianji，shixiaocheanzhaoxiwangdeguilvyundong。weileshichengxuliuchengqingxijianjie
，kuangtuzhongyiyigebiaozhixinhaolaijiluxiaochesuoyunxingdejieduan，kongzhiqizegenjuxiaochesuochudeyunxingjieduanjinxingxiangyingdekongzhi。

 

 

 

 

genjubenxitongsuoxudadaogongnengyaoqiuhexingnengyaoqiu，xitongxuyaowanchengchuanganqimoniliangdeshujucaijiheguangdianchuanganqidianpingshujudecaiji，xuyaoduicaijideshujujinxingchuliheshuchu，xuyaoduixiaochedezhuangtaijinxingpanduanhekongzhideng。Spartan-3E芯片（XC3S500E-4FG320C）具有速度高，接口豐富等特點，根據係統要求和所要完成的功能，Spartan-3E芯片（XC3S500E-4FG320C）配以相應的開發環境，完全可以完成係統控製要求，且價廉實惠

，開發過程快捷，簡單易行。為了能夠使用Spartan-3E初級板，本項目需要與Spartan-3E初級板相配套的開發軟件和編譯調試工具和環境。

 

 

在本方案中需要研製、開發的功能主要模塊

，以及開發的方式

 

本方案中，所要研製的硬件模塊包括：1）尋跡用紅外光電傳感器模塊及其波形整形電路
，2）用於檢測小車運行位移和速度的紅外光電編碼器模塊，3）用於為不同元件提供不同電壓的電源變換模塊

，4）用於檢測小車傾角的角度傳感器信號調理模塊，5）用於驅動直流伺服電機的驅動模塊，6）用於顯示係統狀態和輸入指令的人機界麵模塊，7）AD轉換模塊，8）碰觸檢測模塊
，8）在擴展功能中
，用於擴大檢測小車狀態的視頻處理模塊，等等。

 

軟件係統中也按模塊編程，包括：1）人機交互模塊，2）電機驅動PWM運算模塊
，3）平衡控製計算模塊
，4）運行軌跡尋找與跟蹤模塊，信號檢測及標度模塊
，5）係統協調模塊

 

 

該gai項xiang目mu將jiang完wan成cheng小xiao車che的de自zi動dong尋xun跡ji和he平ping衡heng控kong製zhi

，平ping衡heng保bao持chi時shi間jian可ke按an照zhao要yao求qiu任ren意yi設she定ding。小xiao車che在zai引yin導dao線xian的de引yin導dao下xia自zi動dong登deng爬pa蹺qiao蹺qiao板ban，並bing在zai平ping衡heng位wei置zhi達da到dao靜jing態tai平ping衡heng。從cong登deng陸lu蹺qiao蹺qiao板ban到dao進jin入ru平ping衡heng狀zhuang態tai所suo需xu時shi間jian不bu大da於yu20秒。係統靜態誤差小於1度
，超調量小於10％。在基本功能實現的情況下，將進一步優化參數
，提高運行速度和減少調節時間和靜態誤差。

 

 

1.設計輸入輸出功能子板

子板功能為：1）產生係統所需的各種電壓，為係統各部件提供電源。2）為角度傳感器提供參考電源，對角度傳感器的輸出信號進行放大調理
，並進行AD轉換，得到與角度成比例的數字信號。3）將紅外光電傳感器的電壓信號整形為標準邏輯電平。4）將控製信號放大
，為直流電機提供驅動能力。

 

子板接口為標準pin口，使用標準接插件。

 

2.測試設備

PC機、萬用表、直流穩壓電源
、秒表
、卷尺
、量角器等

 

3.方針、開發工具

Spartan-3E初級板，ISE9.1，Modesim se，EDK9.1
，Synplify pro
，Chipscope pro9.1


相關推薦閱讀：

我愛快包——電子工程師的外快錢包