當(dāng)前位置:首頁(yè) > 模擬 > 模擬
[導(dǎo)讀]大多數(shù)關(guān)節(jié)臂式測(cè)量機(jī)通過(guò)臂內(nèi)電纜傳輸角度信號(hào),導(dǎo)致各關(guān)節(jié)不能無(wú)限旋轉(zhuǎn)。針對(duì)該問(wèn)題,本文設(shè)計(jì)了一套可用于關(guān)節(jié)臂式測(cè)量機(jī)的“基于ZigBee技術(shù)的角度同步采集傳輸系統(tǒng)”,通過(guò)在測(cè)量機(jī)各關(guān)節(jié)內(nèi)安裝ZigBee無(wú)線模塊,可實(shí)現(xiàn)各關(guān)節(jié)角度的同步采集和無(wú)線傳輸,克服了測(cè)量機(jī)關(guān)節(jié)不能無(wú)限旋轉(zhuǎn)的缺陷。

0 引言
關(guān)節(jié)臂式測(cè)量機(jī)廣泛用于模具、汽車零部件、鈑金件、塑料制品、木制品、雕塑等的快速檢測(cè)和逆向設(shè)計(jì)。其工作機(jī)理是:手持關(guān)節(jié)臂,帶動(dòng)測(cè)量機(jī)頂端的攝像頭或探針掃描至目標(biāo)探測(cè)點(diǎn),根據(jù)測(cè)量機(jī)各段臂長(zhǎng)和各個(gè)關(guān)節(jié)所轉(zhuǎn)過(guò)的角度可求取出目標(biāo)探測(cè)點(diǎn)的位置或坐標(biāo)。測(cè)量機(jī)的工作關(guān)鍵在于讀取和及時(shí)傳輸各個(gè)關(guān)節(jié)的角度信息。
普通的關(guān)節(jié)臂式測(cè)量機(jī)在每個(gè)關(guān)節(jié)內(nèi)都安裝有一個(gè)角度編碼盤(pán),角度信號(hào)通過(guò)連接在關(guān)節(jié)臂內(nèi)的電纜線傳輸至工控機(jī)。由于編碼器使用有線方式傳輸角度信息,臂內(nèi)電纜多,連續(xù)旋轉(zhuǎn)多圈時(shí)臂內(nèi)電纜將擰成“麻花”,使得測(cè)量機(jī)關(guān)節(jié)不能無(wú)限旋轉(zhuǎn)。
本文所設(shè)計(jì)的“基于ZigBee技術(shù)的角度同步采集傳輸系統(tǒng)”,采用Microchip公司的PIC18LF4620微控制器和Chipcon公司的CC2420射頻芯片共同組成無(wú)線節(jié)點(diǎn),置于關(guān)節(jié)臂式測(cè)量機(jī)的每個(gè)關(guān)節(jié)內(nèi),實(shí)現(xiàn)角度信號(hào)的讀取和無(wú)線傳輸。在工控機(jī)側(cè),也安裝有一個(gè)無(wú)線節(jié)點(diǎn),用于接收這些無(wú)線傳輸?shù)慕嵌刃畔⒉⑸蟼鹘o工控機(jī)。信號(hào)傳輸?shù)臒o(wú)線化使得測(cè)量機(jī)的關(guān)節(jié)可以無(wú)限制旋轉(zhuǎn)。下面主要以六關(guān)節(jié)臂式測(cè)量機(jī)為例,介紹該系統(tǒng)的設(shè)計(jì)方案。
1. 系統(tǒng)方案設(shè)計(jì)
整個(gè)系統(tǒng)實(shí)質(zhì)上為一個(gè)由7個(gè)無(wú)線節(jié)點(diǎn)組成的星形無(wú)線網(wǎng)絡(luò),如圖1所示。安裝在測(cè)量機(jī)6個(gè)關(guān)節(jié)內(nèi)的無(wú)線節(jié)點(diǎn)分別和本關(guān)節(jié)內(nèi)的角度編碼盤(pán)相連,采集編碼盤(pán)信息,并將提取出來(lái)的有效角度信息無(wú)線發(fā)送出去,構(gòu)成星形網(wǎng)絡(luò)的6個(gè)網(wǎng)絡(luò)節(jié)點(diǎn)(以下稱為子節(jié)點(diǎn))。作為網(wǎng)絡(luò)協(xié)調(diào)器的無(wú)線節(jié)點(diǎn)(以下稱為主節(jié)點(diǎn))和工控機(jī)相連,采用時(shí)分復(fù)用的方式接收6個(gè)子節(jié)點(diǎn)無(wú)線傳輸?shù)慕嵌刃畔?,?jīng)整理后通過(guò)串口發(fā)送給工控機(jī)。
 
