插補(bǔ)程序源代碼

1、插補(bǔ)程序源代碼目錄1逐點(diǎn)比較法插補(bǔ)c語(yǔ)言程序源代碼022逐點(diǎn)比較法圓弧插補(bǔ) VB源程序 073逐點(diǎn)比較法直線插補(bǔ)VB源程序114時(shí)間分割法直線插補(bǔ)參考 VB程序 135時(shí)間分割法圓弧插補(bǔ) VB源程序 141 / 141 逐點(diǎn)比較法插補(bǔ) c 語(yǔ)言程序源代碼#include "conio.h"#include "graphics.h"#include "process.h"#define Ni_circle 0#define Shun_circle 1void init_graph();void draw_Base_circle();vo

2、id draw_cabu_circle();void close_graph();void acrroods();static float x0,y0;void line_cabu(), draw_line(),draw_line_cabu();void line_cabu() /* 此函數(shù)控制直線插步兩次 */int i;init_graph();sleep(1);for(i=0;i<2;i+)line(0,120,300,120); outtextxy(310,120,"Z");line(100,10,100,300); outtextxy(110,300,&qu

3、ot;X");outtextxy(90,130,"O");draw_line();if(i=0)draw_line_cabu(6);else draw_line_cabu(2);gotoxy(50,5);getch();cleardevice();setcolor(WHITE);void draw_line()/* 畫(huà)直線 */line(100,120,600,450);textcolor(YELLOW);directvideo=0;gotoxy(45,5); cprintf("Line from:X0Y0 Z0 ");gotoxy(45,6)

4、; cprintf("Line to :X500 Y0 Z330");gotoxy(45,7); cprintf("Units :Pixel");gotoxy(45,8); cprintf("Line now:");void draw_line_cabu(int step)/* 關(guān)鍵的直線插補(bǔ)函數(shù) */2 / 14int Xe=600,Ye=450;float Fm,Xm=100,Ym=120;setcolor(RED);moveto(Xm,Ym);while(Xm<=Xe&&Ym<=Ye)Fm=(Ym-1

5、20)*(Xe-100)-(Xm-100)*(Ye-120); if(Fm>=0)Xm=Xm+step;elseYm=Ym+step;lineto(Xm,Ym);gotoxy(55,8); printf("X%3.0f Y0 Z%3.0f",Xm-100,Ym-120);delay(1100);/* 圓插補(bǔ)部分的函數(shù)區(qū) */void init_graph()/* 圖形系統(tǒng)初始化 */int gdrive=DETECT,gmode;initgraph(&gdrive,&gmode,"");cleardevice();void acrr

6、oods()/* 屏幕中心坐標(biāo) */x0=getmaxx()/2;y0=getmaxy()/2;void draw_Base_circle() /* 畫(huà)圓及寫(xiě)參數(shù) */line(x0-200,y0,x0+200,y0); outtextxy(x0+220,y0,"Z");line(x0,y0-180,x0,y0+180); outtextxy(x0+10,y0+180,"X"); outtextxy(x0-10,y0+10,"O");circle(x0,y0,150);textcolor(YELLOW);directvideo=0;g

7、otoxy(46,2);cprintf("Circle start:X0 Y0 Z150"); gotoxy(46,3);cprintf("Circle end:X0 Y0 Z150");gotoxy(46,4);cprintf("Units :Pixel"); gotoxy(46,5);cprintf("Circle now:");void close_graph()/* 關(guān)圖形系統(tǒng) */3 / 14closegraph();void draw_cabu_circle(int sstep,int Director

8、y)/* 關(guān)鍵的圓插補(bǔ)函數(shù) */int flag=0;float Fm,Xm,Ym; Xm=x0+150; Ym=y0;moveto(Xm,Ym); setcolor(RED);while(1) /* 分象限，順圓和逆圓討論 */Fm=(Xm-x0)*(Xm-x0)+(Ym-y0)*(Ym-y0)-150*150;/* 圓判斷公式 */ if(Fm>=0)if(!Directory) /* 逆圓判斷 */ if(Xm>=x0&&Ym<=y0)if(flag) break; /*if 語(yǔ)句判斷象限，以下一樣 */ else Xm=Xm-sstep; if(Xm&

9、lt;=x0&&Ym<=y0)flag=1; Ym=Ym+sstep; if(Xm<=x0&&Ym>=y0) Xm=Xm+sstep;if(Xm>=x0&&Ym>=y0) Ym=Ym-sstep;else /*it is Directory's else*/ if(Xm>x0&&Ym<y0)Ym=Ym+sstep; if(Xm<=x0&&Ym<=y0)Xm=Xm+sstep; if(Xm<x0&&Ym>y0) flag=1;

10、Ym=Ym-sstep; if(Xm>=x0&&Ym>=y0) if(flag) break;Xm=Xm-sstep; else /*it is Fm's else*/ if(!Directory) if(Xm>x0&&Ym<y0) 4 / 14if(flag) break;else Ym=Ym-sstep;if(Xm<=x0&&Ym<=y0)flag=1; Xm=Xm-sstep;if(Xm<=x0&&Ym>=y0)Ym=Ym+sstep;if(Xm>=x0&

11、&Ym>=y0)Xm=Xm+sstep;elseif(Xm>x0&&Ym<y0)Xm=Xm+sstep;if(Xm<=x0&&Ym<=y0)Ym=Ym-sstep;if(Xm<=x0&&Ym>=y0)flag=1; Xm=Xm-sstep; if(Xm>=x0&&Ym>=y0) if(flag) break;else Ym=Ym+sstep;lineto(Xm,Ym);gotoxy(58,5); printf("X%3.0f Y0 Z%3.0f ",

12、Ym-y0,Xm-x0); delay(800);void circle_demo(int Directory)/* 控制圓插補(bǔ)兩次 */int i=0,sstep;init_graph();sleep(2);acrroods(&x0,&y0);for(i=0;i<2;i+)draw_Base_circle(150);if(i=0)sstep=6;draw_cabu_circle(sstep,Directory);elsesstep=1;draw_cabu_circle(sstep,Directory);5 / 14getch();cleardevice();setcol

13、or(WHITE);/* 圓插補(bǔ)部分的函數(shù)區(qū)結(jié)束 */main()/* 主函數(shù)負(fù)責(zé)寫(xiě)封面和函數(shù)調(diào)用 */int choice=0;init_graph();while(choice!=4)setfillstyle(1,RED); bar(200,30,400,80); setcolor(GREEN);settextstyle(3,0,10); outtextxy(220,50,"DEMO PROGRAM BY P.Y.F"); setcolor(WHITE);settextstyle(0,0,1);gotoxy(46,13);outtextxy(200,120,"

14、1. Line demo."); outtextxy(200,140,"2. Shun_Circle demo."); outtextxy(200,160,"3. Ni_Circle demo."); outtextxy(200,180,"4. Quit the program."); outtextxy(160,200,"Please enter your choice:"); scanf("%d",&choice);switch(choice)case 1: line_ca

15、bu();break;case 2: circle_demo(Ni_circle);break; case 3: circle_demo(Shun_circle);break; case 4: break;default: printf("nChoice wrong,try again!");close_graph();6 / 142 逐點(diǎn)比較法圓弧插補(bǔ) VB 源程序Sub 偏差計(jì)算 （）偏差 = Sqr（x 動(dòng)點(diǎn) - x 圓心 ） 2 + （z 動(dòng)點(diǎn) - z 圓心 ） 2） - R End Sub Sub 插補(bǔ) （）x 動(dòng)點(diǎn) = x 起點(diǎn) : z 動(dòng)點(diǎn) = z 起點(diǎn) :

16、動(dòng)點(diǎn)象限判別 xx: Select Case 象限標(biāo)志 Case 1: 單步連續(xù)判斷If 順逆標(biāo)志 = "順" Then '第一象限插補(bǔ)Do Until （x 動(dòng)點(diǎn) - x 終點(diǎn) ） = 0 And （z 動(dòng)點(diǎn) - z 終點(diǎn) ） = 0 If 偏差 >= 0 Thenx 動(dòng)點(diǎn) = x 動(dòng)點(diǎn) - 1:Line -Step（0, -x 步長(zhǎng) ）, vbRedElse z 動(dòng)點(diǎn) = z 動(dòng)點(diǎn) + 1: Line -Step（z 步長(zhǎng) , 0）, vbRedEnd If 偏差計(jì)算 動(dòng)點(diǎn)象限判別 If 象限標(biāo)志 <> 1 Then GoTo xx End I

17、f 單步連續(xù)判斷LoopElseIf 順逆標(biāo)志 = " 逆 " ThenDo Until （x 動(dòng)點(diǎn) - x 終點(diǎn)） = 0 And （z 動(dòng)點(diǎn) - z 終點(diǎn)） = 0 If 偏差 >= 0 Then z 動(dòng)點(diǎn) = z 動(dòng)點(diǎn) - 1: Line -Step（-z 步長(zhǎng) , 0）, vbRedElse x 動(dòng)點(diǎn) = x 動(dòng)點(diǎn) + 1: Line -Step（0, x 步長(zhǎng) ）, vbRedEnd If DoEvents 偏差計(jì)算 動(dòng)點(diǎn)象限判別 If 象限標(biāo)志 <> 1 Then GoTo xxEnd IfLoopEnd If Case 2: 單步連續(xù)判斷If

18、 順逆標(biāo)志 = "順" Then '第二象限插補(bǔ)Do Until （x 動(dòng)點(diǎn) - x 終點(diǎn)） = 0 And （z 動(dòng)點(diǎn) - z 終點(diǎn)） = 0 If 偏差 >= 0 Then z 動(dòng)點(diǎn) = z 動(dòng)點(diǎn) - 1: Line -Step（-z 步長(zhǎng) , 0）, vbRedElsex 動(dòng)點(diǎn) = x 動(dòng)點(diǎn) - 1:Line -Step（0, -x 步長(zhǎng) ）, vbRedEnd If 偏差計(jì)算 動(dòng)點(diǎn)象限判別 If 象限標(biāo)志 <> 2 Then GoTo xx End IfLoopElseIf 順逆標(biāo)志 = " 逆 " ThenDo Unt

19、il （x 動(dòng)點(diǎn) - x 終點(diǎn)） = 0 And （z 動(dòng)點(diǎn) - z 終點(diǎn)） = 0 If 偏差 >= 0 Thenx 動(dòng)點(diǎn) = x 動(dòng)點(diǎn) + 1:Line -Step（0, x 步長(zhǎng) ）, vbRedElse z 動(dòng)點(diǎn) = z 動(dòng)點(diǎn) + 1: Line -Step（z 步長(zhǎng) , 0）, vbRedEnd If 偏差計(jì)算 動(dòng)點(diǎn)象限判別 If 象限標(biāo)志 <> 2 Then GoTo xx End IfLoopEnd IfCase 3: 單步連續(xù)判斷If 順逆標(biāo)志 = "順" Then '第三象限插補(bǔ)Do Until （x 動(dòng)點(diǎn) - x 終點(diǎn)） = 0

20、 And （z 動(dòng)點(diǎn) - z 終點(diǎn)） = 0 If 偏差 >= 0 Thenx 動(dòng)點(diǎn) = x 動(dòng)點(diǎn) + 1:Line -Step（0, x 步長(zhǎng) ）, vbRedElse z 動(dòng)點(diǎn) = z 動(dòng)點(diǎn) - 1: Line -Step（-z 步長(zhǎng) , 0）, vbRedEnd If DoEvents 偏差計(jì)算 動(dòng)點(diǎn)象限判別If 象限標(biāo)志 <> 3 Then GoTo xxEnd IfLoopElseIf 順逆標(biāo)志 = " 逆 " ThenDo Until （x 動(dòng)點(diǎn) - x 終點(diǎn)） = 0 And （z 動(dòng)點(diǎn) - z 終點(diǎn)） = 0 If 偏差 >= 0 T

21、hen z 動(dòng)點(diǎn) = z 動(dòng)點(diǎn) + 1:Line -Step（z 步長(zhǎng) , 0）, vbRedElsex 動(dòng)點(diǎn) = x 動(dòng)點(diǎn) - 1:Line -Step（0, -x 步長(zhǎng) ）, vbRedEnd If 偏差計(jì)算 動(dòng)點(diǎn)象限判別 If 象限標(biāo)志 <> 3 Then GoTo xx End IfLoopEnd IfCase 4: 單步連續(xù)判斷If 順逆標(biāo)志 = "順" Then '第三象限插補(bǔ)Do Until （x 動(dòng)點(diǎn) - x 終點(diǎn)） = 0 And （z 動(dòng)點(diǎn) - z 終點(diǎn)） = 0 If 偏差 >= 0 Then z 動(dòng)點(diǎn) = z 動(dòng)點(diǎn) + 1:

22、 Line -Step（z 步長(zhǎng) , 0）, vbRedElsex 動(dòng)點(diǎn) = x 動(dòng)點(diǎn) + 1:Line -Step（0, x 步長(zhǎng) ）, vbRedEnd If 偏差計(jì)算 動(dòng)點(diǎn)象限判別 If 象限標(biāo)志 <> 4 Then GoTo xxEnd IfLoopElseIf 順逆標(biāo)志 = " 逆 " ThenDo Until （x 動(dòng)點(diǎn) - x 終點(diǎn)） = 0 And （z 動(dòng)點(diǎn) - z 終點(diǎn)） = 0 If 偏差 >= 0 Thenx 動(dòng)點(diǎn) = x 動(dòng)點(diǎn) - 1:Line -Step（0, -x 步長(zhǎng) ）, vbRedElse z 動(dòng)點(diǎn) = z 動(dòng)點(diǎn) - 1

23、: Line -Step（-z 步長(zhǎng) , 0）, vbRedEnd If 偏差計(jì)算 動(dòng)點(diǎn)象限判別If 象限標(biāo)志 <> 4 Then GoTo xxEnd IfLoopEnd IfEnd SelectEnd Sub9 / 143 逐點(diǎn)比較法直線插補(bǔ) VB 源程序Sub 偏差計(jì)算 （）偏差 = Abs（x終點(diǎn)）X Z動(dòng)點(diǎn)-x 動(dòng)點(diǎn) X Abs（z終點(diǎn)）End SubSub 插補(bǔ) （）Dim c As Integer10 / 14# / 14Select Case 象限標(biāo)志Case 1:' 第一象限插補(bǔ)Do Until x 動(dòng)點(diǎn) + z 動(dòng)點(diǎn) >= 總步數(shù)If 偏差 >

24、;= 0 Thenx 動(dòng)點(diǎn) = x 動(dòng)點(diǎn) + 1:Line -Step（0, x 步長(zhǎng) ）, vbRedElsez 動(dòng)點(diǎn) = z 動(dòng)點(diǎn) + 1:Line -Step（z 步長(zhǎng) , 0）, vbRedEnd If 偏差計(jì)算LoopCase 2:' 第二象限插補(bǔ)c = x 終點(diǎn): x 終點(diǎn)= z 終點(diǎn): z 終點(diǎn)= -cc = x 步長(zhǎng) : x 步長(zhǎng) = z 步長(zhǎng): z 步長(zhǎng) = -cDo Until x 動(dòng)點(diǎn) + z 動(dòng)點(diǎn) >= 總步數(shù)If 偏差 >= 0 Thenx 動(dòng)點(diǎn) = x 動(dòng)點(diǎn) + 1:Line -Step（x步長(zhǎng) , 0）, vbRedElsez 動(dòng)點(diǎn) = z 動(dòng)

25、點(diǎn) + 1:Line -Step（0, z步長(zhǎng) ）, vbRedEnd If偏差計(jì)算LoopCase 3:' 第三象限插補(bǔ)x 步長(zhǎng) = -x 步長(zhǎng) : z 步長(zhǎng) = -z 步長(zhǎng) Do Until x 動(dòng)點(diǎn) + z 動(dòng)點(diǎn) >= 總步數(shù) If 偏差 >= 0 Thenx 動(dòng)點(diǎn) = x 動(dòng)點(diǎn) + 1:Line -Step（0, x 步長(zhǎng) ）, vbRedElsez 動(dòng)點(diǎn) = z 動(dòng)點(diǎn) + 1:Line -Step（z 步長(zhǎng) , 0）, vbRedEnd If偏差計(jì)算LoopCase 4:' 第四象限插補(bǔ)c = x 終點(diǎn) : x 終點(diǎn) = -z 終點(diǎn): z 終點(diǎn) = c c

26、 = x 步長(zhǎng) : x 步長(zhǎng) = -z 步長(zhǎng): z 步長(zhǎng) = c Do Until x 動(dòng)點(diǎn) + z 動(dòng)點(diǎn) >= 總步數(shù) If 偏差 >= 0 Then步長(zhǎng) , 0),步長(zhǎng) ),x 動(dòng)點(diǎn) = x 動(dòng)點(diǎn) + 1: Line -Step(x vbRedElsez 動(dòng)點(diǎn) = z 動(dòng)點(diǎn) + 1: Line -Step(0, z vbRedEnd If偏差計(jì)算LoopEnd SelectEnd Sub11 / 144 時(shí)間分割法直線插補(bǔ)參考 VB 程序Sub 插補(bǔ) （）Dim l, K, a, B, f1, tx 動(dòng)點(diǎn)對(duì)起點(diǎn) = 0: z 動(dòng)點(diǎn)對(duì)起點(diǎn) = 0fl = f 10: t = Ts / 60000l = Sqr（x終點(diǎn)對(duì)起點(diǎn)A 2 + z終點(diǎn)對(duì)起點(diǎn) A 2）K = flt>/ la = Sqr（x動(dòng)點(diǎn)對(duì)起點(diǎn) -x終點(diǎn)對(duì)起點(diǎn)）a 2 + （z動(dòng)點(diǎn)對(duì)起點(diǎn)-z終點(diǎn)對(duì)起點(diǎn)）a 2）x步長(zhǎng) =K *終點(diǎn)對(duì)起點(diǎn)：z步長(zhǎng) =K 邃終點(diǎn)對(duì)起點(diǎn)：B = Sqr（z 步長(zhǎng) A 2 + x 步長(zhǎng) A 2）Do Until a <= B / 2x 動(dòng)點(diǎn)對(duì)起點(diǎn) =