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

　　當(dāng)然也可以采用更嚴(yán)格的方法來判斷，只需調(diào)整定時(shí)中斷的時(shí)間和計(jì)數(shù)值即可。

　　此條件在進(jìn)入直道后總能滿足，所以作為第一種直道判別方式的補(bǔ)充，保證直道的穩(wěn)定可靠識(shí)別。

　　直線穩(wěn)定控制策略：

　　小車出彎后，由于舵機(jī)的反應(yīng)不靈敏，智能車會(huì)發(fā)生振蕩，隨后才能達(dá)到穩(wěn)定，為了盡早減小振蕩，采用如下方式控制小車出彎后的動(dòng)作：
    　在彎道策略中設(shè)置標(biāo)志位，進(jìn)入直線程序后，識(shí)別標(biāo)志位，對(duì)控制舵機(jī)轉(zhuǎn)向的公式采取修正設(shè)置。公式為： ;其中為最終送給舵機(jī)的控制量，為前排光電傳感器的返回轉(zhuǎn)角值，為后排紅外返回轉(zhuǎn)角值。分別為前后排傳感器的加權(quán)比例值。通常情況下為1，需要是則改變賦值。

　　當(dāng)小車從彎道進(jìn)入直道并成功識(shí)別出直道后，減小的值，由于后排傳感器距離小車的前輪(轉(zhuǎn)向輪)很近，小車中心偏離黑線時(shí)，不會(huì)在后排傳感器橫向位置產(chǎn)生很大位移(相對(duì)于前排傳感器)，故小車在直線上舵機(jī)調(diào)整的次數(shù)就會(huì)明顯減少，直線的穩(wěn)定性會(huì)好。同時(shí)，根據(jù)前后排不同傳感器的組合，給出不同的轉(zhuǎn)角策略(在程序中以列表的方式體現(xiàn))，近一步提高直線的穩(wěn)定控制能力。

　　當(dāng)在直線中車身傾斜時(shí)，如下圖情況，前排給出的被縮小后送入舵機(jī)公式，后排給出0信號(hào)，此時(shí)舵機(jī)會(huì)向左打很小的角度，維持直線的高速穩(wěn)定?！　?/p>

圖1

　　圖2所示的車身偏移情況大于圖1，雖然在縱向傳感器位置上沒有變化。此時(shí)前排4和后排傳感器3的組合，優(yōu)先滿足直線控制策略中的特定條件，直接把控制量送入舵機(jī)，使舵機(jī)向右轉(zhuǎn)動(dòng)較小角度?！　?/p>

圖2

　　圖3所示車身有更大的偏移，前排給出向右轉(zhuǎn)的信號(hào)，后排給出信號(hào)，被縮小后，與相加，抵消了部分向左轉(zhuǎn)的信號(hào)。最終的效果就是向左大很小的角度，維持直線的高速穩(wěn)定?！　?/p>

圖3

　　*注：左側(cè)傳感器給出的信號(hào)為負(fù)值，右側(cè)傳感器給出的信號(hào)為正值，這樣可以在公式中自然融合。

　　彎道識(shí)別方式、控制策略(90°彎、180°彎)

　　(僅以右彎作為示例)　　

 　　姿態(tài)1：識(shí)別為半徑大于50cm的彎(即半徑為100cm的彎)，不觸發(fā)彎道程序，舵機(jī)動(dòng)作較小，達(dá)到圓滑過彎，是速度損失最小的一種狀態(tài)。