500)this.style.width=500;" border="0" />
 每個(gè)無(wú)線節(jié)點(diǎn)由控制模塊和射頻模塊組成。控制模塊主芯片是PIC18LF4620,最高工作頻率為40MHz,內(nèi)含64kBytes的flash空間和4kBytes的RAM空間,外圍控制部分包括定時(shí)器模塊,捕捉/比較模塊,A/D轉(zhuǎn)換模塊,SPI接口和EUSART串口等,完成系統(tǒng)的控制和處理功能。射頻模塊用于實(shí)現(xiàn)信息無(wú)線收發(fā),主芯片為CC2420,符合2.4 GHz IEEE 802.15.4協(xié)議,無(wú)線收發(fā)速率可達(dá)250kbps,無(wú)線收發(fā)功率僅為幾十毫瓦。
2. 系統(tǒng)硬件結(jié)構(gòu)及連接圖
系統(tǒng)的硬件連接圖如圖2所示,元件主要包括射頻芯片CC2420、微控制器PIC18LF4620和串口電平轉(zhuǎn)換芯片MAX3221。對(duì)外提供的接口為RS232/485串口(圖2中以RS232為例)。每個(gè)無(wú)線節(jié)點(diǎn)內(nèi)部,控制模塊(PIC18LF4620)和射頻模塊(CC2420)通過(guò)SPI接口連接,主要包括串行數(shù)據(jù)輸出引腳(SDO)、 串行數(shù)據(jù)輸入(SDI)引腳和串行時(shí)鐘(SCK)引腳。對(duì)于主節(jié)點(diǎn),微控制器的串口輸出引腳(TX)和串口輸入引腳(RX)經(jīng)由電平轉(zhuǎn)換芯片MAX3221和工控機(jī)相連。對(duì)于子節(jié)點(diǎn),微控制器通常通過(guò)RS232/RS485串口和編碼盤(pán)相連,具體接口視編碼盤(pán)型號(hào)而定。
 
500)this.style.width=500;" border="0" />


