基于單片機(jī)和智能監(jiān)測的采摘機(jī)器人調(diào)速系統(tǒng)設(shè)計(jì)

胡國順，喬　琳，劉志剛

( 1.云南經(jīng)濟(jì)管理學(xué)院 工程學(xué)院，昆明　650304；2.云南大學(xué) 軟件學(xué)院，昆明　650091)

?

基于單片機(jī)和智能監(jiān)測的采摘機(jī)器人調(diào)速系統(tǒng)設(shè)計(jì)

胡國順1，喬琳1，劉志剛2

( 1.云南經(jīng)濟(jì)管理學(xué)院 工程學(xué)院，昆明650304；2.云南大學(xué) 軟件學(xué)院，昆明650091)

摘要：由于采摘機(jī)器人的移動(dòng)非常頻繁，因此其速度控制是影響工作效率的主要因素，在機(jī)器人的移動(dòng)過程中會(huì)產(chǎn)生較大的慣性和時(shí)延，在控制信號(hào)的輸出和電機(jī)響應(yīng)過程中也會(huì)有一定的延遲，采摘機(jī)器人的慣性會(huì)使采摘機(jī)器人不能很好地在預(yù)定的果實(shí)采摘位置停下。為了解決這個(gè)問題，提高機(jī)器人的采摘效率，設(shè)計(jì)了一種新的機(jī)器人調(diào)速系統(tǒng)。該系統(tǒng)速度由傳感器進(jìn)行采集，通過電機(jī)的變頻調(diào)節(jié)實(shí)現(xiàn)移動(dòng)速度的控制。為了使機(jī)器人的控制平穩(wěn)，以STC89C52單片機(jī)為控制核心，設(shè)計(jì)了采摘機(jī)器人的閉環(huán)控制系統(tǒng)。最后，對(duì)采摘機(jī)器人的性能進(jìn)行了測試，通過測試發(fā)現(xiàn)：采摘機(jī)器人可以準(zhǔn)確地識(shí)別成熟果實(shí)，控制算法運(yùn)行良好，可靠性高，實(shí)現(xiàn)了采摘機(jī)器人的自動(dòng)調(diào)速功能。

關(guān)鍵詞：采摘機(jī)器人；調(diào)速系統(tǒng)；STC89C52單片機(jī)；傳感器；時(shí)延

0引言

果蔬采摘作業(yè)是果實(shí)種植過程的重要環(huán)節(jié)，其工作量大、采摘時(shí)間集中，因此采摘效率是一個(gè)亟待解決的問題。在日本、德國和荷蘭等發(fā)達(dá)國家引進(jìn)研發(fā)了大量的果實(shí)自動(dòng)采摘機(jī)器人，如蘋果、黃瓜和櫻桃等自動(dòng)收獲機(jī)器人；但這些機(jī)器人在設(shè)計(jì)過程中普遍存在果實(shí)識(shí)別率和采摘效率低的問題，其核心需要解決的是采摘機(jī)器人的移動(dòng)速度控制問題。在采摘機(jī)器人速度控制設(shè)計(jì)過程中，如何獲取機(jī)器人的速度和控制機(jī)器人的速度是兩個(gè)關(guān)鍵的問題，解決了這兩個(gè)問題對(duì)于采摘機(jī)器人的設(shè)計(jì)具有重要的意義。

1基于智能監(jiān)測的采摘機(jī)器人結(jié)構(gòu)設(shè)計(jì)

為了實(shí)現(xiàn)采摘機(jī)器人的智能調(diào)速，以STC89C52單片機(jī)為控制核心，實(shí)現(xiàn)采摘機(jī)器人的測速和調(diào)速，達(dá)到智能控制的目的。為了提高采摘機(jī)器人的性能，智能采摘機(jī)器人采用PWM脈寬調(diào)控技術(shù)。在確保采摘機(jī)器人能穩(wěn)定調(diào)速的前提下，需要將電路設(shè)計(jì)得盡量簡潔，以提高采摘機(jī)器人動(dòng)作的靈活性。底盤上的監(jiān)測傳感器布置如圖1所示。

