[發(fā)明專利]一種基于象限標(biāo)定模型的角度傳感器檢測(cè)方法

有效

• 申請(qǐng)?zhí)枺?/td>: 202011165817.6
• 申請(qǐng)日: 2020-10-27
• 公開（公告）號(hào): CN112414355B
• 公開（公告）日: 2022-06-10
• 發(fā)明（設(shè)計(jì)）人: 韓忠來(lái);何光義;王運(yùn)生;劉程;楊玉杰
• 申請(qǐng)（專利權(quán)）人: 徐州威卡電子控制技術(shù)有限公司
• 主分類號(hào): G01B21/22
• 分類號(hào): G01B21/22
• 代理公司: 南京縱橫知識(shí)產(chǎn)權(quán)代理有限公司 32224
• 代理人: 張歡歡

1.一種基于象限標(biāo)定模型的角度傳感器檢測(cè)方法，其特征是，包括：

基于選取的標(biāo)定點(diǎn)對(duì)角度傳感器進(jìn)行標(biāo)定，獲得各標(biāo)定點(diǎn)對(duì)應(yīng)的標(biāo)定參數(shù)，所述標(biāo)定點(diǎn)包括區(qū)分四個(gè)象限的標(biāo)定點(diǎn)和每個(gè)象限內(nèi)至少一個(gè)標(biāo)定點(diǎn)；

獲取加速度芯片采集的加速度變量原始值；

根據(jù)標(biāo)定參數(shù)和加速度原始值，計(jì)算得出角度值；

所述標(biāo)定點(diǎn)分別為0、90、180、270、45、135、225、315角度值；

所述根據(jù)標(biāo)定參數(shù)和加速度原始值，計(jì)算得出角度值，包括：

(1)當(dāng)ady＜＝offset_y1且adx＜o(jì)ffset_x1時(shí)，角度值計(jì)算公式為：

angle＝((offset_y1-ady)/(offset_x1-adx))*(1.01+(sensitive1/1000.00)-((2100-adx)/80000.00))

(2)當(dāng)ady＜o(jì)ffset_y2且adx＞offset_x1時(shí)，角度值計(jì)算公式為：

angle＝((offset_y2-ady+0.00)/(adx-offset_x1))*(1.01+(sensitive2/1000.00)+((adx-2000)/80000.00))

(3)當(dāng)ady＞＝offset_y2且adx＞offset_x2時(shí)，角度值計(jì)算公式為：

angle＝((ady-offset_y2+0.00)/(adx-offset_x2))*(1.01+(sensitive3/1000.00)-((ady-2000)/70000.00))

(4)當(dāng)ady＞offset_y1且adx＜o(jì)ffset_x2時(shí)，角度值計(jì)算公式為：

angle＝((ady-offset_y1+0.00)/(offset_x2-adx))*(1.01+(sensitive4/1000.00)-((ady-2000)/70000.00))

其中，adx為x軸方向加速度值，ady為y軸方向?qū)崟r(shí)加速度值，offset_x1為90標(biāo)定點(diǎn)的標(biāo)定參數(shù)，offset_x2為270標(biāo)定點(diǎn)的標(biāo)定參數(shù)，offset_y1為0標(biāo)定點(diǎn)的標(biāo)定參數(shù)，offset_y2為180標(biāo)定點(diǎn)的標(biāo)定參數(shù)，angle為角度的弧度值，sensitive1為45標(biāo)定點(diǎn)的標(biāo)定參數(shù)，sensitive2為135標(biāo)定點(diǎn)的標(biāo)定參數(shù)，sensitive3為225標(biāo)定點(diǎn)的標(biāo)定參數(shù)，sensitive4為315標(biāo)定點(diǎn)的標(biāo)定參數(shù)。

2.根據(jù)權(quán)利要求1所述的一種基于象限標(biāo)定模型的角度傳感器檢測(cè)方法，其特征是，在計(jì)算得出角度值之后，還包括：將角度值擴(kuò)大若干倍后輸出，若干倍為20倍。

3.根據(jù)權(quán)利要求1所述的一種基于象限標(biāo)定模型的角度傳感器檢測(cè)方法，其特征是，在計(jì)算得出角度值之后，還包括根據(jù)角度傳感器左置、右置判斷條件，確定角度傳感器的角度使用區(qū)間。

4.根據(jù)權(quán)利要求3所述的一種基于象限標(biāo)定模型的角度傳感器檢測(cè)方法，其特征是，所述根據(jù)角度傳感器左置、右置判斷條件，確定角度傳感器的使用區(qū)間包括：

如果是左置，則使用的是270-360度角度區(qū)間，如果是右置，則使用的0-90度角度區(qū)間。

5.根據(jù)權(quán)利要求1所述的一種基于象限標(biāo)定模型的角度傳感器檢測(cè)方法，其特征是，在計(jì)算得出角度值之后，還包括對(duì)角度值進(jìn)行濾波。

6.根據(jù)權(quán)利要求5所述的一種基于象限標(biāo)定模型的角度傳感器檢測(cè)方法，其特征是，所述濾波的公式為：

tts_log_cal＝(tts_cal+tts_old*(filter_Value_cal-1))/filter_Value_cal

其中，tts_cal為角度輸出值，tts_old為上一次濾波值，filter_Value_cal為濾波因子，tts_log_cal為經(jīng)濾波后的實(shí)時(shí)值。

7.根據(jù)權(quán)利要求6所述的一種基于象限標(biāo)定模型的角度傳感器檢測(cè)方法，其特征是，還包括：如果判斷角度在一定時(shí)間內(nèi)持續(xù)上升或下降，則調(diào)整濾波因子。