3. 組網(wǎng)過(guò)程
7個(gè)無(wú)線節(jié)點(diǎn)組成一個(gè)星形無(wú)線網(wǎng)絡(luò),以主節(jié)點(diǎn)為協(xié)調(diào)器,6個(gè)子節(jié)點(diǎn)為網(wǎng)絡(luò)節(jié)點(diǎn)。組網(wǎng)的過(guò)程可以描述如下:
(1) 將主節(jié)點(diǎn)和所有子節(jié)點(diǎn)的無(wú)線收發(fā)頻率置于同一信道,確保該信道上無(wú)其它無(wú)線設(shè)備。
(2) 主節(jié)點(diǎn)無(wú)線發(fā)送組網(wǎng)廣播,告知同信道的所有處于接收狀態(tài)的無(wú)線設(shè)備(各子節(jié)點(diǎn))自己為網(wǎng)絡(luò)協(xié)調(diào)器,并告知該網(wǎng)絡(luò)的PAN ID,以及主節(jié)點(diǎn)自己的64位MAC地址。同時(shí),設(shè)定廣播報(bào)文的最大重傳次數(shù),并開(kāi)啟廣播超時(shí)定時(shí)器。
(3) 各個(gè)子節(jié)點(diǎn)在接收到廣播之后回應(yīng)一個(gè)網(wǎng)絡(luò)連接請(qǐng)求。
(4) 當(dāng)主節(jié)點(diǎn)收到子節(jié)點(diǎn)的網(wǎng)絡(luò)連接請(qǐng)求時(shí),主節(jié)點(diǎn)給該子節(jié)點(diǎn)分配16位的網(wǎng)絡(luò)地址。
(5) 定時(shí)器超時(shí),主節(jié)點(diǎn)檢查是否收到了所有子節(jié)點(diǎn)的網(wǎng)絡(luò)連接請(qǐng)求。“是”則停止組網(wǎng)廣播,組網(wǎng)成功?!胺瘛眲t重傳組網(wǎng)廣播,重傳次數(shù)減1。
(6) 重復(fù)步驟(5),若重傳次數(shù)已經(jīng)自減為0,停止組網(wǎng)廣播,組網(wǎng)結(jié)束,并告知工控機(jī)本次組網(wǎng)失敗。
4. 數(shù)據(jù)傳輸
4.1 幀格式定義
在本文所設(shè)計(jì)的星形無(wú)線網(wǎng)絡(luò)中,共分為物理層、MAC層和應(yīng)用層3層,各層的幀格式如圖3所示。網(wǎng)間傳輸?shù)男畔膸愋蜕戏譃?種,分別為數(shù)據(jù)幀、確認(rèn)幀和命令幀,組網(wǎng)廣播幀和角度采集廣播歸屬于命令幀。
 
500)this.style.width=500;" border="0" />


注:Frame Length為物理層幀長(zhǎng)度;Frame Control域的低3位指示該信息的幀類型;Sequence NO.為序列號(hào);FCS為校驗(yàn)域。Command Type為命令類型,指示收到命令幀之后無(wú)線節(jié)點(diǎn)所需進(jìn)行的操作。
4.2 TDMA時(shí)隙分配和傳輸協(xié)議
主節(jié)點(diǎn)和各子節(jié)點(diǎn)采取時(shí)分復(fù)用TDMA的方式進(jìn)行通信,每個(gè)子節(jié)點(diǎn)在指定的時(shí)隙內(nèi)和主節(jié)點(diǎn)進(jìn)行信息交互。在本文所設(shè)計(jì)的星型無(wú)線網(wǎng)絡(luò)中,共劃分有8個(gè)時(shí)隙,如圖4所示。
 
500)this.style.width=500;" border="0" />


