專(zhuān)利名稱(chēng)：編碼器干擾控制系統(tǒng)及方法
技術(shù)領(lǐng)域：
本發(fā)明涉及伺服電機(jī)控制領(lǐng)域，更具體地說(shuō)，涉及一種編碼器干擾控制系統(tǒng)及方法。
背景技術(shù)：
伺服電機(jī)是指在伺服系統(tǒng)中控制機(jī)械元件運(yùn)轉(zhuǎn)的發(fā)動(dòng)機(jī)，是ー種輔助馬達(dá)間接變速裝置。伺服電機(jī)可進(jìn)行速度控制，位置精度非常準(zhǔn)確，可以將電壓信號(hào)轉(zhuǎn)化為轉(zhuǎn)矩和轉(zhuǎn)速以驅(qū)動(dòng)控制對(duì)象。目前，伺服電機(jī)被廣泛應(yīng)用于各類(lèi)自動(dòng)控制裝置中。在伺服電機(jī)系統(tǒng)中，對(duì)電機(jī)的位置、速度等控制信息通過(guò)與電機(jī)同軸的編碼器獲 得。然而，由于伺服電機(jī)的工作環(huán)境不同，周?chē)赡艽嬖谳^強(qiáng)的干擾，例如在高鐵門(mén)控應(yīng)用中。若編碼器信號(hào)受到干擾，則無(wú)法對(duì)電機(jī)進(jìn)行精確控制。目前的伺服系統(tǒng)主要采用硬件抗干擾電路實(shí)現(xiàn)編碼器信號(hào)濾波。然而，在ー些復(fù)雜環(huán)境下，硬件電路并不能完全實(shí)現(xiàn)濾波，而對(duì)于電機(jī)反饋信息而言，任何一個(gè)數(shù)據(jù)的跳變均會(huì)導(dǎo)致電機(jī)控制的不穩(wěn)定。特別是當(dāng)電磁環(huán)境較為復(fù)雜時(shí)，總線式編碼器的硬件抗干擾電路不能完全實(shí)現(xiàn)濾波，這將導(dǎo)致電機(jī)運(yùn)轉(zhuǎn)不平穩(wěn)，甚至異常。