圖1中，A表示采摘機(jī)器人的尾部傳感器，負(fù)責(zé)倒退時(shí)的巡航功能；B為前端傳感器，負(fù)責(zé)前進(jìn)時(shí)的巡航功能；C傳感器和A傳感器進(jìn)行配合實(shí)現(xiàn)轉(zhuǎn)彎功能。

圖1　底盤傳感器分布圖示意圖

圖2為其他傳感器和圖像采集系統(tǒng)的分布示意圖。其中，B、C為光電傳感器，當(dāng)機(jī)器人靠近樹木的過程中，機(jī)器人停止；A表示攝像機(jī)，可以對(duì)果實(shí)圖像進(jìn)行采集，然后對(duì)成熟果實(shí)進(jìn)行識(shí)別。在果實(shí)識(shí)別時(shí)，大部分果實(shí)為球形果實(shí)，利用采集得到的圖像重新建立三維信息模型，然后利用最小二乘法求其質(zhì)心位置，便可以對(duì)果實(shí)的位置進(jìn)行準(zhǔn)確識(shí)別。球形果實(shí)的數(shù)學(xué)模型為

(x-a)2+(y-b)2+(z-c)2=R2

(1)

其中，(a,b,c)表示球形在相機(jī)坐標(biāo)系中的坐標(biāo)；R表示球形果實(shí)的半徑，也可以將其寫成

2ax+2by+2cz+R2-(a2+b2+c2)=x2+y2+z2

(2)

將采集圖像的n個(gè)點(diǎn)用矩形表示為

(3)

對(duì)于式(3)可以簡單寫為

Am=B

(4)

通過最小二乘方法進(jìn)行求解可得

m=(ATA)-1ATB

(5)

為了實(shí)現(xiàn)果實(shí)的快速定位，利用目標(biāo)上的8個(gè)點(diǎn)來近似建立果實(shí)的形狀，利用Hough可以得到果實(shí)在圖像上的圓心坐標(biāo)為和半徑。其中，圓的外接矩陣的左上角坐標(biāo)為(xmin,ymin)，右下角坐標(biāo)為(xmax,ymax)，則矩形內(nèi)隨機(jī)一個(gè)點(diǎn)的坐標(biāo)為

(6)

圖2　其他傳感器和攝像機(jī)分布

利用8個(gè)點(diǎn)可以擬合出果實(shí)的球形形狀，果實(shí)位置的整個(gè)識(shí)別過程如圖3所示。

圖3　果實(shí)位置的整個(gè)識(shí)別過程流程圖

圖3中，主要包括圖像采集、圖像處理、果實(shí)形心位置坐標(biāo)計(jì)算及果實(shí)球心計(jì)算，通過計(jì)算可以得到果實(shí)的實(shí)際位置。

2采摘機(jī)器人調(diào)速控制系統(tǒng)設(shè)計(jì)

當(dāng)機(jī)器人對(duì)果實(shí)目標(biāo)進(jìn)行定位后，在到達(dá)指定位置過程中需要實(shí)現(xiàn)自動(dòng)調(diào)速功能，采摘機(jī)器人的移動(dòng)主要利用電機(jī)驅(qū)動(dòng)來實(shí)現(xiàn)。對(duì)于電機(jī)來說，不管是同步還是異步電機(jī)，其驅(qū)動(dòng)速度都是由同步轉(zhuǎn)速?zèng)Q定的，其表達(dá)式為

n=n0(1-s)

(7)

其中，n表示電動(dòng)機(jī)轉(zhuǎn)速，n0表示電動(dòng)機(jī)同步轉(zhuǎn)速，s表示電動(dòng)機(jī)的轉(zhuǎn)速差率。同步轉(zhuǎn)速是由電機(jī)的頻率決定的，表達(dá)式為

n0=60f/p

(8)

其中，f表示電機(jī)的輸入頻率，p表示電動(dòng)機(jī)的磁極對(duì)數(shù)，聯(lián)合式(7)、式(8)可得

n=60f(1-s)/p

(9)