前6個(gè)時(shí)隙內(nèi),主節(jié)點(diǎn)依次對(duì)各子節(jié)點(diǎn)進(jìn)行輪詢,獲取角度信息并對(duì)其進(jìn)行校驗(yàn)。后2個(gè)時(shí)隙用于重傳,當(dāng)1個(gè)或多個(gè)子節(jié)點(diǎn)的信息丟失或校驗(yàn)發(fā)生錯(cuò)誤時(shí),采取“先丟失/出錯(cuò),先重傳”的方式進(jìn)行重傳。
每個(gè)時(shí)隙內(nèi),主節(jié)點(diǎn)發(fā)送“開(kāi)始傳輸角度信息”的命令幀至指定子節(jié)點(diǎn),并啟動(dòng)時(shí)隙超時(shí)定時(shí)器。子節(jié)點(diǎn)在接收到該命令幀后,立刻將從編碼盤(pán)信息中提取出的有效角度信息封裝成幀,經(jīng)由射頻模塊發(fā)送給主節(jié)點(diǎn)。當(dāng)定時(shí)器超時(shí)時(shí),主節(jié)點(diǎn)若還未收到該子節(jié)點(diǎn)的角度信息幀,或收到角度信息幀但校驗(yàn)錯(cuò)誤,則記錄該子節(jié)點(diǎn)的編號(hào)(以便在重傳時(shí)隙內(nèi)令其重發(fā)),并轉(zhuǎn)入輪詢下一子節(jié)點(diǎn)。若接收到正確報(bào)文,則直接轉(zhuǎn)入下一子節(jié)點(diǎn)的輪詢。
4.3 子節(jié)點(diǎn)采集時(shí)刻同步
組網(wǎng)完成之后,主節(jié)點(diǎn)無(wú)線發(fā)送角度采集廣播給各個(gè)子節(jié)點(diǎn),指示其以一定頻率采集編碼盤(pán)信息,提取并發(fā)送有效的角度信息。由于主節(jié)點(diǎn)以無(wú)線方式發(fā)送角度采集廣播,該廣播到達(dá)各個(gè)子節(jié)點(diǎn)的時(shí)間可能并不一致。若子節(jié)點(diǎn)在收到該廣播后立刻開(kāi)始讀取編碼盤(pán)信息,子節(jié)點(diǎn)所讀到并提取的關(guān)節(jié)角度并不是同一時(shí)刻點(diǎn)的,導(dǎo)致測(cè)量機(jī)無(wú)法準(zhǔn)確工作,所以需要有“子節(jié)點(diǎn)采集時(shí)刻同步”的環(huán)節(jié)。
我們采取的做法是:在組網(wǎng)完成之后,主節(jié)點(diǎn)發(fā)送角度采集廣播之前, 6個(gè)子節(jié)點(diǎn)逐一與主節(jié)點(diǎn)進(jìn)行信息交互,子節(jié)點(diǎn)求取出信息幀的空中傳輸時(shí)間ti(i為子節(jié)點(diǎn)的編號(hào),i=1,2…6;)。當(dāng)所有子節(jié)點(diǎn)接收到主節(jié)點(diǎn)發(fā)送的角度采集廣播后,分別延遲(T – ti)時(shí)間再采集編碼盤(pán)信息,其中T為常數(shù),T>max[t1, t2, …t6]。那么,從主節(jié)點(diǎn)發(fā)送角度采集廣播的那一時(shí)刻開(kāi)始,各子節(jié)點(diǎn)都經(jīng)過(guò)了[ti +(T – ti)] = T時(shí)間后讀取編碼盤(pán)信息,實(shí)現(xiàn)了子節(jié)點(diǎn)采集時(shí)刻同步。
求取信息幀空中傳輸時(shí)間ti的具體過(guò)程如圖5所示。子節(jié)點(diǎn)i在Ti1時(shí)刻發(fā)送一個(gè)“請(qǐng)求時(shí)間校正幀”給主節(jié)點(diǎn),主節(jié)點(diǎn)在Ti2時(shí)刻收到該幀,并于Ti3時(shí)刻回復(fù)第一個(gè)應(yīng)答幀,應(yīng)答幀的內(nèi)容為時(shí)刻Ti2。子節(jié)點(diǎn)在Ti4時(shí)刻收到應(yīng)答幀,獲得時(shí)間Ti2。主節(jié)點(diǎn)在Ti3時(shí)刻后任意延遲一段時(shí)間發(fā)送第二個(gè)應(yīng)答幀,應(yīng)答幀的內(nèi)容為時(shí)刻Ti3,使子節(jié)點(diǎn)能在某時(shí)刻獲取時(shí)間Ti3。
 
500)this.style.width=500;" border="0" />

