網(wǎng)球撿球機(jī)自動化控制策略設(shè)計(jì)

東南大學(xué)吳健雄學(xué)院 馮嘉偉 楊宇宸 宋雨遙 王 成 林曉輝

網(wǎng)球撿球機(jī)自動化控制策略設(shè)計(jì)

東南大學(xué)吳健雄學(xué)院 馮嘉偉 楊宇宸 宋雨遙 王 成 林曉輝

本文針對網(wǎng)球撿球機(jī)的自動化和智能化，提出了將遙控模塊、陀螺儀模塊、超聲波模塊與基于單片機(jī)的網(wǎng)球撿球機(jī)相結(jié)合，提出了一種能通過手動（遙控）或自動的方式遍歷整個球場的創(chuàng)新型網(wǎng)球撿球機(jī)，并在理論的基礎(chǔ)上進(jìn)行了實(shí)驗(yàn)。該撿球機(jī)具有簡單易用、拾取效率高、人為干預(yù)少的特點(diǎn)。

遙控；單片機(jī)；網(wǎng)球撿球機(jī)；超聲波測距；陀螺儀

0.引言

網(wǎng)球作為世界第一的個人運(yùn)動，在世界范圍內(nèi)具有很大的愛好者基數(shù)，在網(wǎng)球的多球訓(xùn)練后，大量網(wǎng)球散落在球場上，給訓(xùn)練者帶來了很多麻煩。

目前，手動的網(wǎng)球撿球器械已經(jīng)發(fā)展地比較成熟而且在市場上取得了一定的成功，主要包括筒狀和筐狀兩種結(jié)構(gòu)，分別如圖1、圖2所示。

圖1 網(wǎng)球撿球筐

圖2 網(wǎng)球撿球筒

這兩種撿球機(jī)無論是在移動還是撿球時(shí)，都需要人力來完成，這兩種撿球機(jī)結(jié)構(gòu)簡單，技術(shù)難度較低，因此價(jià)格較為低廉，具有經(jīng)濟(jì)性的優(yōu)勢，此外由于筐狀、筒狀結(jié)構(gòu)材料使用較少，因此整體重量較輕。然而，這兩種設(shè)計(jì)本質(zhì)上仍需要人力的參與，只是減少了撿球的彎腰環(huán)節(jié)，并不能大幅降低勞動強(qiáng)度，也不能節(jié)省撿球的時(shí)間。

此外，李鵬在專利“一種網(wǎng)球自動撿球機(jī)”中提出了一種手推式的網(wǎng)球撿球機(jī)，這種撿球機(jī)上安裝有手推用的提桿，其撿球裝置由傳感器控制，當(dāng)傳感器檢測到附近有網(wǎng)球時(shí)，撿球裝置的電機(jī)開始工作，將球撿拾入收集器中。這種撿球機(jī)只需要推行即可完成撿球的工作，能夠在一定程度上提升撿球的效率，但是仍需要人為干預(yù)，且結(jié)構(gòu)體積龐大，不便于攜帶。

本文針對網(wǎng)球撿球機(jī)目前發(fā)展的難題，基于現(xiàn)在市場占有率很高拾取機(jī)構(gòu)做出了自動化改進(jìn)設(shè)計(jì)，能夠進(jìn)一步提升智能化程度，節(jié)省人力。

1.手動遙控控制

1.1 總體設(shè)計(jì)方案

本設(shè)計(jì)的遙控部分采用PS2X遙控模塊，該模塊可以將信號發(fā)射器上的鍵盤或者搖桿的信號傳輸?shù)浇邮掌魃?，接收器與arduino單片機(jī)相連，由單片機(jī)對數(shù)字信號進(jìn)行處理并且對步進(jìn)電機(jī)的驅(qū)動器發(fā)出指令，控制網(wǎng)球撿球機(jī)的運(yùn)動。

遙控控制的控制框圖如圖3所示。

