電氣控制下采摘機(jī)器人作業(yè)系統(tǒng)探究
前言：想要寫出一篇引人入勝的文章？我們特意為您整理了電氣控制下采摘機(jī)器人作業(yè)系統(tǒng)探究范文，希望能給你帶來(lái)靈感和參考，敬請(qǐng)閱讀。
摘要:以采摘機(jī)器人作業(yè)系統(tǒng)為研究對(duì)象，對(duì)采摘過(guò)程中機(jī)器人各關(guān)節(jié)運(yùn)動(dòng)控制需求進(jìn)行分析，并結(jié)合采摘機(jī)器人的作業(yè)環(huán)境、工作模式以及工作過(guò)程要求，設(shè)計(jì)了一種高精度、能夠快速響應(yīng)并具有較高的抗干擾性能控制系統(tǒng)。選用直流永磁同步電機(jī)作為作業(yè)系統(tǒng)關(guān)機(jī)驅(qū)動(dòng)電機(jī)，并對(duì)采摘機(jī)器人作業(yè)控制系統(tǒng)的硬件及軟件進(jìn)行設(shè)計(jì)，搭建作業(yè)控制系統(tǒng)。實(shí)驗(yàn)結(jié)果表明:控制系統(tǒng)能夠快速準(zhǔn)確地進(jìn)行采摘系統(tǒng)定位，并有效地抵抗系統(tǒng)部件產(chǎn)生的機(jī)械振動(dòng)沖擊。
關(guān)鍵詞:采摘機(jī)器人;電氣控制;永磁同步電機(jī);控制系統(tǒng)
0引言
果蔬采摘是果蔬種植過(guò)程中耗時(shí)耗力的一環(huán)，且具有一定的時(shí)限性，往往需要投入大量的勞動(dòng)力［1］。果蔬采摘機(jī)器人可代替人工勞動(dòng)，達(dá)到無(wú)害化采摘的目的，能大幅度提高采摘作業(yè)效率。采摘機(jī)器人的工作性能受自然環(huán)境的影響較大，隨著采摘對(duì)象的差異，要求采摘機(jī)器人具有一定的抗干擾能力，能夠?qū)Νh(huán)境及采摘對(duì)象的變化進(jìn)行快速的響應(yīng)［2］。采摘機(jī)器人在作業(yè)過(guò)程中，依靠關(guān)節(jié)實(shí)現(xiàn)采摘?jiǎng)幼鳎烧獧C(jī)器人關(guān)節(jié)的控制性能直接關(guān)系到采摘機(jī)器人作業(yè)系統(tǒng)的整體工作性能。由于采摘機(jī)器人受外部條件的影響較大，對(duì)于機(jī)器人作業(yè)系統(tǒng)的驅(qū)動(dòng)常采用一種伺服控制系統(tǒng)來(lái)提高采摘機(jī)器人的抗干擾能力和適應(yīng)性［3－4］。
1采摘機(jī)器人驅(qū)動(dòng)控制系統(tǒng)
按照動(dòng)力源的不同，采摘機(jī)器人的驅(qū)動(dòng)系統(tǒng)可分為液壓驅(qū)動(dòng)、氣壓驅(qū)動(dòng)以及電機(jī)驅(qū)動(dòng)3種不同系統(tǒng)［5］。其中，液壓驅(qū)動(dòng)系統(tǒng)具有較高的輸出功率，可實(shí)現(xiàn)無(wú)極調(diào)速，響應(yīng)速度快，但具有較大的體積，制造維修復(fù)雜，常用于大功率采摘環(huán)境中;氣壓驅(qū)動(dòng)系統(tǒng)輸出功率小，能夠高速運(yùn)行，生產(chǎn)制造成本低，但抗干擾能力差;電機(jī)驅(qū)動(dòng)系統(tǒng)中一種常用控制方式為同步電機(jī)伺服驅(qū)動(dòng)系統(tǒng)，控制性能好，能夠快速進(jìn)行指令響應(yīng)，生產(chǎn)制造成本較高，具有較高的可靠性［6］?？紤]到產(chǎn)量及經(jīng)濟(jì)性，果蔬種植時(shí)往往具有較大的種植密度，采摘機(jī)器人要求具有較小的結(jié)構(gòu)體積、采摘過(guò)程中負(fù)荷較低，主要負(fù)載來(lái)自于采摘機(jī)器人自身質(zhì)量，且采摘過(guò)程中具有較高的移動(dòng)速度。因此，筆者采用永磁同步電機(jī)為作業(yè)系統(tǒng)的驅(qū)動(dòng)執(zhí)行元件，電氣控制部分采用伺服控制系統(tǒng)，實(shí)現(xiàn)機(jī)器人關(guān)節(jié)運(yùn)動(dòng)過(guò)程中的轉(zhuǎn)速和位置快速精準(zhǔn)調(diào)節(jié)。永磁同步電機(jī)體積小、質(zhì)量輕且轉(zhuǎn)動(dòng)慣量小，能夠在工作過(guò)程中進(jìn)行平穩(wěn)工作，同時(shí)具有過(guò)載保護(hù)功能［7］。采摘機(jī)器人主要包含運(yùn)動(dòng)關(guān)節(jié)及末端采摘執(zhí)行器，每個(gè)機(jī)器人關(guān)節(jié)具有獨(dú)立的運(yùn)動(dòng)控制系統(tǒng)，通過(guò)上位機(jī)進(jìn)行采摘機(jī)器人運(yùn)動(dòng)控制，每個(gè)關(guān)節(jié)運(yùn)動(dòng)控制系統(tǒng)進(jìn)行電機(jī)驅(qū)動(dòng)，完成響應(yīng)的動(dòng)作指令，實(shí)現(xiàn)一次采摘過(guò)程。圖1所示為采摘機(jī)器人驅(qū)動(dòng)控制系統(tǒng)總體結(jié)構(gòu)圖。
2電氣控制系統(tǒng)硬件結(jié)構(gòu)
采摘機(jī)器人的每一次作業(yè)過(guò)程都要求具有較高的位置精度，且每一次采摘過(guò)程能夠進(jìn)行快速的響應(yīng)，采摘過(guò)程中無(wú)抖動(dòng)，因此要求采摘機(jī)器人電機(jī)伺服控制系統(tǒng)具有較高的可靠性。在進(jìn)行采摘機(jī)器人關(guān)節(jié)驅(qū)動(dòng)控制系統(tǒng)設(shè)計(jì)時(shí)，以矢量控制方式為基礎(chǔ)，設(shè)計(jì)了一種包含電流反饋、速度反饋以及位置反饋在內(nèi)的永磁同步電機(jī)控制系統(tǒng)。采摘機(jī)器人作業(yè)系統(tǒng)中關(guān)節(jié)部分伺服控制的硬件結(jié)構(gòu)是整個(gè)采摘機(jī)器人功能的基本保證，如圖2所示。工作時(shí)，工控機(jī)通過(guò)視覺(jué)系統(tǒng)及其他傳感系統(tǒng)獲取采摘對(duì)象的位置信息及周圍環(huán)境信息，根據(jù)采摘對(duì)象位置與姿態(tài)信息求出機(jī)器人運(yùn)動(dòng)學(xué)逆解，從而獲得每一個(gè)關(guān)節(jié)的電機(jī)需要轉(zhuǎn)動(dòng)的角度;目標(biāo)轉(zhuǎn)動(dòng)角通過(guò)PWM波傳輸至運(yùn)動(dòng)驅(qū)動(dòng)板，并經(jīng)過(guò)光電放大后產(chǎn)生正弦波電流，驅(qū)動(dòng)永磁同步電機(jī);編碼器將每一個(gè)關(guān)節(jié)電機(jī)的速度及位置信息進(jìn)行采集，并反饋至控制板，從而實(shí)現(xiàn)采摘機(jī)器人作業(yè)系統(tǒng)中各關(guān)節(jié)電機(jī)的閉環(huán)控制。采摘機(jī)器人伺服控制系統(tǒng)通訊模式是一種上位機(jī)與多個(gè)下位機(jī)之間的通訊，在此選用一種平衡數(shù)字多點(diǎn)通訊，實(shí)現(xiàn)工控機(jī)與各關(guān)節(jié)之間的通訊，能夠保證系統(tǒng)通訊的實(shí)時(shí)有效性，且滿足采摘過(guò)程中較遠(yuǎn)距離的通訊要求;同時(shí)，采用差分傳輸?shù)姆绞剑瑴p少了噪音對(duì)通訊過(guò)程的干擾，保證采摘機(jī)器人能夠在復(fù)雜環(huán)境中進(jìn)行快速響應(yīng)工作。電氣系統(tǒng)通訊電路圖，如圖3所示。電流反饋環(huán)節(jié)通過(guò)傳感器進(jìn)行轉(zhuǎn)角及位置姿態(tài)信息采集，獲取模擬量，并通過(guò)A/D轉(zhuǎn)換電路進(jìn)行轉(zhuǎn)化，獲取穩(wěn)定準(zhǔn)確的采集電流。在采摘機(jī)器人作業(yè)系統(tǒng)控制過(guò)程中，對(duì)于末端執(zhí)行器位置和速度的控制需要進(jìn)行電機(jī)的位置及速度檢測(cè)，形成整個(gè)控制系統(tǒng)的反饋環(huán)節(jié)，從而準(zhǔn)確地進(jìn)行采摘機(jī)器人控制。文中所用編碼器采用一種增程式光電編碼器，并利用差分接收器進(jìn)行脈沖控制信號(hào)轉(zhuǎn)換，信號(hào)轉(zhuǎn)換過(guò)程中通過(guò)光耦隔離減少脈沖信號(hào)的干擾。增程式編碼采集器電路圖，如圖4所示。采摘機(jī)器人功率驅(qū)動(dòng)電路實(shí)現(xiàn)電流的轉(zhuǎn)換，根據(jù)機(jī)器人功率需求，選用220V交流電進(jìn)行采摘機(jī)器人供電，采摘機(jī)器人主回路電路采用220V交流電接入機(jī)器人驅(qū)動(dòng)板，并經(jīng)過(guò)全波電流整流橋，在濾波電路中進(jìn)行濾波，從而得到穩(wěn)定的直流電壓。在進(jìn)行永磁同步電機(jī)控制過(guò)程中，為了實(shí)現(xiàn)閉環(huán)控制，必須精確采集電機(jī)兩相的電流值，并計(jì)算出第三相電流。
3電氣控制系統(tǒng)軟件設(shè)計(jì)
采摘機(jī)器人永磁同步電機(jī)控制系統(tǒng)使用單上位機(jī)和多下位機(jī)并存的控制通訊方式，每一個(gè)電機(jī)控制系統(tǒng)接收到上位機(jī)控制指令后，進(jìn)行中斷程序觸發(fā)，實(shí)現(xiàn)電機(jī)的啟動(dòng);電機(jī)快速旋轉(zhuǎn)至指定角度位置，中斷程序結(jié)束，并向上位機(jī)進(jìn)行執(zhí)行結(jié)果的反饋。采摘機(jī)器人主程序流程圖，如圖5所示。采摘機(jī)器人中斷程序包含電機(jī)轉(zhuǎn)子角度信息、速度檢測(cè)計(jì)算、通電電流采集以及其他相關(guān)控制程序，完整的中斷程序是永磁同步電機(jī)控制系統(tǒng)的主要控制流程，并直接影響著控制系統(tǒng)的性能。采摘機(jī)器人中斷程序流程圖，如圖6所示。采摘機(jī)器人在進(jìn)行永磁同步電機(jī)控制系統(tǒng)的閉環(huán)控制過(guò)程中，采用電流環(huán)、速度環(huán)和位置環(huán)進(jìn)行相關(guān)信息的反饋，采摘機(jī)器人閉環(huán)控制軟件流程如圖7所示。
4作業(yè)系統(tǒng)實(shí)驗(yàn)分析
采摘機(jī)器人控制系統(tǒng)設(shè)計(jì)優(yōu)化完成后，進(jìn)行系統(tǒng)搭建。上位機(jī)選用工控機(jī)，并通過(guò)雙絞線與各關(guān)節(jié)控制系統(tǒng)連接，實(shí)現(xiàn)各關(guān)節(jié)控制系統(tǒng)與工控機(jī)之間的相互通訊。選用220V交流電為系統(tǒng)電源，并經(jīng)過(guò)變壓后輸出24V直流電源，作為控制系統(tǒng)的開關(guān)電源，對(duì)運(yùn)動(dòng)控制板進(jìn)行供電。選用4個(gè)磁極的永磁同步電機(jī)作為機(jī)器人關(guān)節(jié)驅(qū)動(dòng)電機(jī)，電感為6．55mH，電阻為0．901Ω，轉(zhuǎn)子磁鏈0．031Wb，轉(zhuǎn)動(dòng)慣量為1．2×10－4kg·m2。硬件系統(tǒng)搭建完成后，在測(cè)試實(shí)驗(yàn)區(qū)域內(nèi)不同位置設(shè)置5個(gè)采摘對(duì)象，其坐標(biāo)點(diǎn)分別為(100，100，100)、(150，200，100)、(50，100，150)、(100，100，50)、(150，150，200)，對(duì)采摘機(jī)器人作業(yè)過(guò)程中末端執(zhí)行器的位置信息、速度以及加速度進(jìn)行監(jiān)測(cè)。采摘機(jī)器人作業(yè)系統(tǒng)末端執(zhí)行器位置曲線，如圖8所示。由圖8可看出:采摘機(jī)器人在作業(yè)過(guò)程中，能夠快速準(zhǔn)確地運(yùn)動(dòng)至采摘對(duì)象所在位置，在采摘對(duì)象附近位置，作業(yè)系統(tǒng)速度發(fā)生波動(dòng)，并在采摘過(guò)程中處于靜止?fàn)顟B(tài);采摘完成后，迅速移動(dòng)至下一采摘對(duì)象。采摘機(jī)器人作業(yè)系統(tǒng)末端執(zhí)行器速度曲線，如圖9所示。由圖9可看出:在運(yùn)動(dòng)至采摘對(duì)象時(shí)，作業(yè)系統(tǒng)能夠平穩(wěn)進(jìn)行減速，減少了采摘機(jī)器人由于動(dòng)量產(chǎn)生的系統(tǒng)沖擊。采摘機(jī)器人作業(yè)系統(tǒng)末端執(zhí)行器加速度曲線，如圖10所示。由圖10可看出:采摘機(jī)器人在作業(yè)過(guò)程中，加速度不斷的變化，說(shuō)明在作業(yè)過(guò)程中，采摘機(jī)器人驅(qū)動(dòng)電機(jī)需不斷承受由末端產(chǎn)生的機(jī)械振動(dòng)。
5結(jié)論
所設(shè)計(jì)的采摘機(jī)器人作業(yè)控制系統(tǒng)對(duì)永磁同步電機(jī)的作業(yè)運(yùn)動(dòng)過(guò)程進(jìn)行實(shí)時(shí)閉環(huán)控制，具有較高的響應(yīng)響度，能夠有效地對(duì)作業(yè)過(guò)程中的干擾因素進(jìn)行抵抗。在作業(yè)過(guò)程中能夠準(zhǔn)確進(jìn)行采摘對(duì)象定位，各機(jī)器人關(guān)節(jié)在電機(jī)驅(qū)動(dòng)過(guò)程中具有一定的緩沖能力，能夠?qū)C(jī)械部件的沖擊進(jìn)行有效的抵抗。試驗(yàn)結(jié)果表明:伺服控制系統(tǒng)具有較高的可靠性，可為采摘機(jī)器人作業(yè)過(guò)程的精密控制提供理論基礎(chǔ)。
作者:張志豐 單位:鄭州電力職業(yè)技術(shù)學(xué)院