1.一種角速度計算方法,其特征在于,所述方法包括:
對當(dāng)前時間電機(jī)轉(zhuǎn)子的角度值進(jìn)行采集,獲取當(dāng)前角度值;
將當(dāng)前角度值的數(shù)據(jù)類型轉(zhuǎn)換為預(yù)設(shè)位數(shù)m的無符號整型,將轉(zhuǎn)換后角度值的有效位左移(m-n)位,并將左移后得到的數(shù)值的非有效位補(bǔ)0,得到當(dāng)前修正角度值;所述n為所述有效位的位數(shù),m與n都為正整數(shù),且n≤m;
將所述當(dāng)前修正角度值與當(dāng)前時間鄰近的上一采集時間的修正角度值的數(shù)據(jù)差的數(shù)據(jù)類型定義為有符號整型,并計算所述數(shù)據(jù)差;
將所述數(shù)據(jù)差的有效位右移(m-n)位,得到有效數(shù)據(jù)差;
根據(jù)所述有效數(shù)據(jù)差計算并輸出角速度。
2.根據(jù)權(quán)利要求1所述的方法,其特征在于,在所述將所述數(shù)據(jù)差的數(shù)值的有效位右移(m-n)位之前,還包括:
判斷所述數(shù)據(jù)差是否大于預(yù)設(shè)值或小于所述預(yù)設(shè)值的負(fù)值,若是,對所述數(shù)據(jù)差進(jìn)行限幅處理。
3.根據(jù)權(quán)利要求2所述的方法,其特征在于,所述對所述數(shù)據(jù)差進(jìn)行限幅處理,包括:
當(dāng)所述數(shù)據(jù)差大于所述預(yù)設(shè)值時,將所述預(yù)設(shè)值確定為所述數(shù)據(jù)差;
當(dāng)所述數(shù)據(jù)差小于所述預(yù)設(shè)值的負(fù)值時,將所述預(yù)設(shè)值的負(fù)值確定為所述數(shù)據(jù)差。
4.根據(jù)權(quán)利要求1所述的方法,其特征在于,所述m的取值為16或32。
5.一種角速度計算裝置,其特征在于,所述裝置包括:
采集單元,用于對當(dāng)前時間電機(jī)轉(zhuǎn)子的角度值進(jìn)行采集,獲取當(dāng)前角度值;
轉(zhuǎn)換單元,用于將當(dāng)前角度值的數(shù)據(jù)類型轉(zhuǎn)換為預(yù)設(shè)位數(shù)m的無符號整型,將轉(zhuǎn)換后角度值的有效位左移(m-n)位,并將左移后得到的數(shù)值的非有效位補(bǔ)0,得到當(dāng)前修正角度值;所述n為所述有效位的位數(shù),m與n都為正整數(shù),且n≤m;
定義單元,用于將所述當(dāng)前修正角度值與當(dāng)前時間鄰近的上一采集時間的修正角度值的數(shù)據(jù)差的數(shù)據(jù)類型定義為有符號整型,并計算所述數(shù)據(jù)差;
處理單元,用于將所述數(shù)據(jù)差的有效位右移(m-n)位,得到有效數(shù)據(jù)差;
計算單元,用于根據(jù)所述有效數(shù)據(jù)差計算并輸出角速度。
6.根據(jù)權(quán)利要求5所述的裝置,其特征在于,所述裝置還包括:
判斷單元,用于判斷所述數(shù)據(jù)差是否大于預(yù)設(shè)值或小于所述預(yù)設(shè)值的負(fù)值,若是,對所述數(shù)據(jù)差進(jìn)行限幅處理。
7.根據(jù)權(quán)利要求6所述的裝置,其特征在于,所述判斷單元包括:
確定子單元,用于當(dāng)所述數(shù)據(jù)差大于所述預(yù)設(shè)值時,將所述預(yù)設(shè)值確定為所述數(shù)據(jù)差;當(dāng)所述數(shù)據(jù)差小于所述預(yù)設(shè)值的負(fù)值時,將所述預(yù)設(shè)值的負(fù)值確定為所述數(shù)據(jù)差。
8.根據(jù)權(quán)利要求5所述的裝置,其特征在于,所述m的取值為16或32。