考慮到使用范圍和使用工況，本設(shè)計(jì)沒有采用像汽車轉(zhuǎn)向一樣的轉(zhuǎn)向機(jī)構(gòu)，而是采用了在智能小車等裝置中廣泛使用的差速轉(zhuǎn)向的解決方案。整體設(shè)計(jì)方案如圖4所示。

前兩個輪子為聚氨酯輪，直徑200mm，而為了保證裝置前進(jìn)時(shí)的功率和轉(zhuǎn)向時(shí)的穩(wěn)定性，兩個后輪采用有動力全向輪，直徑127mm。當(dāng)前后輪直徑不同時(shí)，在前進(jìn)和轉(zhuǎn)向過程中的轉(zhuǎn)速自然會有不同的要求，本設(shè)計(jì)用arduino單片機(jī)的4個端口作為4個步進(jìn)電機(jī)的步進(jìn)信號發(fā)生端，對4個電機(jī)的轉(zhuǎn)速進(jìn)行獨(dú)立的控制。

由于本設(shè)計(jì)采用了差速轉(zhuǎn)向的設(shè)計(jì)，所以在不同的工況要求下，左側(cè)和右側(cè)的車輪相比轉(zhuǎn)速可能是不同的，但是，同側(cè)兩個輪子要求轉(zhuǎn)向相同才能保證運(yùn)動正常。

圖3 遙控控制的控制框圖

圖4 整體設(shè)計(jì)方案

1.2 遙控系統(tǒng)擾動消除

遙控系統(tǒng)由于設(shè)計(jì)制造上存在偏差以及工況的復(fù)雜性等原因，在網(wǎng)球撿球機(jī)的調(diào)試過程中發(fā)現(xiàn)，發(fā)射器經(jīng)常向接收器發(fā)射明顯錯誤的鍵盤或者搖桿的位置信號，造成真?zhèn)€撿球機(jī)的異常運(yùn)動等后果。此外，該擾動還具有很強(qiáng)的隨機(jī)性和不確定性，因此需要用軟件的方法進(jìn)行消除。

在調(diào)試過程中發(fā)現(xiàn)，該擾動的表現(xiàn)形式通常為搖桿坐標(biāo)發(fā)射的異常，很多時(shí)候，當(dāng)搖桿位置為初始位置時(shí)，即（128，128）時(shí)，接受器的接受信號經(jīng)常不確定地跳動為（255,255），考慮到（255,255）這個坐標(biāo)在整個網(wǎng)球撿球機(jī)的使用過程中極少出現(xiàn)，因此本設(shè)計(jì)將該坐標(biāo)的出現(xiàn)視為擾動，網(wǎng)球撿球機(jī)的接收器在接收到此信號后不對該指令做出任何反應(yīng)。

1.3 方向鍵盤信號處理

本設(shè)計(jì)采用arduino單片機(jī)的兩個端口為網(wǎng)球撿球機(jī)4個步進(jìn)電機(jī)轉(zhuǎn)向的控制端口，左側(cè)兩個電機(jī)共用一個，右側(cè)兩個電機(jī)共用一個。

在方向鍵盤控制的模式下，發(fā)射器向接收器發(fā)射的是上下左右四個方向的指令信號，設(shè)計(jì)要求為，當(dāng)收到前或后的信號時(shí)，單片機(jī)向驅(qū)動器發(fā)送電平信號，使網(wǎng)球撿球機(jī)向正前方或正后方行駛；當(dāng)接受到向左或者向右的信號時(shí)，單片機(jī)向接收器發(fā)送控制信號，使網(wǎng)球撿球機(jī)繞著車上一點(diǎn)，向左或向右原地轉(zhuǎn)向。這也就要求，在向前行駛模式時(shí)，左右兩側(cè)電機(jī)均向前轉(zhuǎn)動，在向后行駛時(shí)，所有電機(jī)向后轉(zhuǎn)動，左轉(zhuǎn)時(shí)，右側(cè)電機(jī)向前，左側(cè)電機(jī)向后，右轉(zhuǎn)時(shí)，右側(cè)電機(jī)向后，左側(cè)電機(jī)向前。

