采用爬山搜索算法確定光學聚焦位置。在自動聚焦使能信號有效后，驅(qū)動馬達從初始位置正轉(zhuǎn)8步，反轉(zhuǎn)8步，然后再反轉(zhuǎn)8步，正轉(zhuǎn)八步，回到初始位置。每轉(zhuǎn)1 步檢測聚焦評價函數(shù)模塊的輸出out值，將4個8步內(nèi)檢測到‘1’的個數(shù)分別保存為suml、sum2、sum3 sum4，接下來進行統(tǒng)計分析，如果suml≥16，則認為正轉(zhuǎn)方向為聚焦方向；若sum2≥6則認為反轉(zhuǎn)方向為聚焦方向；如果suml、sum2都未大 于等于6，則計算suml+sum4和sum2+sum3；如果suml+sum4≥sum2+sum3，則認為正轉(zhuǎn)方向為聚焦方向，否則認為反轉(zhuǎn)方向為 聚焦方向。確定出聚焦方向后驅(qū)動步進馬達帶動鏡頭向聚焦方向一步一步轉(zhuǎn)動，每轉(zhuǎn)一步檢測聚焦評價函數(shù)算法模塊的輸出OUT值，若連續(xù)轉(zhuǎn)的2步輸出out都 為‘0’，則認為超過最清晰位置，則驅(qū)動步進馬達倒退2步，鏡頭達到最佳聚焦位置。
步進馬達驅(qū)動包括變焦馬達驅(qū)動和聚焦馬達驅(qū)動，變焦馬達實現(xiàn)變倍，聚焦馬達用來聚焦。變焦馬達和聚焦馬達的勵磁方式不同，變焦馬達采用2相勵磁方式，見表 l。聚焦馬達采用的是1．2相勵磁方式，見表2。其中A+、A-分別代表A相繞組正端和負端功率橋控制信號，B+、B-分別代表B相繞組正端和負端功率橋 控制信號。按照表中所示的電平信號，外加在步進馬達的兩組線圈上，利用線圈間脈沖的相位差產(chǎn)生的扭矩來驅(qū)動馬達步進工作。按照表中所示的脈沖順序，從左向 右變化可實現(xiàn)步進馬達的反轉(zhuǎn)；反之則實現(xiàn)正轉(zhuǎn)。以變焦馬達驅(qū)動為例，在FP-GA內(nèi)設(shè)計一個狀態(tài)機，實現(xiàn)4個狀態(tài)間的狀態(tài)轉(zhuǎn)移，每一次變倍使能有效時，根 據(jù)當前狀態(tài)轉(zhuǎn)移，變倍方向轉(zhuǎn)移到下一個相鄰狀態(tài)，輸出該狀態(tài)時對應的4個控制電平信號，驅(qū)動馬達轉(zhuǎn)動，實現(xiàn)變倍功能。需要注意的是，由于FPGA輸出脈沖 信號的驅(qū)動電平和電流與步進馬達的驅(qū)動要求不匹配，應在FPGA輸出引腳外接驅(qū)動橋電路。