〃該函數(shù)在VC++6.0下編譯測試通過，可實(shí)現(xiàn)直線、圓弧、完整圓的數(shù)據(jù)采樣法插補(bǔ)：并可將插補(bǔ)函數(shù)計(jì)算出的數(shù)〃據(jù)點(diǎn)寫入xxx.txt文件中〃昔有任何疑問，歡迎郵件聯(lián)系，dingiiang90@〃版權(quán)所有，侵權(quán)必究。轉(zhuǎn)載時(shí)請注明來自大連理工機(jī)械工程學(xué)院Deanjiang#include<math.h>#include<stdlib.h>#include<stdio.h>/********************************************************************/TOC\o"1-5"\h\z/*函數(shù)名：InsertPoint *//*功能：控制機(jī)床各軸進(jìn)給并將進(jìn)給結(jié)果寫入文件中 *//*參數(shù)：doublex,doubley插補(bǔ)點(diǎn)單位:毫米 *//*說明：與機(jī)床硬件關(guān)聯(lián)，每產(chǎn)生一個(gè)點(diǎ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ù)坐標(biāo)的所在象限并返回相應(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ù)采樣法直線插補(bǔ)數(shù)：doubleXEnd,doubleYEnddoubleFValunsignedshortTs插補(bǔ)終點(diǎn)mm插補(bǔ)速度 mm/min插補(bǔ)周期ms*/*/*/*******************************************************************/voidDSM_Line(doubleXEnd,doubleYEnd,doubleFVal,unsignedshortTs)(doublefDeltaLjL;doubleK;intbXIsBigger;doubleGEnd,NEnd;doubleGStepVaI;//NStepVaI;doubleAxisGVal,AxisNVal;doublefStVel;doublefDistToEnd;fStVel=FVal/300000;〃插補(bǔ)速度’單位為mm/stAxisGVal=AxisNVal=O;fDeltaL=FVal*Ts/(60*1000);//一個(gè)插補(bǔ)周期內(nèi)的合成增量，單位為亳米fL=sqrt(XEnd*XEnd+YEnd*YEnd);K=fDeltaL/fL;〃確定引導(dǎo)坐標(biāo)和非引導(dǎo)坐標(biāo)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ù)采樣法圓弧插補(bǔ)*//*參數(shù)：doubleXStart,doubleYStart插補(bǔ)起點(diǎn)mm *//*doubleXEnd,doubleYEnd 插補(bǔ)終點(diǎn)mm*//*doubleFVal 插補(bǔ)速度 mm/min*//*unsignedshortTs 插補(bǔ)周期 ms*//*doubleradius 圓弧半徑 mm*//*boolblsCW 圓弧插補(bǔ)方向0或1*//********************************************************************/voidDSM_Circle(doublexSt,doubleySt,doublexEnd,doubleyEnd,doubleradius,doubleFVal,intTs,intblsCW)doubleFTa,xCurzyCuGxCurl;doubleeszxdir,ydir;//用于判定終點(diǎn)的誤差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);〃每個(gè)插補(bǔ)周期所超過的弦線對應(yīng)的圓心角xCur=xSt,yCur=ySt;lnsertPoint(xCurzyCur);if(blsCW==O)//逆圓插補(bǔ)while(judge==l||full_circle==l)//終點(diǎn)判斷xCurl=xCur*cos(a)-yCur*sin(a);//三角函數(shù)圓弧插補(bǔ)的迭代公式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//順圓插補(bǔ){while(judge==l||full_circle==l)//終點(diǎn)判斷{xCurl=xCur*cos(a)+yCur*sin(a);//三角函數(shù)圓弧插補(bǔ)的迭代公式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