由于前后運(yùn)動時(shí)要求直線運(yùn)動，左右轉(zhuǎn)向時(shí)要求原地轉(zhuǎn)動，所以左右側(cè)的聚氨酯輪要求轉(zhuǎn)速一致，麥克納姆輪也要轉(zhuǎn)速一致，而前后輪的轉(zhuǎn)速之比由于直徑不同，要求直行時(shí)與直徑成反比，即127/200左右，而轉(zhuǎn)向時(shí)，由于安裝位置和差速轉(zhuǎn)向的特性，經(jīng)過計(jì)算，比值在0.61左右為宜。這也就要求arduino單片機(jī)根據(jù)轉(zhuǎn)速的要求和驅(qū)動器的細(xì)分值送相應(yīng)頻率的脈沖信號至驅(qū)動器。本設(shè)計(jì)采用軟件延時(shí)的方法解決這一問題，首先在初始化時(shí)將向4個驅(qū)動器脈沖信號的4個端口的電平全部拉高。將每個運(yùn)動周期設(shè)為10ms，每個運(yùn)動周期中可分為10000個時(shí)間長度為1μs的計(jì)數(shù)周期，在每個計(jì)數(shù)周期中，單片機(jī)主要完成延時(shí)1μs和計(jì)數(shù)的工作，當(dāng)在某一計(jì)數(shù)周期中，軟件計(jì)數(shù)的值與預(yù)先計(jì)算得到的前/后輪轉(zhuǎn)動所需的時(shí)間值相等時(shí)，單片機(jī)即將該端口的電平拉低1μs，再將該口電平拉高，形成一個脈沖，使該端口控制的電機(jī)步進(jìn)。

1.4 搖桿信號的處理

搖桿信號時(shí)通過發(fā)射器發(fā)射的模擬信號，橫坐標(biāo)為0～255，縱坐標(biāo)也為0～255，在初始狀態(tài)下，即無人為干預(yù)時(shí)，搖桿坐標(biāo)為（128,128），與方向鍵盤信號相比，搖桿信號的復(fù)雜性遠(yuǎn)遠(yuǎn)超過了前后左右四個方向指令，需要對接受器接受到的二維坐標(biāo)進(jìn)行針對性處理，發(fā)現(xiàn)這些坐標(biāo)中的共性和個性，提出個性化的解決方案。

本設(shè)計(jì)采用了兩個函數(shù)，將搖桿傳送的二維數(shù)字信號轉(zhuǎn)化為左右兩側(cè)的速度信號。

本設(shè)計(jì)將式子1-1和1-2的計(jì)算結(jié)果d和e的絕對值作為左右兩側(cè)電機(jī)的相對速度值，將結(jié)果的正負(fù)作為兩側(cè)電機(jī)轉(zhuǎn)向的參考值，可見在這種處理方式下，當(dāng)橫坐標(biāo)小于128時(shí)，網(wǎng)球撿球機(jī)會向左轉(zhuǎn)向，且坐標(biāo)越小，轉(zhuǎn)速越快，同理，在向其他三個方向運(yùn)動時(shí)也同樣滿足設(shè)計(jì)要求，且可以完成“邊轉(zhuǎn)邊走”的任務(wù)，大大提高了運(yùn)動的靈活性和可控性。

在確定了兩側(cè)電機(jī)的轉(zhuǎn)向和相對速度之后，只需要向相應(yīng)的驅(qū)動器和脈沖信號即可，但這里需要注意的是，如果使用和方向鍵盤信號一樣的軟件延時(shí)方法來控制轉(zhuǎn)速的話，相對速度大小需要轉(zhuǎn)化為脈沖信號送入驅(qū)動器。因?yàn)樗俣鹊慕^對值大小和脈沖的周期是成反比的，可以用一個較大的整數(shù)除以相對速度而得到相應(yīng)的脈沖周期。