由式(9)可知：當(dāng)電機(jī)的磁極的對(duì)數(shù)一定時(shí)，可以通過改變電機(jī)的頻率來實(shí)現(xiàn)電機(jī)的調(diào)速。變頻調(diào)速的總體設(shè)計(jì)如圖4所示。

圖4　電動(dòng)機(jī)變頻調(diào)速系統(tǒng)框圖

電動(dòng)機(jī)的變頻調(diào)速系統(tǒng)，控制核心為STC89C52單片機(jī)，利用轉(zhuǎn)速監(jiān)測反饋信息來對(duì)電機(jī)的速度進(jìn)行變頻控制，其速度可以在外圍設(shè)備中顯示。其主程序的控制流程如圖5所示。

圖5中，主要是對(duì)監(jiān)測速度的反饋信息處理，利用反饋信息更新控制參數(shù)，實(shí)現(xiàn)采摘機(jī)器人的速度閉環(huán)控制。單片機(jī)的最小系統(tǒng)電路如圖6所示。

圖6包括晶振電路、復(fù)位電路和RS232下載端口。晶振電路可以維持采摘機(jī)器人工作的穩(wěn)定性，復(fù)位電路可以實(shí)習(xí)單片機(jī)的復(fù)位功能， 采摘機(jī)器人調(diào)速系統(tǒng)時(shí)間控制過程中需要多次利用反饋信息修改數(shù)據(jù)，因此需要設(shè)計(jì)RS232下載端口。

圖5　主程序流程圖

圖6　單片機(jī)最小系統(tǒng)設(shè)計(jì)圖

圖7為STC89C52RC基本結(jié)構(gòu)圖。STC89C52是ST公司生產(chǎn)的一種低功耗、高性能CMOS 8位微控制器，通過改進(jìn)使其具有了51單片機(jī)很多不具有的功能，提高了其性能。

圖7　STC89C52RC基本結(jié)構(gòu)圖

3采摘機(jī)器人性能測試

為了測試本次研究設(shè)計(jì)的采摘機(jī)器人的可靠性，對(duì)其采摘性能進(jìn)行了測試，采用單片機(jī)、傳感器和圖像采集系統(tǒng)對(duì)機(jī)器人進(jìn)行智能控制，測試項(xiàng)目包括目標(biāo)識(shí)別率和速度調(diào)控精度測試，測試場景圖片如圖8所示。

圖8　機(jī)器人作業(yè)性能測試圖

機(jī)器人通過采摘作業(yè)，對(duì)目標(biāo)的準(zhǔn)確識(shí)別率進(jìn)行了測試，主要采用圖像采集系統(tǒng)和傳感器進(jìn)行控制，通過測試得到了如表1所示的測試結(jié)果。

表1　果實(shí)準(zhǔn)確識(shí)別率結(jié)果

由表1可以看出:通過8次測試，采摘機(jī)器人能夠成功地識(shí)別綠色成熟果實(shí)和黃色成熟果實(shí)，而且準(zhǔn)確識(shí)別率都超過了95%，準(zhǔn)確識(shí)別率較高。

表2表示機(jī)器人調(diào)速的測試結(jié)果。其中，測試使用的電機(jī)為5V的直流電機(jī)，傳感器使用U型光電測速傳感器。當(dāng)PWM=5V，占空比為100%時(shí)，電機(jī)的轉(zhuǎn)速264r/s。通過測試發(fā)現(xiàn)：所設(shè)計(jì)的基于單片機(jī)和智能監(jiān)測的采摘機(jī)器人控制算法運(yùn)行良好，可靠性高，實(shí)現(xiàn)了采摘機(jī)器人的自動(dòng)調(diào)速功能。

表2　機(jī)器人調(diào)速測試結(jié)果

4結(jié)論

1)為了降低采摘機(jī)器人由于慣性和時(shí)延造成的移動(dòng)誤差，并有效提高機(jī)器人的采摘效率，設(shè)計(jì)了一種新的采摘機(jī)器人調(diào)速系統(tǒng)。該系統(tǒng)以STC89C52單片機(jī)為控制核心，采用閉環(huán)控制系統(tǒng)，實(shí)現(xiàn)了速度的采集和變頻控制，從而提高了機(jī)器人的智能控制水平。

