連續(xù)軌跡中“拐點”判斷方法如所示設(shè)V1為機床在接點A處的速度大小，V2為機床在接點B處的速度大小，V3為機床在接點C處的速度大小。設(shè)插補周期為T，機床在z軸方向的分速度直線段軌跡AB與各軸的夾角分別為α2，β2，γ2，如果此時機床的速度大小不變而速度方向，即速度變?yōu)檠刂本€段AB方向，如果有任意一個值大于Q，則認(rèn)為此時相鄰的上下兩段軌跡的接點是“拐點”，此時機床不能以上段軌跡的結(jié)束速度V1直接改變速度方向后執(zhí)行下一段軌跡，也就是說在到達(dá)上段軌跡OA終點時需要減速，直到機床速度的速度大小滿足等式①所敘條件。

　　如果軌跡中有圓弧曲線，則應(yīng)該分別求出該圓弧曲線的起點和終點切線斜率，因為圓弧的起點速度方向和終點速度方向不同。然后按照同樣的方式判斷軌跡的交點是否是“拐點”。方法的具體步驟我們應(yīng)該怎樣在運動過程中找出這些“拐點”呢就像開車一樣，只有我們知道了前方有急轉(zhuǎn)彎的時，我們才能預(yù)先減速。同樣的道理，我們應(yīng)該在機床執(zhí)行到這段軌跡時就應(yīng)該知道這段軌跡和下段軌跡的交點是否是“拐點”，如果是則我們應(yīng)該在哪個地方開始減速然后計算軌跡與各坐標(biāo)軸的夾角（如果是圓弧則起點和終點切線與坐標(biāo)軸的夾角都需計算），直到處理完該數(shù)組中所有的軌跡。下一步求出該數(shù)組中每段軌跡的長度（不是總長，而是單獨各段軌跡段的長度）。然后從未被處理的軌跡開始，都是直線，還是上段軌跡是直線下段軌跡是圓弧，還是上段軌跡是圓弧下段軌跡是直線，或上下兩段軌跡都是圓弧。然后按給定的加速度進(jìn)行加速計算（相當(dāng)于用軟件模擬運動過程），直到該段軌跡的終點，得到該點的速度值（在這個過程中還需要判斷速度是否超過了設(shè)定的*高速度），處理完一段軌跡時還要把該段軌跡的長度與All＿length變量相加（All＿length這個變量用來保存連續(xù)軌跡段的總長，在以后計算減速點時有用到）。

　　一直做減速運動。根據(jù)相映的運動我們可以根據(jù)勻加速運動或等差數(shù)列的公式求出減速點，然后我們將處理后的N（N＜60）段軌跡參數(shù)和所求出的減速點保存在數(shù)組dispoased中，然后向下位機傳送數(shù)據(jù)，然后上位機再向數(shù)組no＿disposal中送N段沒有處理的軌跡參數(shù)，下位機得到處理好的數(shù)據(jù)后，再根據(jù)插補算法計算插補量控制機床的運行，并且把每次的插補量累加起來和減速點進(jìn)行比較，看是否應(yīng)繼續(xù)加速還是勻速，如果累加量Length＞＝Down＿length就開始按照設(shè)定的加速度開始減速，不斷重復(fù)⑴到⑹直到走完所有的軌跡，這樣機床就能連續(xù)的做加減速運動。還有一個問題是，如果在no＿disposal數(shù)組軌跡中沒有“拐點”時，我們不要把這60段軌跡都存放到數(shù)組dispoased中，這樣是為了防止，在這60段軌跡之后有“拐點”，而我們沒有足夠長的距離來減速到V1，這樣就會造成丟步或超程。我們應(yīng)該在這60段中選擇一個點作為結(jié)束點，選擇結(jié)束點的依據(jù)是，留出從結(jié)束點速度按照勻減速運動減速到啟動速度F時所需的長度即可。

　　小結(jié)雖然這種處理方式不是*好的方式，但是比較簡單容易實現(xiàn)，可以用在精度要求不是很高的數(shù)控系統(tǒng)中。我們已經(jīng)將這種方法成功的應(yīng)用到我們的機器上了并且加工出比較復(fù)雜的工件?？偨Y(jié)本文研究了自抗擾控制器的基本原理，并將自抗擾控制器成功應(yīng)用到某型伺服跟蹤裝置的伺服系統(tǒng)設(shè)計中。實際系統(tǒng)測試數(shù)據(jù)表明采用自抗擾控制器的情況下伺服系統(tǒng)各項指標(biāo)滿足要求，且均優(yōu)于采用傳統(tǒng)PID控制器的情況，解決了系統(tǒng)響應(yīng)快速性與超調(diào)的矛盾的，同時克服了系統(tǒng)模型難以建立給系統(tǒng)設(shè)計帶來的困難，也使系統(tǒng)具有較好的抗擾性和魯棒性。此外，本論文的研究工作還對無模型控制方法在實際系統(tǒng)中的應(yīng)用研究具有重要的參考價值。