如式1-3和1-4所示，考慮步進(jìn)電機(jī)細(xì)分等因素，選取整數(shù)2560，將速度信號轉(zhuǎn)化為合適的脈沖周期。與1.3部分一樣，控制循環(huán)中，每個循環(huán)都有1μs的延時(shí)，當(dāng)軟件計(jì)數(shù)的計(jì)數(shù)值能被b或者c整除時(shí)，向前輪或者后輪送脈沖信號，步進(jìn)電機(jī)完成步進(jìn)。

2.自動遍歷控制

2.1 總體方案設(shè)計(jì)

該功能模式中，與遙控模式一樣，運(yùn)用arduino單片機(jī)作為控制的中樞，處理各個傳感器的信號，并且對四個步進(jìn)電機(jī)進(jìn)行控制。PS2X遙控模塊同樣在該方案中得到使用，不過不作為遙控控制功能使用，而是作為緊急情況下的人為干預(yù)保護(hù)整個系統(tǒng)。此外，在這種工作模式下還增設(shè)了2個HC-SR04超聲波測距模塊和1個MPU6050陀螺儀模塊作為負(fù)反饋信號對自動遍歷過程中的內(nèi)部擾動進(jìn)行校正，實(shí)現(xiàn)閉環(huán)的高可靠性控制，系統(tǒng)的控制框圖5所示。

2.2 失控保護(hù)

該設(shè)計(jì)要求當(dāng)網(wǎng)球撿球機(jī)正在自動遍歷球場時(shí)，操作人按住PS2X鍵盤上的R1鍵，作為應(yīng)急指令，當(dāng)撿球機(jī)遍歷過程中因?yàn)樽陨韮?nèi)部擾動發(fā)生失控時(shí)，操作人需立即松開R1，當(dāng)網(wǎng)球撿球機(jī)上的接收器未接受到發(fā)射器發(fā)送的R1被按下的信號時(shí)，立即停止運(yùn)動，防止撿球機(jī)失控后與球場邊網(wǎng)發(fā)生碰撞，造成撿球機(jī)的損毀。

此外，因?yàn)镻S2X遙控模塊的發(fā)射器和接收器之間可能存在信號質(zhì)量不佳或因?yàn)榫嚯x過遠(yuǎn)產(chǎn)生的遙控信號傳送問題，該設(shè)計(jì)設(shè)定當(dāng)接收器超過50ms未收到發(fā)射器發(fā)送的任何信號時(shí)，作為失控的依據(jù)立即停止運(yùn)動，直到再次收到控制信號。

圖5 系統(tǒng)的控制框圖

圖6

2.3 邊界的判斷

如圖6所示，網(wǎng)球撿球機(jī)的2個聚攏片前端裝有2個超聲波距離傳感器，該傳感器的能實(shí)現(xiàn)精度達(dá)到0.3cm的精準(zhǔn)測距，考慮撿球機(jī)本身的大小和旋轉(zhuǎn)中心等因素，將兩個超聲波傳感器與邊網(wǎng)距離的和d=d1+d2為100cm作為臨界值，當(dāng)網(wǎng)球撿球機(jī)在前進(jìn)過程中探測到d值小于該臨界值，則可以得出網(wǎng)球撿球機(jī)已經(jīng)在球場的邊界的結(jié)論，控制系統(tǒng)進(jìn)入邊界控制算法。

2.4 姿態(tài)自動調(diào)整

由于網(wǎng)球撿球機(jī)在遍歷全場的過程中，場地不平坦，摩擦力不均勻等因素的存在，可能使撿球機(jī)遍歷時(shí)的軌跡不完全垂直于邊界，該擾動如果不被消除，將在之后的遍歷過程中不斷被放大，造成自動遍歷的可靠性降低。

圖7

圖8