發(fā)明內(nèi)容
本發(fā)明要解決的技術(shù)問(wèn)題在于，針對(duì)上述伺服電機(jī)因環(huán)境干擾而無(wú)法穩(wěn)定控制的問(wèn)題，提供一種編碼器干擾控制系統(tǒng)及方法。本發(fā)明解決上述技術(shù)問(wèn)題采用的技術(shù)方案是，提供一種編碼器干擾控制系統(tǒng)，包括信號(hào)獲取單元、第一判斷単元、第一限幅単元及第ニ限幅単元；其中所述信號(hào)獲取單元，用于從編碼器獲得位置反饋信號(hào)；所述第一判斷単元，用于在當(dāng)前原始增量的絕對(duì)值大于前次原始增量的絕對(duì)值的η倍時(shí)啟動(dòng)第二限幅單元并在當(dāng)前原始增量的絕對(duì)值小于或等于前次原始增量的絕對(duì)值的η倍時(shí)啟動(dòng)第一限幅単元，其中η>1，所述當(dāng)前原始增量為當(dāng)前位置反饋信號(hào)與前次位置反饋信號(hào)之差，所述前次原始?jí)埩繛榍皟纱挝恢梅答佇盘?hào)之差；所述第一限幅単元，用于確認(rèn)所述當(dāng)前位置反饋信號(hào)正常并將當(dāng)前限幅信號(hào)設(shè)為當(dāng)前位置反饋信號(hào)；所述第二限幅単元，用于確認(rèn)所述當(dāng)前位置反饋信號(hào)為干擾量并將當(dāng)前限幅信號(hào)設(shè)為前次限幅信號(hào)與前次限幅増量之和，所述前次限幅増量為前兩次限幅信號(hào)之差。在本發(fā)明所述的編碼器干擾控制系統(tǒng)中，所述系統(tǒng)還包括第二判斷単元及第三判斷単元；其中所述第二判斷単元，用于判斷前次位置反饋信號(hào)是否為干擾量，并在確認(rèn)前次位置反饋信號(hào)為干擾量時(shí)啟動(dòng)第三判斷單元進(jìn)行判斷，否則啟動(dòng)第一判斷單元進(jìn)行判斷；所述第三判斷単元，用于在當(dāng)前混合增量的絕對(duì)值大于之前第m次原始增量的絕對(duì)值的k倍時(shí)啟動(dòng)第二限幅單元并在當(dāng)前混合增量的絕對(duì)值小于或等于之前第m次原始?jí)埩康慕^對(duì)值的k倍時(shí)啟動(dòng)第一限幅単元，其中k>l，m為大于I的正整數(shù)，所述當(dāng)前混合增量為當(dāng)前位置反饋信號(hào)與前次限幅信號(hào)之差，所述之前第m次原始增量為之前第m次位置反饋信號(hào)與其前次位置反饋信號(hào)之差。
在本發(fā)明所述的編碼器干擾控制系統(tǒng)中，所述之前第m次位置反饋信號(hào)為距離當(dāng)前位置反饋信號(hào)最接近的一次非干擾量。在本發(fā)明所述的編碼器干擾控制系統(tǒng)中，所述系統(tǒng)還包括電機(jī)控制単元，用于根據(jù)當(dāng)前限幅信號(hào)進(jìn)行電機(jī)運(yùn)轉(zhuǎn)控制。本發(fā)明還提供一種編碼器干擾控制方法，該方法包括以下步驟步驟(a)從編碼器獲得位置反饋信號(hào)；步驟(b)判斷當(dāng)前原始增量的絕對(duì)值是否大于前次原始增量的絕對(duì)值的η倍，若所述當(dāng)前原始增量的絕對(duì)值小于或等于前次原始增量的絕對(duì)值的η倍，則執(zhí)行步驟(d)，否則執(zhí)行步驟(C)，其中η>1，所述當(dāng)前原始增量為當(dāng)前位置反饋信號(hào)與前次位置反饋信號(hào)之
差，所述前次原始?jí)埩繛榍皟纱挝恢梅答佇盘?hào)之差；步驟(c)確認(rèn)所述當(dāng)前位置反饋信號(hào)為干擾量并將當(dāng)前限幅信號(hào)設(shè)為前次限幅信號(hào)與前次限幅増量之和，然后返回步驟(a)，所述前次限幅増量為前兩次限幅信號(hào)之差；步驟(d)確認(rèn)所述當(dāng)前位置反饋信號(hào)正常并將當(dāng)前限幅信號(hào)設(shè)為當(dāng)前位置反饋信號(hào)，然后返回步驟U)。在本發(fā)明所述的編碼器干擾控制方法中，所述步驟(a)之后包括(al)判斷前次位置反饋信號(hào)是否為干擾量，若前次位置反饋信號(hào)為干擾量則執(zhí)行(a2)，否則執(zhí)行步驟(b)；(a2)判斷當(dāng)前混合增量的絕對(duì)值是否大于之前第m次原始增量的絕對(duì)值的k倍，若所述當(dāng)前混合增量的絕對(duì)值小于或等于之前第m次原始增量的絕對(duì)值的k倍，則執(zhí)行步驟(d)，否則執(zhí)行步驟(C)，其中k>l，m為大于I的正整數(shù)，所述當(dāng)前混合增量為當(dāng)前位置反饋信號(hào)與前次限幅信號(hào)之差，所述之前第m次原始增量為之前第m次位置反饋信號(hào)與其前次位置反饋信號(hào)之差。在本發(fā)明所述的編碼器干擾控制方法中，所述之前第m次原始?jí)埩繛榫嚯x當(dāng)前位置反饋信號(hào)最接近的一次非干擾量。在本發(fā)明所述的編碼器干擾控制方法中，所述步驟(C)和(d)中還包括使用當(dāng)前限幅信號(hào)進(jìn)行電機(jī)控制。本發(fā)明的編碼器控制系統(tǒng)及方法，通過(guò)對(duì)編碼器反饋信號(hào)進(jìn)行抗干擾處理，排除反饋信號(hào)因環(huán)境干擾而出現(xiàn)的跳變，從而實(shí)現(xiàn)對(duì)電機(jī)的精確控制。本發(fā)明可使伺服電機(jī)在現(xiàn)場(chǎng)干擾嚴(yán)重的環(huán)境下平穩(wěn)運(yùn)轉(zhuǎn)，較之前性能上顯著提高。


