;; CHAMFER(I,J,C,U,X,Y,T) by Yi-Wan LIN 07/09/1998 11:33:53
       #27=0.5*#9-#3+0.5*#20*TAN(22.5);    // 1/2 PATH.X
       #28=0.5*#10-#3+0.5*#20*TAN(22.5);   // 1/2 PATH.Y
       IF(#21==1) GOTO 5500;
N5000  IF( #3<=0 ) GOTO 5050;
       ;//U=0..CW DIRECTION
               #33=#25+0.5*(#20+#10);
       G90 G01 X#24 Y#33;  //TO  ENTRY POINT P0
               #33=#24+#27;
       G90 G01 X#33;            // P1
               #32=#24+0.5*(#9+#20);
               #33=#25+#28;
       G90 G01 X#32 Y#33;       // P2
               #32=#24+0.5*(#9+#20);
               #33=#25-#28;
       G90 G01 X#32 Y#33;       // P3
               #32=#24+#27;
               #33=#25-0.5*(#10+#20);
       G90 G01 X#32 Y#33;       // P4
               #32=#24-#27;
       G90 G01 X#32;            // P5
               #32=#24-0.5*(#9+#20);
               #33=#25-#28;
       G90 G01 X#32 Y#33;       // P6
               #33=#25+#28;
       G90 G01 Y#33;            // P7
               #32=#24-#27;
               #33=#25+0.5*(#20+#10);
       G90 G01 X#32 Y#33;       // P8
       G90 G01 X#24;            // P0
               GOTO 6000;
;;------------------------------------------------------
N5050          #33=#25+0.5*(#20+#10); ;------- C=0 -----
       G90 G01 X#24 Y#33;  //TO  ENTRY POINT P0
               #32=#9/2+#20/2; //half.x
               #33=#10+#20;    //path.y
       G91 G01 X#32;
               Y-#33;
               X-#32;
               X-#32;
               Y#33;
               X#32;
               GOTO 6000;
;;============ U=1..CCW DIRECTION =======================
N5500  IF ( #3 <=0 ) GOTO 5550;
               #33=#25+0.5*(#20+#10);
       G90 G01 X#24 Y#33;  //TO  ENTRY POINT P0
               #33=#24-#27;
       G90 G01 X#33;            // P8
               #32=#24-0.5*(#9+#20);
               #33=#25+#28;
       G90 G01 X#32 Y#33;       // P7
               #32=#24-0.5*(#9+#20);
               #33=#25-#28;
       G90 G01 X#32 Y#33;       // P6
               #32=#24-#27;
               #33=#25-0.5*(#10+#20);
       G90 G01 X#32 Y#33;       // P5
               #32=#24+#27;
       G90 G01 X#32;            // P4
               #32=#24+0.5*(#9+#20);
               #33=#25-#28;
       G90 G01 X#32 Y#33;       // P3
               #33=#25+#28;
       G90 G01 Y#33;            // P2
               #32=#24+#27;
               #33=#25+0.5*(#20+#10);
       G90 G01 X#32 Y#33;       // P1
       G90 G01 X#24;            // P0
               GOTO 6000;
;;-----------------------------------------------------
N5550          #33=#25+0.5*(#20+#10); ------- C=0 -----
       G90 G01 X#24 Y#33;  //TO  ENTRY POINT P0
               #32=#9/2+#20/2; //half.x
               #33=#10+#20;    //path.y
       G91 G01 X-#32;
               Y-#33;
               X#32;
               X#32;
               Y#33;
               X-#32;
               GOTO 6000;
N6000  ; //CYCLE END
       M99;
;;FUNCTION:A SUB MACRO,THAT ONLY RUN A 2D MOVEMENT OF RECTANGLE WITH CHAMFER
;;USAGE:G65  P9929 I J C X Y U T ;
;;    ARGUMENT LIST
;;    I..LENGTH(X) OF RECTANGEL
;;    J..WIDTH(Y)  OF RECTANGEL
;;    C..THE VALUE OF CHAMFER
;;    U..MILLING DIRECTION
;;    X..THE LOW_LEFT ORIENT POINT.X OF RECTANGLE
;;    Y..THE LOW_LEFT ORIENT POINT.Y OF RECTANGLE
;;    T..TOOL DIAMETER