线切割控制器的插补运算公式

TGXQG

线切割控制器是按一定的的插补运算公式，实现对步进电机的控制的。
我在自己的线切割管理系统中的B代码处理器中，就运用了直线和圆弧的插补运算公式，实现了仿真运算校验误差功能。

直线插补运算公式：
F>=0时 F=F-|y| F<0时 F=F+|X|
F>=0时 走哪一步呢？
& U* ~% m+ q, T- O: F* H第一象限：+X
第二象限：-X  
2 p" n+ m1 n: x: E1 F: ]$ B/ @第三象限：-X
) v% D2 s  S8 x% z" K9 h# B* q第四象限：+X
/ y  u" J/ [7 s$ fF<时 走哪一步呢？
3 B, \0 }( T) w0 t' E6 l第一象限：+Y
第二象限：+Y  
5 v. G# B$ |* }第三象限：-Y
第四象限：-Y

圆弧插补运算公式：
8 J& V: w1 M$ L6 z4 U- C* KSR1SR3 NR2NR4 :F>=0时 F=F-2Y+1 F<0时 F=F+2X+1
4 j, }( ^! U- V9 ?. ?2 _NR1NR3SR2SR4 :F>=0时 F=F-2X+1 F<0时 F=F+2Y+1
F>=0时 走哪一步呢？  
8 X9 A4 x* }, r- `8 USR1:-Y
& ~1 K0 r/ b8 A/ e' j- gSR3:+Y
NR2:-Y
4 w" A. A- g+ L" K$ V
0 R. B  W2 r: J5 {& i) GNR4:+Y  
" Y3 t8 O$ L4 y! e* \NR1:-X
9 ]8 Z; J& J$ K4 Y8 y- k: A
* h4 Z, G! {! J# A/ q# q( D5 {3 jNR3:+X
5 S! s! c" a4 ~3 |. G. OSR2:+X
SR4:-X
& q: g& o( a$ o  sF<时 走哪一步呢？
SR1:+X

+ i# d- o; ^. I  p( @1 v0 PSR3:-X
) i' H; t  f, j% U# ]* P# s
8 e8 @% g) o) z  KNR2:-X

NR4:+X
6 F9 k1 L4 M7 D2 r/ Y3 |
NR1:+Y
. O/ R5 f# @6 I& G
NR3:-Y
! h) L, u9 }, K/ A; ~0 r& {SR2:+Y F  
0 y" `6 {- q5 c4 s* C+ O) pSR4:-Y
0 L5 Y# V2 t# K1 z$ C2 G
5 y! s. i! \- C& f3 L* p8 }最后还要判断到达终点，和象限变化问题