基于雙排傳感器的循跡策略研究

　　姿態(tài)2：識別為90°/180°彎，舵機轉(zhuǎn)角加大，將直道穩(wěn)定程序轉(zhuǎn)換為彎道控制程序，并啟動剎車制動程序(判斷當(dāng)前速度大小與給定此條件下極限速度值的差距，以程序執(zhí)行周期為單位調(diào)整剎車力度)。剎車結(jié)束后，采取加速策略彌補剎車速度的損失。(加速度小于直線加速度)

　　彎道控制策略：轉(zhuǎn)換到彎道程序后。首先，增大舵機轉(zhuǎn)角控制公式中的值，略微增大對彎道不敏感的的值。使相同的傳感器在彎道中的轉(zhuǎn)角更大，以適應(yīng) 90°/180°彎等需要大轉(zhuǎn)向的彎。此策略更適應(yīng)今年新出現(xiàn)的大波浪彎。之后，把傳感器中心左移一個傳感器(針對右彎)，達到切內(nèi)彎的效果。進入直道后取消中心左移。

　　*注：前排傳感器與前輪之間的距離也會對小車的切內(nèi)彎效果產(chǎn)生影響。

　　我們的前排傳感器與與小車距離10cm左右，在橫向傳感器布局上稍加調(diào)整，即使不加任何切內(nèi)彎的控制策略，仍會有切內(nèi)彎的效果。程序中優(yōu)化了這種過彎方式，加入了平滑過彎，及時判斷出彎策略。

　　下圖為實測切內(nèi)彎效果;圖中情況滿足直線預(yù)測加速策略，下一個動作為直線加速。(圖為視頻文件中截取的照片)　　

　　

　　S彎識別方式及控制策略

　　以下圖為例闡述彎道策略。雙排紅外優(yōu)于單排最明顯的地方就在與S彎道。通過S彎的最佳方式是直行通過。

　　從圖中也可以看出，此時的情況智能車只要直行就可以，所以我們把舵機轉(zhuǎn)角控制的公式中的值進行調(diào)整，使之在此種情況下近似直行即可。也就是說，讓小車在行進中切每個彎的內(nèi)線。所以，我們適當(dāng)增大后排k值比重，前排k值減少?！　?/p>

 

　　S彎入彎情況及S彎中策略控制狀態(tài)（上圖）

　　(1)入S彎時，由于后給出的轉(zhuǎn)角值為0， 
        (2)入S彎的第二個狀態(tài)。由于前排給出向前排給出的左轉(zhuǎn)角度k值被縮小，小車右的轉(zhuǎn)角，后排也給出向右的轉(zhuǎn)角。此時，向左轉(zhuǎn)很小角度。 兩個量之和作為舵機的控制量，此擴大的控制量被舵機執(zhí)行，達到切內(nèi)彎的效果。
　　(3)此時傳感器給出的組合是出彎時加速狀態(tài)。此處分兩種情況：
     　　<1>速度慢時，小車嚴格循跡時，沒有過多的晃動，即沒有碰到1號或7號前排光電管時，沒有觸發(fā)彎道程序，故不存在出彎加速的判斷，可順利通過此彎，不會出現(xiàn)振蕩。
     　　<2>速度快時，遇到S彎，小車晃動較大，會觸發(fā)彎道程序，隨即啟動剎車制動程序，可有效抑制小車的晃動，使小車嚴格循跡。

　　*注：從兩屆的比賽跑道來看，一般都是大彎后，接S彎，出彎的速度不快，可以穩(wěn)定循跡。在決賽的跑道上可能會出現(xiàn)長直線接S彎的情況，此時車速很快，遇到S彎會有較大晃動，使1或7號光電管觸發(fā)剎車程序，使速度降低，達到順利通過S彎的目的。