2)對(duì)采摘機(jī)器人的性能進(jìn)行了測試，由測試結(jié)果可以看出：采摘機(jī)器人對(duì)成熟果實(shí)的識(shí)別率較高，達(dá)到了95%以上；其控制算法的運(yùn)行可靠性較高，提高了機(jī)器人的自動(dòng)調(diào)速能力，為高效率采摘機(jī)器人的研發(fā)提供了技術(shù)參考。

參考文獻(xiàn)：

[1]徐忠燕,簡毅,任海洋.基于P87LPC768的小功率直流電動(dòng)機(jī)調(diào)速系統(tǒng)[J].機(jī)械與電子,2009(7): 46-47.

[2]趙慶波,趙德安,姬偉,等.采摘機(jī)器人視覺伺服控制系統(tǒng)設(shè)計(jì)[J].農(nóng)業(yè)機(jī)械學(xué)報(bào),2009, 40(1): 152-156.

[3]謝志勇,張鐵中,趙金英.基于Hough變換的成熟草莓識(shí)別技術(shù)[J].農(nóng)業(yè)機(jī)械學(xué)報(bào),2007,38(3):106-109.

[4]吳忠強(qiáng),張曉霞,舒杰.柔性機(jī)器人基于自適應(yīng)模糊動(dòng)態(tài)面的實(shí)用穩(wěn)定控制[J].中國機(jī)械工程,2012, 23(19):2297-2301.

[5]過希文,王群京,李國麗.基于動(dòng)態(tài)面的機(jī)械臂軌跡跟蹤神經(jīng)網(wǎng)絡(luò)自適應(yīng)算法[J].系統(tǒng)仿真學(xué)報(bào),2011, 23(11):2327-2332.

[6]李曉剛,劉晉浩.基于反演設(shè)計(jì)的碼垛機(jī)器人神經(jīng)網(wǎng)絡(luò)自適應(yīng)控制[J].包裝工程,2012,33(1):80-85.

[7]金雷澤,杜振軍,賈凱.基于勢場法的移動(dòng)機(jī)器人路徑規(guī)劃仿真研究[J].計(jì)算機(jī)工程與應(yīng)用,2007, 43(24):226-229.

[8]由暢宇,韓建達(dá).一種移動(dòng)機(jī)器人在三維動(dòng)態(tài)環(huán)境下的路徑規(guī)劃方法[J].計(jì)算機(jī)應(yīng)用與軟件,2009, 26(8):223-224.

[9]伊連云,姚俊紅,付瑩瑩，等.基于自主視覺足球機(jī)器人路徑規(guī)劃的研究[J].機(jī)械工程與自動(dòng)化,2006(2): 67-69.

[10]黃彥文,曹其新.Robocop比賽環(huán)境下足球機(jī)器人路徑規(guī)劃研究[J].智能系統(tǒng)學(xué)報(bào),2007(4):52-57.

[11]余群明,曹益,嚴(yán)欽山，等.基于改進(jìn)型遺傳算法的足球機(jī)器人路徑規(guī)劃[J].計(jì)算機(jī)仿真,2008,25(2)：178-180.

[12]王丙強(qiáng),宋弘.兩級(jí)BP網(wǎng)絡(luò)在機(jī)器人傳感器融合中的應(yīng)用[J].微計(jì)算機(jī)信息,2009,25(23):192-194.

[13]李繼勇,趙德彪,張靜.基于BP神經(jīng)網(wǎng)絡(luò)的供應(yīng)鏈風(fēng)險(xiǎn)預(yù)警研究[J].河北工程大學(xué)學(xué)報(bào):自然科學(xué)版, 2011,28(3):83-77.

[14]周芳,朱齊丹,趙國良.基于改進(jìn)快速搜索隨機(jī)樹法的機(jī)械手路徑優(yōu)化[J].機(jī)械工程學(xué)報(bào),2011(11):30 -35.