如圖7和圖8所示，當(dāng)網(wǎng)球撿球機(jī)的行進(jìn)方向與周界不完全垂直時(shí)，兩距離傳感器的測距結(jié)果將會有所不同，當(dāng)左側(cè)的測距值大于右側(cè)時(shí)，需要撿球機(jī) 向右旋轉(zhuǎn)，反之，若右側(cè)的測距值大于左側(cè)時(shí)則需要撿球機(jī)向左側(cè)旋轉(zhuǎn)，在左右兩側(cè)距離傳感器的反饋之下，撿球機(jī)不斷調(diào)整自身姿態(tài)，直到左右兩側(cè)測距值相等，撿球機(jī)的行進(jìn)方向與周界嚴(yán)格垂直，擾動消除完成。

2.5 陀螺儀引導(dǎo)轉(zhuǎn)向

網(wǎng)球撿球機(jī)遍歷球場到達(dá)邊界完成姿態(tài)調(diào)整后，需要完成一系列動作，如圖9所示：

圖9

每一次撿球機(jī)到達(dá)邊界，需要完成兩次90度的轉(zhuǎn)向和一段約75cm的直行完成邊界段的運(yùn)動。該設(shè)計(jì)采用基于陀螺儀的負(fù)反饋控制提升轉(zhuǎn)向過程的精度和可靠性，控制流程圖如圖10所示：

圖10

Wm(s)——角度轉(zhuǎn)化為電機(jī)轉(zhuǎn)速的傳遞函數(shù)；

Wo(s)——對象的傳遞函數(shù)；

WH(s)——陀螺儀傳感器的傳遞函數(shù)。

用實(shí)驗(yàn)法對PI調(diào)節(jié)器進(jìn)行整定，可以實(shí)現(xiàn)對轉(zhuǎn)角的無差調(diào)節(jié)，整定過程中，要求r的衰減率大于1，防止來回震蕩對系統(tǒng)造成不良影響。該過程中陀螺儀的零位漂移可以忽略不計(jì)，因零位漂移積累的誤差可以通過2.4中的姿態(tài)調(diào)整進(jìn)行消除。

撿球機(jī)在陀螺儀的負(fù)反饋調(diào)節(jié)下，按照圖5所示的軌跡進(jìn)行轉(zhuǎn)向，即可完成邊界部分的轉(zhuǎn)向任務(wù)，轉(zhuǎn)向之后再進(jìn)行一整排的步進(jìn)，不斷循環(huán)之后即可實(shí)現(xiàn)遍歷全場的任務(wù)。

3.結(jié)論

在上述控制理論的指導(dǎo)下，本設(shè)計(jì)最終形成了實(shí)物，如圖11所示，實(shí)驗(yàn)證明，在本文所述的控制思想指導(dǎo)下制作的網(wǎng)球撿球機(jī)可以很好地完成高自動化程度遍歷整個球場的要求，系統(tǒng)運(yùn)行穩(wěn)定高效，節(jié)省了人力，網(wǎng)球訓(xùn)練過程中繁瑣的撿球任務(wù)可以很大程度上得到減輕。

圖11 實(shí)物圖

[1]朱建,安必勝,朱向楠．乒乓球撿球機(jī)的創(chuàng)新設(shè)計(jì)及感悟[J]．工程技術(shù)與應(yīng)用,2016-7(1):34-36．

[2]柴劍．智能掃地機(jī)器人技術(shù)的研究與實(shí)現(xiàn)[D]．西安電子科技大學(xué),2013．

[3]韓良,王德彬,龔煥．智能網(wǎng)球車的研制[J]．機(jī)電技術(shù),2011,34(1):49-54．

[4]呂騰飛,陸麗,何炳林,等．智能網(wǎng)球撿球機(jī)的研制[J]．電子世界,2013(12):68-69．

[5]李鵬．一種網(wǎng)球自動撿球機(jī):中國,201620686496．7[P]．2016-12-28．

馮嘉偉（1996—），江蘇南通人，大學(xué)本科，現(xiàn)就讀于東南大學(xué)吳健雄學(xué)院。