[發明專利]一種AFS執行器的控制方法和控制裝置

有效

• 申請號: 201210392470.8
• 申請日: 2012-10-16
• 公開（公告）號: CN102874172A
• 公開（公告）日: 2013-01-16
• 發明（設計）人: 程愛明;王文平;楊軒;李海巖
• 申請（專利權）人: 北京經緯恒潤科技有限公司
• 主分類號: B60Q1/08
• 分類號: B60Q1/08
• 代理公司: 北京集佳知識產權代理有限公司 11227
• 代理人: 王寶筠

1.一種AFS執行器的控制方法，其特征在于，所述AFS執行器包括步進電機、直線電機和燈頭，所述步進電機的輸出軸與固定所述直線電機的蝸輪的齒輪相嚙合，所述直線電機的輸出軸通過球副結構與所述燈頭相連，該控制方法包括：

接收燈頭調節指令，所述燈頭調節指令中包括所述燈頭的水平方向上的第一旋轉角度和豎直方向上的第二旋轉角度；

獲取所述直線電機的中心軸到所述燈頭的水平旋轉軸的第一距離、所述齒輪的旋轉軸到燈頭中心線的第二距離、所述球副結構的中心到所述燈頭的中心線的第三距離；

依據所述燈頭的第一旋轉角度和第二旋轉角度，以及所述第一距離、第二距離和第三距離，確定控制所述步進電機運行步數的第一控制信號和控制所述直線電機運行步數的第二控制信號；

將所述第一控制信號發送至所述步進電機，并控制所述步進電機運行與所述第一控制信號對應的運行步數，以使得所述直線電機通過所述蝸輪接受所述步進電機傳輸的旋轉運動；

將所述第二控制信號發送至所述直線電機，并控制所述直線電機運行與所述第二控制信號對應的運行步數，使得所述直線電機直線輸出與所述第二控制信號對應的位移，以使得所述直線電機結合所述旋轉運動和直線輸出帶動所述燈頭在水平方向旋轉第一旋轉角度并在豎直方向旋轉第二旋轉角度。

2.根據權利要求1所述的控制方法，其特征在于，所述依據所述燈頭的第一旋轉角度和第二旋轉角度，以及所述第一距離、第二距離和第三距離，確定控制所述步進電機運行步數的第一控制信號和控制所述直線電機運行步數的第二控制信號包括：

依據所述燈頭的第一旋轉角度和第二旋轉角度，以及獲取的所述第一距離、第二距離和第三距離，計算得到所述直線電機待轉動的位移量和所述齒輪旋轉的角度；

依據所述直線電機的待轉動的位移量和所述直線電機的每運轉一步所產生的位移量，計算得到所述直線電機的待運轉的運行步數；

依據所述齒輪旋轉的角度，以及所述步進電機的步距角和齒輪傳動機構的總傳動比，計算得到步進電機的待運轉的運行步數；

依據所述步進電機待運轉的運行步數生成第一控制信號，依據所述直線電機的待運轉的運行步數生成第二控制信號。

3.根據權利要求2所述的控制方法，其特征在于，所述依據所述燈頭的第一旋轉角度和第二旋轉角度，以及獲取的所述第一距離、第二距離和第三距離，計算得到所述直線電機待轉動的位移量和所述齒輪旋轉的角度包括：

所述齒輪旋轉角度的計算式包括：

θ=arctan-l1tanαh1+(l1tanα)2+l12tanβ-l0cosβ]]>所述直線電機待轉動的位移量計算式包括：

s=(l1tanα)2+(h1+(l1tanα)2+l12tanβ-l0cosβ)2-h1+l0]]>

其中，θ表示齒輪旋轉角度，s表示直線電機待轉動的位移量，α表示燈頭的第一旋轉角度、β表示第二旋轉角度、l₁表示第一距離、h₁表示第二距離、l₀表示第三距離。