[15]李秦川,胡挺,武傳宇,等.果蔬采摘機(jī)器人末端執(zhí)行器研究綜述[J].農(nóng)業(yè)機(jī)械學(xué)報(bào),2008,39(3): 175-179.

[16]梁喜鳳,王永維,苗香雯.番茄收獲機(jī)械手避障運(yùn)動(dòng)規(guī)劃[J].農(nóng)業(yè)機(jī)械學(xué)報(bào),2008,39(11):89-93.

[17]宋勇,李貽斌,栗春,等.基于神經(jīng)網(wǎng)絡(luò)的移動(dòng)機(jī)器人路徑規(guī)劃方法[J].系統(tǒng)工程與電子技術(shù),2008(2):316-319.

[18]張美玉,黃翰,郝志峰,等.基于蟻群算法的機(jī)器人路徑規(guī)劃[J].計(jì)算機(jī)工程與應(yīng)用,2005(25):34- 37.

[19]孔令軍,張興華,陳建國.基本蟻群算法及其改進(jìn)[J].北華大學(xué)學(xué)報(bào)：自然科學(xué)版,2004(6):572-574.

[20]羅德林,吳順祥.基于勢場蟻群算法的機(jī)器人路徑規(guī)劃[J].系統(tǒng)工程與電子技術(shù),2010(6):1277- 1280.

[21]許斯軍,曹奇英.基于可視圖的移動(dòng)機(jī)器人路徑規(guī)劃[J].計(jì)算機(jī)應(yīng)用與軟件,2011(3):220-222.

[22]陳磊,陳帝伊,馬孝義.果蔬采摘機(jī)器人的研究[J].農(nóng)機(jī)化研究,2011,33(1):224-231.

[23]梁喜鳳,楊犇,王永維.番茄收獲機(jī)械手軌跡跟蹤模糊控制仿真與試驗(yàn)[J].農(nóng)業(yè)工程學(xué)報(bào),2013,29 (17):16-22.

[24]張建鋒,何東健,張志勇.采摘機(jī)器人自適應(yīng)魯棒跟蹤控制算法設(shè)計(jì)[J].農(nóng)機(jī)化研究,2009,31(12): 10-14.

[25]劉繼展,李萍萍,李智國.番茄采摘機(jī)器人末端執(zhí)行器的硬件設(shè)計(jì)[J].農(nóng)業(yè)機(jī)械學(xué)報(bào),2008,39(3):109- 112.

Design of Speed Control System for Picking Robot Based on Single Chip Microcomputer and Intelligent Monitoring

Hu Guoshun1, Qiao Lin1, Liu Zhigang2

(1.School of Engineering, Yunnan College of Business Management, Kunming 650304, China; 2.School of Software,Yunnan University, Kunming 650091,China)

Abstract：Because picking robot moves very frequently,the speed control is the main factors that affects the efficiency in the moving process of robot,which will be poor research with large inertia and delay.The control signal is output and the motor response to the process will also have a certain delay, picking machine inertia will make picking robots not be good in a predetermined fruit picking place to stop.In order to solve this problem and improve the picking efficiency, a new robot speed regulation system is designed.The speed of the system is collected by the sensor. The control of the robot is controlled by the frequency conversion.The closed-loop control system is designed. Finally, the performance of the picking robot is tested.The test shows that the picking robot can recognize the mature fruit accurately, and the control algorithm runs well and the reliability is high.

Key words：picking robot; speed control system; STC89C52 MCU; sensor; time delay

中圖分類號(hào)：S225.93；TP242

文獻(xiàn)標(biāo)識(shí)碼：A

文章編號(hào)：1003-188X(2016)09-0083-05

作者簡介：胡國順 (1986-) ，女， 云南大理人，講師，碩士。通訊作者：劉志剛(1980-)，男，湖北天門人，副教授，博士，(E-mail)zgliu@ynu.edu.cn。

基金項(xiàng)目：國家自然科學(xué)基金青年基金項(xiàng)目(51305152)

收稿日期：2015-08-19