注:在此我們假定,信息幀由主節(jié)點(diǎn)發(fā)送至子節(jié)點(diǎn)需要的空中傳輸時(shí)間和信息幀由子節(jié)點(diǎn)發(fā)送至主節(jié)點(diǎn)需要的空中傳輸時(shí)間相同且穩(wěn)定。且信息幀長(zhǎng)度等于主節(jié)點(diǎn)發(fā)送的“角度采集廣播幀”長(zhǎng)度。
假設(shè)主節(jié)點(diǎn)的時(shí)鐘超前子節(jié)點(diǎn)△Ti,信息幀的空中傳輸時(shí)間為ti,可得:
Ti2 = Ti1 + △Ti + ti                                       ①
Ti4 = Ti3 - △Ti + ti                                       ②
由式①和②聯(lián)立可得:
△Ti  = (Ti2 - Ti1 -  Ti4 + Ti3)/2
 ti   = (Ti2 - Ti1  + Ti4 - Ti3)/2
5. 主節(jié)點(diǎn)和工控機(jī)的通信
主節(jié)點(diǎn)和工控機(jī)采用RS-232 串行數(shù)據(jù)傳輸,串行口通信方式為異步串行通信,速率為19200bps,信息格式為1位開(kāi)始位、8 位數(shù)據(jù)位、1個(gè)停止位、無(wú)奇偶校驗(yàn)位,采用中斷方式進(jìn)行數(shù)據(jù)傳輸。以下是串口初始化程序片斷:
void ConsoleInit(void)
{
#if defined(USART_USE_BRGH_HIGH)
      TXSTA = 0x24;   //設(shè)置串口發(fā)送狀態(tài)寄存器
#else
TXSTA = 0x20; 
#endif
      RCSTA = 0x90;    //設(shè)置串口接收狀態(tài)寄存器
   // SPBRG_VAL = CLOCK_FREQ/BAUD_RATE/64 – 1,BAUD_RATE=19200bps
      SPBRG = SPBRG_VAL;
  TXIE = 1; //默認(rèn)情況下串口處于發(fā)送狀態(tài),使能發(fā)送中斷
     TXIP = 1;
  //RCIE = 1; //若需要執(zhí)行串口接收,使能發(fā)送中斷
     //RCIP = 1;
}
6. 結(jié)論
將信息傳輸無(wú)線化,可免去關(guān)節(jié)臂式測(cè)量機(jī)的臂內(nèi)電纜線,實(shí)現(xiàn)關(guān)節(jié)的無(wú)限旋轉(zhuǎn)。本文設(shè)計(jì)的“基于ZigBee技術(shù)的角度同步采集傳輸系統(tǒng)”的無(wú)線硬件設(shè)計(jì)、軟件設(shè)計(jì)解決方案經(jīng)測(cè)試運(yùn)行穩(wěn)定,無(wú)線通信誤碼率低、可靠性高、安全性好。在室內(nèi)測(cè)試環(huán)境下,無(wú)線收發(fā)速率可以穩(wěn)定達(dá)到18kbps,重傳后誤碼率不高于10¬-5數(shù)量級(jí).
本文作者創(chuàng)新點(diǎn):將ZigBee無(wú)線通信技術(shù)與機(jī)械測(cè)量相結(jié)合,設(shè)計(jì)了一套基于ZigBee技術(shù)的角度同步采集傳輸系統(tǒng),應(yīng)用在關(guān)節(jié)臂式測(cè)量機(jī)上,實(shí)現(xiàn)了關(guān)節(jié)的無(wú)限旋轉(zhuǎn)。

本站聲明: 本文章由作者或相關(guān)機(jī)構(gòu)授權(quán)發(fā)布,目的在于傳遞更多信息,并不代表本站贊同其觀點(diǎn),本站亦不保證或承諾內(nèi)容真實(shí)性等。需要轉(zhuǎn)載請(qǐng)聯(lián)系該專欄作者,如若文章內(nèi)容侵犯您的權(quán)益,請(qǐng)及時(shí)聯(lián)系本站刪除。
換一批
延伸閱讀

9月2日消息,不造車的華為或?qū)⒋呱龈蟮莫?dú)角獸公司,隨著阿維塔和賽力斯的入局,華為引望愈發(fā)顯得引人矚目。

關(guān)鍵字: 阿維塔 塞力斯 華為

