[發(fā)明專利]基于狀態(tài)機(jī)原理的插補(bǔ)控制方法

在審

• 申請(qǐng)?zhí)枺?/td>: 201410850586.0
• 申請(qǐng)日: 2014-12-30
• 公開(kāi)（公告）號(hào): CN104597848A
• 公開(kāi)（公告）日: 2015-05-06
• 發(fā)明（設(shè)計(jì)）人: 唐艷麗;潘再生;施一明;童慶;王挺
• 申請(qǐng)（專利權(quán)）人: 浙江中控研究院有限公司
• 主分類號(hào): G05B19/4103
• 分類號(hào): G05B19/4103
• 代理公司: 上海漢聲知識(shí)產(chǎn)權(quán)代理有限公司 31236
• 代理人: 胡晶

1.一種基于狀態(tài)機(jī)原理的插補(bǔ)控制方法，通過(guò)基于IP核上插補(bǔ)控制模塊來(lái)實(shí)現(xiàn)，包括如下步驟：

S1：初始化被積函數(shù)寄存器和余數(shù)寄存器；

S2：依據(jù)選定的進(jìn)給軸，得到插補(bǔ)的輸出脈沖數(shù)以及左移規(guī)格化處理所需移位次數(shù)；

S3：對(duì)被積函數(shù)寄存器中接收到的數(shù)據(jù)依據(jù)步驟S2中得到的所需移位次數(shù)進(jìn)行左移規(guī)格化處理，對(duì)余數(shù)寄存器進(jìn)行半加載初始化賦值；

S4：依據(jù)插補(bǔ)的輸出脈沖數(shù)對(duì)被積函數(shù)寄存器和余數(shù)寄存器進(jìn)行累加操作；

S5：判斷余數(shù)寄存器的溢出條件是否滿足；

若滿足，則產(chǎn)生并輸出溢出脈沖，進(jìn)入步驟S6；

若不滿足，則重復(fù)步驟S4，進(jìn)行下一次累加；

S6：更新動(dòng)點(diǎn)坐標(biāo)和被積函數(shù)寄存器值，判斷插補(bǔ)的終點(diǎn)條件是否滿足；

若滿足，則所述插補(bǔ)控制模塊進(jìn)入空閑狀態(tài)；

若不滿足，則重復(fù)步驟S4，進(jìn)行下一次累加。

2.如權(quán)利要求1所述的基于狀態(tài)機(jī)原理的插補(bǔ)控制方法，其特征在于：用于直線插補(bǔ)。

3.如權(quán)利要求1所述的基于狀態(tài)機(jī)原理的插補(bǔ)控制方法，其特征在于：用于圓弧插補(bǔ)。

4.如權(quán)利要求3所述的基于狀態(tài)機(jī)原理的插補(bǔ)控制方法，其特征在于：在所述步驟S6中，重復(fù)步驟S4時(shí)：

若x軸方向到達(dá)終點(diǎn)，y軸方向未到達(dá)終點(diǎn)，則針對(duì)y軸方向?qū)?yīng)的被積函數(shù)寄存器和余數(shù)寄存器進(jìn)行累加操作；針對(duì)x軸方向?qū)?yīng)的被積函數(shù)寄存器和余數(shù)寄存器清零；然后進(jìn)入步驟S5；

若y軸方向到達(dá)終點(diǎn)，x軸方向未到達(dá)終點(diǎn)，則針對(duì)x軸方向?qū)?yīng)的被積函數(shù)寄存器和余數(shù)寄存器進(jìn)行累加操作；針對(duì)y軸方向?qū)?yīng)的被積函數(shù)寄存器和余數(shù)寄存器清零；然后進(jìn)入步驟S5；

若x、y軸方向均為到達(dá)終點(diǎn)，則針對(duì)x、y軸方向?qū)?yīng)的被積函數(shù)寄存器和余數(shù)寄存器均進(jìn)行累加操作；然后進(jìn)入步驟S5。

5.如權(quán)利要求3所述的基于狀態(tài)機(jī)原理的插補(bǔ)控制方法，其特征在于：在所述步驟S5中，在滿足溢出條件的情況下，還進(jìn)行當(dāng)前動(dòng)點(diǎn)所在象限的判斷；

然后根據(jù)當(dāng)前動(dòng)點(diǎn)所在象限和動(dòng)點(diǎn)運(yùn)動(dòng)趨勢(shì)，在余數(shù)寄存器溢出的情況下，選擇對(duì)應(yīng)的正方向驅(qū)動(dòng)脈沖或負(fù)方向驅(qū)動(dòng)脈沖進(jìn)行輸出。

6.如權(quán)利要求1所述的基于狀態(tài)機(jī)原理的插補(bǔ)控制方法，其特征在于：在進(jìn)行半加載初始化賦值的過(guò)程中，所述余數(shù)寄存器的最高有效位設(shè)置為1，其余各位均設(shè)置為0。

7.如權(quán)利要求1所述的基于狀態(tài)機(jī)原理的插補(bǔ)控制方法，其特征在于：在進(jìn)行左規(guī)格化處理時(shí)，將被積函數(shù)寄存器中的數(shù)同時(shí)左移，并記下左移位數(shù)，直到最左一位成為規(guī)格化數(shù)為止。

8.如權(quán)利要求1所述的基于狀態(tài)機(jī)原理的插補(bǔ)控制方法，其特征在于：用于螺旋線插補(bǔ)。