基于PIC單片機的仿生機器魚的舵機控制
仿生機器魚實驗平臺屬于教育部和北京郵電大學共同出資支持的一項“國家級大學生創(chuàng)新性實驗計劃”項目,是一個集光、機、電、流體、智能于一體的實驗平臺,研究內(nèi)容包括:仿生機器魚機械結(jié)構(gòu)的研究,推薦效率的研究以及控制性能的研究。
1 仿生機器魚平臺簡介:
設(shè)計制作的機器魚模仿科魚類的外形,頭部采用剛性結(jié)構(gòu)的塑料材料。其形狀采用流線型,模仿真魚魚頭的形狀和大小比例。在魚頭的內(nèi)部空間里安裝電源及控制電路,并在魚頭兩側(cè)魚眼處及在頭前部的偏下側(cè)安裝了3 個紅外傳感器,構(gòu)成了一個探測左、前、右三個方向的傳感器網(wǎng)絡(luò),讓魚具有自助避障的功能。
使用鋁合金制作的魚骨架把三個舵機串聯(lián)起來,魚骨架支撐起套于舵機外面的橡膠魚皮,便構(gòu)成了了機器魚的魚身這個三關(guān)節(jié)的驅(qū)動系統(tǒng)。使用鋁合金制作的連接件將魚身通過螺紋連接的方式固定在在剛性魚頭上,魚身的橡膠魚皮使用熱熔膠粘在魚頭上,這樣便構(gòu)成了機器魚的整體結(jié)果。具體如圖1 所示。實驗證明,這種方法簡單易行,且方便拆卸和組裝。
機器魚技術(shù)指標:巡游速度:1.2~1.5m./s;全電量巡游距離:4.5~5.5 千米;轉(zhuǎn)彎半徑:15~20cm。
2.系統(tǒng)組成及工作原理:
從功能上看,整個魚體的系統(tǒng)可以分成三大塊,分別是:感知區(qū),決策區(qū),行為區(qū)。感知區(qū)對應(yīng)著多紅外傳感器網(wǎng)絡(luò)和無限傳輸模塊,而決策區(qū)指的是主控芯片(MCU),動作區(qū)對應(yīng)著舵機串聯(lián)組成的三關(guān)節(jié)驅(qū)動系統(tǒng)。具體如圖2所示。本系統(tǒng)的最重要的工作集中在對多舵機的協(xié)調(diào)控制,因此主要圍繞舵機的控制工作進行細致詳盡的介紹。
評論