圖I是本發(fā)明編碼器干擾控制系統(tǒng)第一實(shí)施例的示意圖。圖2是本發(fā)明編碼器干擾控制系統(tǒng)第二實(shí)施例的示意圖。圖3是本發(fā)明編碼器干擾控制方法第一實(shí)施例的流程示意圖。圖4是本發(fā)明編碼器干擾控制方法第二實(shí)施例的流程示意圖。
具體實(shí)施例方式為了使本發(fā)明的目的、技術(shù)方案及優(yōu)點(diǎn)更加清楚明白，以下結(jié)合附圖及實(shí)施例，對(duì)本發(fā)明進(jìn)行進(jìn)ー步詳細(xì)說(shuō)明。應(yīng)當(dāng)理解，此處所描述的具體實(shí)施例僅僅用以解釋本發(fā)明，并不用于限定本發(fā)明。如圖I所示，是本發(fā)明編碼器干擾控制系統(tǒng)第一實(shí)施例的示意圖。該編碼器干擾控制系統(tǒng)包括信號(hào)獲取單元11、第一判斷単元12、第一限幅単元13及第ニ限幅単元14。具體地，上述各単元可位于伺服控制器中，并可以通過(guò)軟件、硬件或軟件和硬件的結(jié)合實(shí)現(xiàn)。信號(hào)獲取單元11用于從編碼器獲得位置反饋信號(hào)。上述編碼器與電機(jī)同軸，井隨電機(jī)轉(zhuǎn)子一起旋轉(zhuǎn)，從而其輸出信號(hào)可實(shí)時(shí)反映電機(jī)轉(zhuǎn)子的位置、速度等信息。第一判斷単元12用于在當(dāng)前原始?jí)埩?即當(dāng)前位置反饋信號(hào)與前次位置反饋信號(hào)之差，當(dāng)前位置反饋信號(hào)即為信號(hào)獲取單元11從編碼器即時(shí)獲取的位置反饋信號(hào)，前次位置反饋信號(hào)即為當(dāng)前位置反饋信號(hào)的前一次位置反饋信號(hào))的絕對(duì)值大于前次原始?jí)埩?即前兩次位置反饋信號(hào)之差)的絕對(duì)值的η倍時(shí)啟動(dòng)第二限幅単元14并在當(dāng)前原始?jí)埩康慕^對(duì)值小于或等于前次原始增量的絕對(duì)值的η倍時(shí)啟動(dòng)第一限幅単元11。上述的η>1，且η的值越接近I，系統(tǒng)的精度越高。第一限幅単元13用于在第一判斷単元12判斷當(dāng)前原始增量的絕對(duì)值小于或等于前次原始增量的絕對(duì)值的η倍時(shí)，確認(rèn)當(dāng)前位置反饋信號(hào)正常并將當(dāng)前限幅信號(hào)(即經(jīng)過(guò)限幅處理的位置反饋信號(hào))設(shè)為該當(dāng)前位置反饋信號(hào)。第二限幅単元14用于在第一判斷単元12判斷當(dāng)前原始增量的絕對(duì)值大于前次原始增量的絕對(duì)值的η倍時(shí)，確認(rèn)當(dāng)前位置反饋信號(hào)為干擾量并將當(dāng)前限幅信號(hào)設(shè)為前次限幅信號(hào)與前次限幅増量之和，其中前次限幅增量為前次限幅信號(hào)與前兩次限幅信號(hào)之差。此外，為了避免在出現(xiàn)連續(xù)的干擾量時(shí)上述系統(tǒng)出現(xiàn)誤判，在如圖2所示的本發(fā)明編碼器干擾控制系統(tǒng)的第二實(shí)施例中，除了包括信號(hào)獲取單元21、第一判斷単元23、第一限幅単元26及第ニ限幅単元25タト，還包括第二判斷単元22及第三判斷単元24。第二判斷単元22用于判斷信號(hào)獲取單元21獲取的前次位置反饋信號(hào)是否為干擾量，并在確認(rèn)前次位置反饋信號(hào)為干擾量時(shí)啟動(dòng)第三判斷単元24進(jìn)行相應(yīng)判斷，否則啟動(dòng)第一判斷単元23進(jìn)行相應(yīng)判斷。第三判斷単元24用于在第二判斷単元22判斷前次位置反饋信號(hào)為干擾量時(shí)，判斷當(dāng)前混合増量(即當(dāng)前位置反饋信號(hào)與前次限幅信號(hào))的絕對(duì)值是否大于之前第m次原始?jí)埩?即之前第m次位置反饋信號(hào)與其前次位置反饋信號(hào)之差)的絕對(duì)值的k倍，并在當(dāng)前混合增量的絕對(duì)值大于之前第m次原始增量的絕對(duì)值的k倍吋，使第二限幅単元25確認(rèn)當(dāng)前位置反饋信號(hào)為干擾量并將當(dāng)前限幅信號(hào)設(shè)為前次限幅信號(hào)與前次限幅増量之和；在當(dāng)前混合增量的絕對(duì)值小于或等于之前第m次原始增量的絕對(duì)值的k倍吋，使第一限幅単元26確認(rèn)當(dāng)前位置反饋信號(hào)正常并將當(dāng)前限幅信號(hào)設(shè)為當(dāng)前位置反饋信號(hào)。上述k>l，m為大于I的正整數(shù)，k越接近I，系統(tǒng)精度越高。特別地，上述的之前第m次原始?jí)埩繛榫嚯x當(dāng)前位置反饋信號(hào)最接近的一次非干擾量。此外，m也可根據(jù)系統(tǒng)的精度要求及系統(tǒng)環(huán)境自行設(shè)置。當(dāng)然，在實(shí)際應(yīng)用中，出現(xiàn)連續(xù)干擾量的情況極少，因此本發(fā)明第一實(shí)施例的系統(tǒng)即可較好地改善伺服電機(jī)的運(yùn)行控制。此外，在上述系統(tǒng)中，還可包括電機(jī)控制単元，用于根據(jù)當(dāng)前限幅信號(hào)進(jìn)行電機(jī)運(yùn) 轉(zhuǎn)控制。以下假設(shè)信號(hào)獲取單元11第i次采樣的絕對(duì)位置反饋為P (i)，相應(yīng)的第i_l次絕對(duì)位置反饋為P (i-Ι)，經(jīng)過(guò)限幅處理后的第i位置反饋信息為(i)，經(jīng)限幅處理的第i-Ι次位置反饋信息為p_limit(i-l),則三個(gè)位置增量信息函數(shù)分別為原始增量nz_diff(i)= p(i) _ p(i_l)或 p(i) _ p_limit (i_l)；混合增量mn_diff(i) = p (i) - p_limit(i_l)；限幅增量mk_diff(i)= p_limit(i_l) - p_limit(i_2)或 p(i) - p_limit (i-1)；則當(dāng)采樣的位置反饋信號(hào)中只有一個(gè)干擾量(即干擾量不連續(xù))時(shí)，若上述第一判斷單元12判斷abs(nz_diff (i))大于n*abs (nz_diff (i_l))時(shí)(η為大于或等于I的常數(shù)，可設(shè)置，該值越接近I則系統(tǒng)精度越高)，則第一限幅単元13確認(rèn)第i次絕對(duì)位置反饋 p(i)為ー個(gè)干擾量，·Ρ_1 η (; )的值設(shè)為 p_limit(i-l) + mk_diff(i_l);否則,第二限幅単元14確認(rèn)第i次絕對(duì)位置反饋P (i)不是干擾量，并將的值設(shè)為P (i)。在某些極端環(huán)境中，如果采樣的反饋信息中可能連續(xù)出現(xiàn)幾個(gè)干擾量時(shí)，例如，在出現(xiàn)第一個(gè)干擾量時(shí)，由于當(dāng)后續(xù)的位置反饋信號(hào)也是干擾量時(shí)，這兩個(gè)干擾量相等，即nz_diff(i) = P (i) - p (i-1) = O,即可能出現(xiàn)誤判。此時(shí),需通過(guò)第三判斷單元判斷abs (mn_diff)是否大于k*abs (nz_diff (i_m)) (k、m可設(shè)，其中k大于I, m為連續(xù)出現(xiàn)的干擾的個(gè)數(shù))，如果大于則P(i)是干擾量，P_limit(i)應(yīng)等于p_limit(i-l) + mk_diff (i-1);否則，p(i)不是干擾量，p_limit(i)等于 p(i)。如圖3所述，是本發(fā)明編碼器干擾控制方法第一實(shí)施例的流程圖。該方法包括以下步驟步驟S31 :從編碼器獲得位置反饋信號(hào)。上述編碼器與電機(jī)同軸，井隨電機(jī)轉(zhuǎn)子一起旋轉(zhuǎn)，從而其輸出信號(hào)可實(shí)時(shí)反映電機(jī)轉(zhuǎn)子的位置、速度等信息。步驟S32 :判斷當(dāng)前原始增量的絕對(duì)值是否大于前次原始增量的絕對(duì)值的η倍，若當(dāng)前原始增量的絕對(duì)值小于或等于前次原始增量的絕對(duì)值的η倍，則執(zhí)行步驟S34，否則執(zhí)行步驟S33，其中η>1，當(dāng)前原始增量為當(dāng)前位置反饋信號(hào)與前次位置反饋信號(hào)之差，前次原始?jí)埩繛榍皟纱挝恢梅答佇盘?hào)之差。步驟S33 :確認(rèn)當(dāng)前位置反饋信號(hào)為干擾量并將當(dāng)前限幅信號(hào)設(shè)為前次限幅信號(hào)與前次限幅増量之和，然后返回步驟S31，前次限幅増量為前兩次限幅信號(hào)之差。步驟S34:確認(rèn)當(dāng)前位置反饋信號(hào)正常并將當(dāng)前限幅信號(hào)設(shè)為當(dāng)前位置反饋信號(hào)，然后返回步驟S31。同樣地，為了避免在出現(xiàn)連續(xù)的干擾量時(shí)上述系統(tǒng)出現(xiàn)誤判，如圖4所示，是本發(fā)明編碼器干擾控制方法第二實(shí)施例的流程圖，該方法包括步驟S41 :從編碼器獲得位置反饋信號(hào)。步驟S42 :判斷前次位置反饋信號(hào)是否為干擾量，若前次位置反饋信號(hào)為干擾量則執(zhí)行步驟S43，否則執(zhí)行步驟S44。步驟S43 :判斷當(dāng)前原始增量的絕對(duì)值是否大于前次原始增量的絕對(duì)值的η倍，若當(dāng)前原始增量的絕對(duì)值小于或等于前次原始增量的絕對(duì)值的η倍，則執(zhí)行步驟S45，否則執(zhí) 行步驟S46，其中η>1，當(dāng)前原始增量為當(dāng)前位置反饋信號(hào)與前次位置反饋信號(hào)之差，前次原始?jí)埩繛榍皟纱挝恢梅答佇盘?hào)之差。步驟S44 :判斷當(dāng)前混合增量的絕對(duì)值是否大于前之前第m次原始增量的絕對(duì)值的k倍，若所述當(dāng)前混合增量的絕對(duì)值小于或等于之前第m次原始增量的絕對(duì)值的k倍，則執(zhí)行步驟S45，否則執(zhí)行步驟S46，其中k>l，m為大于I的正整數(shù)，當(dāng)前混合增量為當(dāng)前位置反饋信號(hào)與前次限幅信號(hào)之差，之前第m次原始增量為之前第m次位置反饋信號(hào)與其前次位置反饋信號(hào)之差。步驟S45 :確認(rèn)當(dāng)前位置反饋信號(hào)正常并將當(dāng)前限幅信號(hào)設(shè)為當(dāng)前位置反饋信號(hào)，然后返回步驟S41。 步驟S46 :確認(rèn)當(dāng)前位置反饋信號(hào)為干擾量并將當(dāng)前限幅信號(hào)設(shè)為前次限幅信號(hào)與前次限幅増量之和，然后返回步驟S41，前次限幅増量為前兩次限幅信號(hào)之差。在該實(shí)施例的方法中，之前第m次位置反饋信號(hào)為距離當(dāng)前位置反饋信號(hào)最接近的一次非干擾量。在具體應(yīng)用中，上述方法還可包括使用當(dāng)前限幅信號(hào)進(jìn)行電機(jī)控制。以上所述，僅為本發(fā)明較佳的具體實(shí)施方式
，但本發(fā)明的保護(hù)范圍并不局限于此，任何熟悉本技術(shù)領(lǐng)域的技術(shù)人員在本發(fā)明揭露的技術(shù)范圍內(nèi)，可輕易想到的變化或替換，都應(yīng)涵蓋在本發(fā)明的保護(hù)范圍之內(nèi)。因此，本發(fā)明的保護(hù)范圍應(yīng)該以權(quán)利要求的保護(hù)范圍為準(zhǔn)。
權(quán)利要求
1.一種編碼器干擾控制系統(tǒng)，其特征在于包括信號(hào)獲取單元、第一判斷單元、第一限幅單元及第二限幅單元；其中所述信號(hào)獲取單元，用于從編碼器獲得位置反饋信號(hào)；所述第一判斷單元，用于在當(dāng)前原始增量的絕對(duì)值大于前次原始增量的絕對(duì)值的η倍時(shí)啟動(dòng)第二限幅單元并在當(dāng)前原始增量的絕對(duì)值小于或等于前次原始增量的絕對(duì)值的η倍時(shí)啟動(dòng)第一限幅單元，其中η>1，所述當(dāng)前原始增量為當(dāng)前位置反饋信號(hào)與前次位置反饋信號(hào)之差，所述前次原始增量為前兩次位置反饋信號(hào)之差；所述第一限幅單元，用于確認(rèn)所述當(dāng)前位置反饋信號(hào)正常并將當(dāng)前限幅信號(hào)設(shè)為當(dāng)前位置反饋信號(hào)；所述第二限幅單元，用于確認(rèn)所述當(dāng)前位置反饋信號(hào)為干擾量并將當(dāng)前限幅信號(hào)設(shè)為前次限幅信號(hào)與前次限幅增量之和，所述前次限幅增量為前兩次限幅信號(hào)之差。
2.根據(jù)權(quán)利要求I所述的編碼器干擾控制系統(tǒng)，其特征在于所述系統(tǒng)還包括第二判斷單元及第三判斷單元；其中所述第二判斷單元，用于判斷前次位置反饋信號(hào)是否為干擾量，并在確認(rèn)前次位置反饋信號(hào)為干擾量時(shí)啟動(dòng)第三判斷單元進(jìn)行判斷，否則啟動(dòng)第一判斷單元進(jìn)行判斷；所述第三判斷單元，用于在當(dāng)前混合增量的絕對(duì)值大于之前第m次原始增量的絕對(duì)值的k倍時(shí)啟動(dòng)第二限幅單元并在當(dāng)前混合增量的絕對(duì)值小于或等于之前第m次原始增量的絕對(duì)值的k倍時(shí)啟動(dòng)第一限幅單元，其中k>l，m為大于I的正整數(shù)，所述當(dāng)前混合增量為當(dāng)前位置反饋信號(hào)與前次限幅信號(hào)之差，所述之前第m次原始增量為之前第m次位置反饋信號(hào)與其前次位置反饋信號(hào)之差。
3.根據(jù)權(quán)利要求2所述的編碼器干擾控制系統(tǒng)，其特征在于所述之前第m次位置反饋信號(hào)為距離當(dāng)前位置反饋信號(hào)最接近的一次非干擾量。
4.根據(jù)權(quán)利要求1-3中任一項(xiàng)所述的編碼器干擾控制系統(tǒng)，其特征在于所述系統(tǒng)還包括電機(jī)控制單元，用于根據(jù)當(dāng)前限幅信號(hào)進(jìn)行電機(jī)運(yùn)轉(zhuǎn)控制。
5.一種編碼器干擾控制方法，其特征在于該方法包括以下步驟 步驟Ca)從編碼器獲得位置反饋信號(hào)； 步驟(b)判斷當(dāng)前原始增量的絕對(duì)值是否大于前次原始增量的絕對(duì)值的η倍，若所述當(dāng)前原始增量的絕對(duì)值小于或等于前次原始增量的絕對(duì)值的η倍，則執(zhí)行步驟(d)，否則執(zhí)行步驟(c)，其中η>1，所述當(dāng)前原始增量為當(dāng)前位置反饋信號(hào)與前次位置反饋信號(hào)之差，所述前次原始增量為前兩次位置反饋信號(hào)之差； 步驟(c)確認(rèn)所述當(dāng)前位置反饋信號(hào)為干擾量并將當(dāng)前限幅信號(hào)設(shè)為前次限幅信號(hào)與前次限幅增量之和，然后返回步驟(a)，所述前次限幅增量為前兩次限幅信號(hào)之差； 步驟(d)確認(rèn)所述當(dāng)前位置反饋信號(hào)正常并將當(dāng)前限幅信號(hào)設(shè)為當(dāng)前位置反饋信號(hào)，然后返回步驟(a)。
6.根據(jù)權(quán)利要求5所述的編碼器干擾控制方法，其特征在于所述步驟(a)之后包括 (al)判斷前次位置反饋信號(hào)是否為干擾量，若前次位置反饋信號(hào)為干擾量則執(zhí)行(a2)，否則執(zhí)行步驟(b)； (a2)判斷當(dāng)前混合增量的絕對(duì)值是否大于之前第m次原始增量的絕對(duì)值的k倍，若所述當(dāng)前混合增量的絕對(duì)值小于或等于之前第m次原始增量的絕對(duì)值的k倍，則執(zhí)行步驟(d)，否則執(zhí)行步驟(C)，其中k>l，m為大于I的正整數(shù)，所述當(dāng)前混合增量為當(dāng)前位置反饋信號(hào)與前次限幅信號(hào)之差，所述之前第m次原始增量為之前第m次位置反饋信號(hào)與其前次位置反饋信號(hào)之差。
7.根據(jù)權(quán)利要求6所述的編碼器干擾控制方法，其特征在于所述之前第m次原始增量為距離當(dāng)前位置反饋信號(hào)最接近的一次非干擾量。
8.根據(jù)權(quán)利要求5-7中任一項(xiàng)所述的編碼器干擾控制方法，其特征在于所述步驟(c)和(d)中還包括使用當(dāng)前限幅信號(hào)進(jìn)行電機(jī)控制。
全文摘要
本發(fā)明提供了一種編碼器干擾控制系統(tǒng)，包括信號(hào)獲取單元、第一判斷單元、第一限幅單元及第二限幅單元；其中所述信號(hào)獲取單元，用于從編碼器獲得位置反饋信號(hào)；所述第一判斷單元，用于在當(dāng)前原始增量的絕對(duì)值大于前次原始增量的絕對(duì)值的n倍時(shí)啟動(dòng)第二限幅單元并在當(dāng)前原始增量的絕對(duì)值小于或等于前次原始增量的絕對(duì)值的n倍時(shí)啟動(dòng)第一限幅單元，其中n>1；所述第一限幅單元，用于將當(dāng)前限幅信號(hào)設(shè)為當(dāng)前位置反饋信號(hào)；所述第二限幅單元，用于將當(dāng)前限幅信號(hào)設(shè)為前次限幅信號(hào)與前次限幅增量之和。本發(fā)明還提供一種對(duì)應(yīng)的方法。本發(fā)明通過(guò)對(duì)編碼器反饋信號(hào)進(jìn)行抗干擾處理，排除反饋信號(hào)因環(huán)境干擾而出現(xiàn)的跳變，從而實(shí)現(xiàn)對(duì)電機(jī)的精確控制。
文檔編號(hào)H02P6/08GK102664571SQ20121014004
公開(kāi)日2012年9月12日 申請(qǐng)日期2012年5月8日 優(yōu)先權(quán)日2012年5月8日
發(fā)明者劉偉 申請(qǐng)人:深圳市匯川技術(shù)股份有限公司, 蘇州匯川技術(shù)有限公司, 蘇州默納克控制技術(shù)有限公司