逐点比较法插补C语言程序

1、精选优质文档-倾情为你奉上/该函数在VC+6.0下编译测试通过，可实现直线、圆弧、完整圆的逐点比较法插补；并可将插补函数计算出的数/据点写入xxx.txt文件中/若有任何疑问，欢迎邮件联系，/版权所有，侵权必究。转载时请注明来自大连理工机械工程学院Deanjiang#include<stdio.h>#include<math.h>#include<stdlib.h>/*/* 函数名: InsertPoint */* 功 能：控制机床各轴进给并将进给结果写入文件中*/* 参 数：double x, double y 插补点 单位:毫米*/* 说 明：与机床硬件

2、关联，每产生一个点调用一次*/*/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);/*/* 函数名: Judge_Quadrant */* 功 能：判断参数坐标的所在象限并返回相应象限值*/* 参 数：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;/*/* 函数名: PBP_Line */* 功 能：逐点比较法直线插补*/* 参 数：double step步长mm*/*double XEnd, double YEnd插补终点mm*/*/void PBP_Line(double step, double XEnd

4、, double YEnd)double lDevVal; /偏差值double xCurVal=0,yCurVal=0; /当前点的实际位置long StepMount; /插补总步数long StepCount=0; /插补次数计数器unsigned short nDir; /当前点所在象限 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) /终点判别/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+; /*/* 函数名: PBP_Circle */*

7、 功 能：逐点比较法圆弧插补*/* 参 数：double step步长mm*/*double XStart,double YStart插补起点mm*/*double XEnd,double YEnd插补终点mm*/*double radius圆弧半径mm*/* bool bIsCW圆弧插补方向0或1 */*/void PBP_Circle(double step, double XStart, double YStart, double XEnd,double YEnd, double radius, int bIsCW)double lDevVal,goallDevVal;/当前误差和与终点

8、的差值double xCurVal=XStart,yCurVal=YStart;/当前坐标 unsigned short nDir;/象限long stepcount=0;/步数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、插补 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/顺圆插补 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)/逆圆插补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/顺圆插补 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");/输入要写入数据的文件名，如pbp_circle.txtscanf("%s",