數(shù)據(jù)采樣法插補C語言程序

〃該函數(shù)在VC++6.0下編譯測試通過，可實現(xiàn)直線、圓弧、完整圓的數(shù)據(jù)采樣法插補：并可將插補函數(shù)計算出的數(shù)〃據(jù)點寫入xxx.txt文件中〃昔有任何疑問，歡迎郵件聯(lián)系，dingiiang90@〃版權(quán)所有，侵權(quán)必究。轉(zhuǎn)載時請注明來自大連理工機械工程學院Deanjiang#include<math.h>#include<stdlib.h>#include<stdio.h>/********************************************************************/TOC\o"1-5"\h\z/*函數(shù)名：InsertPoint *//*功能：控制機床各軸進給并將進給結(jié)果寫入文件中 *//*參數(shù)：doublex,doubley插補點單位:毫米 *//*說明：與機床硬件關(guān)聯(lián)，每產(chǎn)生一個點調(diào)用一次 *//********************************************************************/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);}/*/*/*/*/********************************************************************/*/*/*/函數(shù)名：Judge_Quadrant能：判斷參數(shù)坐標的所在象限并返回相應(yīng)象限值數(shù)：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*/函數(shù)名：DSM_Line能：數(shù)據(jù)采樣法直線插補數(shù)：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);//一個插補周期內(nèi)的合成增量，單位為亳米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);)/********************************************************************//*函數(shù)名：DSMJZircle*//*功能：數(shù)據(jù)采樣法圓弧插補*//*參數(shù)：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);〃每個插補周期所超過的弦線對應(yīng)的圓心角xCur=xSt,yCur=ySt;lnsertPoint(xCurzyCur);if(blsCW==O)//逆圓插補while(judge==l||full_circle==l)//終點判斷xCurl=xCur*cos(a)-yCur*sin(a);//三角函數(shù)圓弧插補的迭代公式y(tǒng)Cur=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);//三角函數(shù)圓弧插補的迭代公式y(tǒng)Cur=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