数据采样法插补C语言程序

〃该函数在VC++6.0下编译测试通过，可实现直线、圆弧、完整圆的数据采样法插补：并可将插补函数计算出的数〃据点写入xxx.txt文件中〃昔有任何疑问，欢迎邮件联系，dingiiang90@〃版权所有，侵权必究。转载时请注明来自大连理工机械工程学院Deanjiang#include<math.h>#include<stdlib.h>#include<stdio.h>/********************************************************************/TOC\o"1-5"\h\z/*函数名：InsertPoint *//*功能：控制机床各轴进给并将进给结果写入文件中 *//*参数：doublex,doubley插补点单位:毫米 *//*说明：与机床硬件关联，每产生一个点调用一次 *//********************************************************************/voidlnsertPoint(doublexCuodoubleyCur)externFILE*fp;charch=10;printf(,,xCur=%fexternFILE*fp;charch=10;printf(,,xCur=%f/yCur=%f\n,,,xCur,yCur);fprintf(fp,”％f,%仁xCur,yCur);fputc(ch,fp);}/*/*/*/*/********************************************************************/*/*/*/函数名：Judge_Quadrant能：判断参数坐标的所在象限并返回相应象限值数：doublexdoubleymmmm*/******************************************************************unsignedshortJudge_Quadrant(doublex,doubley)(unsignedshortnDir;if(x>=0){〃象限判断if(y>=0)nDir=l;return1;)elsenDir=4;return4;else

if(y>=0){nDir=2;return2;}else{nDir=3;return3;}(}*******************************************************************/7*/函数名：DSM_Line能：数据采样法直线插补数：doubleXEnd,doubleYEnddoubleFValunsignedshortTs插补终点mm插补速度 mm/min插补周期ms*/*/*/*******************************************************************/voidDSM_Line(doubleXEnd,doubleYEnd,doubleFVal,unsignedshortTs)(doublefDeltaLjL;doubleK;intbXIsBigger;doubleGEnd,NEnd;doubleGStepVaI;//NStepVaI;doubleAxisGVal,AxisNVal;doublefStVel;doublefDistToEnd;fStVel=FVal/300000;〃插补速度’单位为mm/stAxisGVal=AxisNVal=O;fDeltaL=FVal*Ts/(60*1000);//一个插补周期内的合成增量，单位为亳米fL=sqrt(XEnd*XEnd+YEnd*YEnd);K=fDeltaL/fL;〃确定引导坐标和非引导坐标if(fabs(XEnd>=fabs(YEnd))){bXlsBigger=l;GEnd=XEnd;NEnd=YEnd;(else{bXlsBigger=O;GEnd=YEnd;NEnd=XEnd;GStepVal=GEnd*K;fDistToEnd=(AxisGVal-GEnd)*(AxisGVal-GEnd)+(AxisNVal-NEnd)*(AxisNVal-NEnd);while(fDistToEnd>(fDeltaL*fDeltaL/4)){AxisGVal+=GStepVaI;AxisNVal=AxisGVal*NEnd/GEnd;if(bXIsBigger){lnsertPoint(AxisGVal,AxisNVal);}elselnsertPoint(AxisNVal,AxisGVal);}fDistToEnd=(AxisGVal-GEnd)*(AxisGVal-GEnd)+(AxisNVal-NEnd)*(AxisNVal-NEnd);)/********************************************************************//*函数名：DSMJZircle*//*功能：数据采样法圆弧插补*//*参数：doubleXStart,doubleYStart插补起点mm *//*doubleXEnd,doubleYEnd 插补终点mm*//*doubleFVal 插补速度 mm/min*//*unsignedshortTs 插补周期 ms*//*doubleradius 圆弧半径 mm*//*boolblsCW 圆弧插补方向0或1*//********************************************************************/voidDSM_Circle(doublexSt,doubleySt,doublexEnd,doubleyEnd,doubleradius,doubleFVal,intTs,intblsCW)doubleFTa,xCurzyCuGxCurl;doubleeszxdir,ydir;//用于判定终点的误差intfull_circle=OJudge=l;intndir;if(xSt==xEnd&ySt==yEnd)full_circle=l;//整圆判断FT=FVal*Ts/60/1000.0;es=FT/2;a=2*asin(FT/2/radius);〃每个插补周期所超过的弦线对应的圆心角xCur=xSt,yCur=ySt;lnsertPoint(xCurzyCur);if(blsCW==O)//逆圆插补while(judge==l||full_circle==l)//终点判断xCurl=xCur*cos(a)-yCur*sin(a);//三角函数圆弧插补的迭代公式yCur=yCur*cos(a)+xCur*sin(a);xCur=xCurl;InsertPoint(xCuGyCur);full_circle=O;xdir=xCur-xEnd;ydir=yCur-yEnd;ndir=Judge_Quadrant(xdiGydir);switch(ndir)(casel:judge=xdir>=es11ydir>=es;break;case2:judge=(-xdir)>=es||ydir>=es;break;case3:judge=(-xdir)>=es11(-ydir)>=es;break;case4:judge=xdir>=es||(-ydir)>=es;break;}}}else//顺圆插补{while(judge==l||full_circle==l)//终点判断{xCurl=xCur*cos(a)+yCur*sin(a);//三角函数圆弧插补的迭代公式yCur=yCur*cos(a)-xCur*sin(a);xCur=xCurl;InsertPoint(xCuoyCur);full_circle=O;xdir=xCur-xEnd;ydir=yCur-yEnd;ndir=Judge_Quadrant(xdir/ydir);switch(ndir)(casel:judge=xdir>=es11ydir>=es;break;case2:judge=(-xdir)>=es||ydir>=es;break;case3:judge=(-xdir)>=es11(-ydir)>=es;break;case4:judge=xdir>=es||(-ydir)>=es;break;}}}}FILE*fp;//文件指针intmain()(doubleft=1000.0*10/60/1000;charfn[10];printf