新聞中心
當(dāng)前位置: 首頁 - 新聞中心

傳感器與軟件在智能機器人中的設(shè)計運用

時間:2021-04-02 點擊次數(shù):

當(dāng)今社會,智能機器人的應(yīng)用越來越廣泛。可以預(yù)見,未來智能機器人的應(yīng)用將會越來越廣泛,從普通玩具機器人到工業(yè)控制機器人,從炒菜機器人到空間探測機器人。

該設(shè)計從全新的思路出發(fā),制造出一款日??赏娴闹悄苄≤?。

一是系統(tǒng)的總體設(shè)計。

智能化小車系統(tǒng)原理是將三維坐標(biāo)光學(xué)傳感器安裝在小車上,小車即具有智能感知功能,將隨目標(biāo)物的左右移動而隨車移動。

該系統(tǒng)包括3個主要組件:一為三維坐標(biāo)光感傳感器(ETOMS-ET21X111),用于采集目標(biāo)物體的移動坐標(biāo),使用非常簡單;

二為MCU(EMC-EM78P156),用于讀取傳感器數(shù)據(jù),控制電機轉(zhuǎn)動,市面上常用的是EM78P156,使用簡單,價格低廉;

三為電機,電機只需用普通直流電機即可,由PWM控制。

整個設(shè)計的功能簡單概括為:使小車可以跟隨人(或目標(biāo)物)前進。單獨來說需要實現(xiàn)以下三個小功能:傳感器能夠正確讀取X,Y,Z的坐標(biāo)值,這是最基本的條件。關(guān)鍵在于MCU能正確判斷X、Z坐標(biāo)值的大小變化。也許有些人會懷疑,為什么不判斷Y坐標(biāo)的變化?這是因為小車無法上下跳躍(上部和下部為Y軸)。其結(jié)果是,MCU根據(jù)坐標(biāo)值的大小控制電機轉(zhuǎn)向和電機PWM的時間。

硬件系統(tǒng)的設(shè)計與實現(xiàn)。

光學(xué)傳感器的周邊電路設(shè)計。

ET21X111是一種性能優(yōu)良的光傳感器,具有X,Y,Z坐標(biāo)數(shù)據(jù)輸出功能。

有以下特征:

速度數(shù)據(jù)輸出,每秒輸出坐標(biāo)數(shù)據(jù)高達75幀;

在2.7~3.5V電壓范圍內(nèi)工作的低壓;

以RS232標(biāo)準(zhǔn)的串行數(shù)據(jù)輸出格式輸出坐標(biāo)值;

采用外置晶振,范圍在0.5~12MHz,一般為3.58MHz;

有可控制的曝光界面EO4~EO7。

一是這四個界面都是用來控制曝光的,它們都可以通過軟件來控制,也可以通過硬件來控制??梢愿鶕?jù)自己的需要選擇合適的。該設(shè)計采用硬件方式,將四個接口均設(shè)置為高電平。

二是周圍有光學(xué)感應(yīng)器詳細的接口電路,由此可知EO4~EO7為高,這是曝光設(shè)置為硬件拉高,也可以在軟件上設(shè)置。當(dāng)IC運行時,RS232端口輸出坐標(biāo)數(shù)據(jù)。請注意圖2中4個LED是IRLED。集成電路的工作電壓為3.3V,系統(tǒng)的電源為5V。晶振外接用3.58MHz的IC,上電自動復(fù)位后就能正常工作。

MCU接口電路的設(shè)計。

單片機周邊控制電路的詳細設(shè)計。L-L+控制左邊路電機PWM,R+控制右路電機PWM。RS232接收輸入的傳感器坐標(biāo)。集成電路在3.3V電壓下工作,上機后自動復(fù)位。該系統(tǒng)時鐘采用4MHz的外部晶振。

三、左轉(zhuǎn)電機控制電路。

右邊的電機控制電路與左邊的相同,Q3、Q4采用PNP管,L+和L+不可同時為LOW,以免造成短路。

軟件體系結(jié)構(gòu)設(shè)計。

在系統(tǒng)上電之后,首先進行初始化,設(shè)置EMC78P156的寄存器,以便能夠中斷標(biāo)志寄存器,等待中斷。

當(dāng)發(fā)生中斷時進入中斷處理子程序,首先要關(guān)閉中斷標(biāo)志并保護現(xiàn)場,然后讀取并解析XYZ坐標(biāo)值,將其分為以下幾種情況。

判斷X軸變化,當(dāng)X值大于14小于17時,電機不左右轉(zhuǎn)動;當(dāng)Z值大于14小于17時,電機不左右轉(zhuǎn)動;當(dāng)Z值大于14小于17時,電機不左右轉(zhuǎn)動。

如果X軸坐標(biāo)值大于17,則判定Z軸坐標(biāo),若Z值大于17,則將右電機換向,然后將左電機轉(zhuǎn)向;若Z值小于14,則將左電機轉(zhuǎn)向,然后將左電機轉(zhuǎn)向,否則,電機不轉(zhuǎn)動。

傳感器設(shè)計技巧。

ET21X111對紅外光譜響應(yīng)最好,但是自然光中含有大量的紅外光,因此強烈的自然光會影響傳感器的數(shù)據(jù),造成輸出坐標(biāo)與實際坐標(biāo)的偏差較大,解決方法是加濾光片,但這也只能起到衰減作用,具體應(yīng)用要視情況而定。

電機控制電路設(shè)計技巧。

在設(shè)計控制電機正反向電路時要注意:由于MCU上電時I/O的狀態(tài)不確定,所以程序在開始時要將Q3、Q4的兩個I/O設(shè)為HI(Q3、Q4為PNP管,如果為NPN管則I/O設(shè)為LOW),以防止上電時兩個I/O均為LOW,從而使Q3、Q4導(dǎo)通形成短路。另需注意的是Q3、Q4在同一時間只能有一個引導(dǎo)。

MCU的設(shè)計技巧。

當(dāng)電刷直流電機啟動或轉(zhuǎn)動時,會產(chǎn)生大量的電源毛刺。這樣會嚴重影響MCU的工作,所以請加入這個LCπ型濾波器電路。

程序設(shè)計技巧。

在運行過程中,需要一邊讀取傳感器傳遞的坐標(biāo)數(shù)據(jù),一邊控制電機的PWM輸出信號;每隔12ms傳感器就會輸出一次坐標(biāo)數(shù)據(jù),因此最好的方法是使用中斷來讀取傳感器數(shù)據(jù),同時執(zhí)行PWM輸出的動作,而不需要輸出數(shù)據(jù)。

深圳市力準(zhǔn)傳感技術(shù)有限公司是專業(yè)研發(fā)生產(chǎn)高品質(zhì)、高精度力值測量傳感器的廠家。主要產(chǎn)品有微型傳感器、拉壓傳感器、S型傳感器、稱重傳感器、測力傳感器、扭矩傳感器、位移傳感器、等力控產(chǎn)品達千余種。

免責(zé)聲明:本文部分內(nèi)容源于網(wǎng)絡(luò),旨在傳遞和分享更多信息,如有侵犯您的權(quán)利,請聯(lián)系我們刪除。


推薦閱讀

Copyright ? 2013-2024 深圳市力準(zhǔn)傳感技術(shù)有限公司 版權(quán)所有  粵ICP備18107338號-1

業(yè)務(wù)咨詢 聯(lián)系方式 公眾號

微信咨詢1

微信咨詢2

微信咨詢3

服務(wù)熱線

0755-8923 3819

力準(zhǔn)公眾號

掃一掃,關(guān)注我們