倫敦2024年8月29日 /美通社/ -- 英國(guó)汽車技術(shù)公司SODA.Auto推出其旗艦產(chǎn)品SODA V,這是全球首款涵蓋汽車工程師從創(chuàng)意到認(rèn)證的所有需求的工具,可用于創(chuàng)建軟件定義汽車。 SODA V工具的開(kāi)發(fā)耗時(shí)1.5...

關(guān)鍵字: 汽車 人工智能 智能驅(qū)動(dòng) BSP

北京2024年8月28日 /美通社/ -- 越來(lái)越多用戶希望企業(yè)業(yè)務(wù)能7×24不間斷運(yùn)行,同時(shí)企業(yè)卻面臨越來(lái)越多業(yè)務(wù)中斷的風(fēng)險(xiǎn),如企業(yè)系統(tǒng)復(fù)雜性的增加,頻繁的功能更新和發(fā)布等。如何確保業(yè)務(wù)連續(xù)性,提升韌性,成...

關(guān)鍵字: 亞馬遜 解密 控制平面 BSP

8月30日消息,據(jù)媒體報(bào)道,騰訊和網(wǎng)易近期正在縮減他們對(duì)日本游戲市場(chǎng)的投資。

關(guān)鍵字: 騰訊 編碼器 CPU

8月28日消息,今天上午,2024中國(guó)國(guó)際大數(shù)據(jù)產(chǎn)業(yè)博覽會(huì)開(kāi)幕式在貴陽(yáng)舉行,華為董事、質(zhì)量流程IT總裁陶景文發(fā)表了演講。

關(guān)鍵字: 華為 12nm EDA 半導(dǎo)體

8月28日消息,在2024中國(guó)國(guó)際大數(shù)據(jù)產(chǎn)業(yè)博覽會(huì)上,華為常務(wù)董事、華為云CEO張平安發(fā)表演講稱,數(shù)字世界的話語(yǔ)權(quán)最終是由生態(tài)的繁榮決定的。

關(guān)鍵字: 華為 12nm 手機(jī) 衛(wèi)星通信

要點(diǎn): 有效應(yīng)對(duì)環(huán)境變化,經(jīng)營(yíng)業(yè)績(jī)穩(wěn)中有升 落實(shí)提質(zhì)增效舉措,毛利潤(rùn)率延續(xù)升勢(shì) 戰(zhàn)略布局成效顯著,戰(zhàn)新業(yè)務(wù)引領(lǐng)增長(zhǎng) 以科技創(chuàng)新為引領(lǐng),提升企業(yè)核心競(jìng)爭(zhēng)力 堅(jiān)持高質(zhì)量發(fā)展策略,塑強(qiáng)核心競(jìng)爭(zhēng)優(yōu)勢(shì)...

關(guān)鍵字: 通信 BSP 電信運(yùn)營(yíng)商 數(shù)字經(jīng)濟(jì)

北京2024年8月27日 /美通社/ -- 8月21日,由中央廣播電視總臺(tái)與中國(guó)電影電視技術(shù)學(xué)會(huì)聯(lián)合牽頭組建的NVI技術(shù)創(chuàng)新聯(lián)盟在BIRTV2024超高清全產(chǎn)業(yè)鏈發(fā)展研討會(huì)上宣布正式成立。 活動(dòng)現(xiàn)場(chǎng) NVI技術(shù)創(chuàng)新聯(lián)...

關(guān)鍵字: VI 傳輸協(xié)議 音頻 BSP

北京2024年8月27日 /美通社/ -- 在8月23日舉辦的2024年長(zhǎng)三角生態(tài)綠色一體化發(fā)展示范區(qū)聯(lián)合招商會(huì)上,軟通動(dòng)力信息技術(shù)(集團(tuán))股份有限公司(以下簡(jiǎn)稱"軟通動(dòng)力")與長(zhǎng)三角投資(上海)有限...

關(guān)鍵字: BSP 信息技術(shù)
關(guān)閉
關(guān)閉