逐點(diǎn)比較法插補(bǔ)C語言程序

1、精選優(yōu)質(zhì)文檔-傾情為你奉上/該函數(shù)在VC+6.0下編譯測(cè)試通過，可實(shí)現(xiàn)直線、圓弧、完整圓的逐點(diǎn)比較法插補(bǔ)；并可將插補(bǔ)函數(shù)計(jì)算出的數(shù)/據(jù)點(diǎn)寫入xxx.txt文件中/若有任何疑問，歡迎郵件聯(lián)系，/版權(quán)所有，侵權(quán)必究。轉(zhuǎn)載時(shí)請(qǐng)注明來自大連理工機(jī)械工程學(xué)院Deanjiang#include<stdio.h>#include<math.h>#include<stdlib.h>/*/* 函數(shù)名: InsertPoint */* 功 能：控制機(jī)床各軸進(jìn)給并將進(jìn)給結(jié)果寫入文件中*/* 參 數(shù)：double x, double y 插補(bǔ)點(diǎn) 單位:毫米*/* 說 明：與機(jī)床硬件

2、關(guān)聯(lián)，每產(chǎn)生一個(gè)點(diǎn)調(diào)用一次*/*/void InsertPoint(double xCur,double yCur)extern FILE *fp;char ch=10;printf("xCur=%f,yCur=%fn",xCur,yCur);fprintf(fp,"%f,%f",xCur,yCur); fputc(ch,fp);/*/* 函數(shù)名: Judge_Quadrant */* 功 能：判斷參數(shù)坐標(biāo)的所在象限并返回相應(yīng)象限值*/* 參 數(shù)：double xmm */*double ymm*/*/unsigned short Judge_Quadr

3、ant(double x, double y)unsigned short nDir;if (x>=0) /象限判斷if (y>=0) nDir=1;return 1;else nDir=4;return 4;else if (y>=0) nDir=2;return 2;else nDir=3;return 3;/*/* 函數(shù)名: PBP_Line */* 功 能：逐點(diǎn)比較法直線插補(bǔ)*/* 參 數(shù)：double step步長mm*/*double XEnd, double YEnd插補(bǔ)終點(diǎn)mm*/*/void PBP_Line(double step, double XEnd

4、, double YEnd)double lDevVal; /偏差值double xCurVal=0,yCurVal=0; /當(dāng)前點(diǎn)的實(shí)際位置long StepMount; /插補(bǔ)總步數(shù)long StepCount=0; /插補(bǔ)次數(shù)計(jì)數(shù)器unsigned short nDir; /當(dāng)前點(diǎn)所在象限 nDir=Judge_Quadrant(XEnd,YEnd); /象限判斷XEnd=labs(XEnd);YEnd=labs(YEnd);StepMount=(long) (XEnd+YEnd)/step;lDevVal=yCurVal*XEnd-xCurVal*YEnd; while (StepCo

5、unt<StepMount) /終點(diǎn)判別/if (lDevVal>=0) /偏差=0switch(nDir) case 1:xCurVal+=step;InsertPoint(xCurVal,yCurVal);break;case 2:xCurVal-=step;InsertPoint(xCurVal,yCurVal);break;case 3: xCurVal-=step;InsertPoint(xCurVal,yCurVal);break;case 4:xCurVal+=step;InsertPoint(xCurVal,yCurVal);break;lDevVal-=YEnd;

6、else /偏差<0switch(nDir) case 1:yCurVal+=step;InsertPoint(xCurVal,yCurVal);break;case 2:yCurVal+=step;InsertPoint(xCurVal,yCurVal);break;case 3:yCurVal-=step;InsertPoint(xCurVal,yCurVal);break;case 4:yCurVal-=step;InsertPoint(xCurVal,yCurVal);break;lDevVal+=XEnd;StepCount+; /*/* 函數(shù)名: PBP_Circle */*

7、 功 能：逐點(diǎn)比較法圓弧插補(bǔ)*/* 參 數(shù)：double step步長mm*/*double XStart,double YStart插補(bǔ)起點(diǎn)mm*/*double XEnd,double YEnd插補(bǔ)終點(diǎn)mm*/*double radius圓弧半徑mm*/* bool bIsCW圓弧插補(bǔ)方向0或1 */*/void PBP_Circle(double step, double XStart, double YStart, double XEnd,double YEnd, double radius, int bIsCW)double lDevVal,goallDevVal;/當(dāng)前誤差和與終點(diǎn)

8、的差值double xCurVal=XStart,yCurVal=YStart;/當(dāng)前坐標(biāo) unsigned short nDir;/象限long stepcount=0;/步數(shù)lDevVal=xCurVal*xCurVal+yCurVal*yCurVal-radius*radius;goallDevVal=(xCurVal-XEnd)*(xCurVal-XEnd)+(yCurVal-YEnd)*(yCurVal-YEnd);while(goallDevVal>=(step*step)|stepcount=0)if(lDevVal>=0)/誤差大于等于零if(bIsCW=0)/逆圓

9、插補(bǔ) nDir=Judge_Quadrant(xCurVal,yCurVal); switch(nDir)case 1:xCurVal-=step; InsertPoint(xCurVal,yCurVal);break;case 2:yCurVal-=step; InsertPoint(xCurVal,yCurVal);break;case 3: xCurVal+=step;InsertPoint(xCurVal,yCurVal);break;case 4:yCurVal+=step; InsertPoint(xCurVal,yCurVal);break;else/順圓插補(bǔ) nDir=Judg

10、e_Quadrant(xCurVal,yCurVal); switch(nDir)case 1:yCurVal-=step; InsertPoint(xCurVal,yCurVal);break;case 2:xCurVal+=step; InsertPoint(xCurVal,yCurVal);break;case 3: yCurVal+=step;InsertPoint(xCurVal,yCurVal);break;case 4:xCurVal-=step; InsertPoint(xCurVal,yCurVal);break;else/誤差小于零if(bIsCW=0)/逆圓插補(bǔ)nDir=

11、Judge_Quadrant(xCurVal,yCurVal); switch(nDir)case 1:yCurVal+=step; InsertPoint(xCurVal,yCurVal);break;case 2:xCurVal-=step; InsertPoint(xCurVal,yCurVal);break;case 3: yCurVal-=step;InsertPoint(xCurVal,yCurVal);break;case 4:xCurVal+=step; InsertPoint(xCurVal,yCurVal);break;else/順圓插補(bǔ) nDir=Judge_Quadra

12、nt(xCurVal,yCurVal); switch(nDir)case 1:xCurVal+=step; InsertPoint(xCurVal,yCurVal);break;case 2:yCurVal+=step; InsertPoint(xCurVal,yCurVal);break;case 3: xCurVal-=step;InsertPoint(xCurVal,yCurVal);break;case 4:yCurVal-=step; InsertPoint(xCurVal,yCurVal);break;lDevVal=xCurVal*xCurVal+yCurVal*yCurVal-radius*radius;goallDevVal=(xCurVal-XEnd)*(xCurVal-XEnd)+(yCurVal-YEnd)*(yCurVal-YEnd);stepcount+;FILE *fp;/文件指針int main()double ft=1000.0*10/60/1000;int j,j1,jj;char fn10;printf("please input filename:n");/輸入要寫入數(shù)據(jù)的文件名，如pbp_circle.txtscanf("%s",