卧式镗床B轴联动的后处理

fl8341

新进了一家大厂，但是里面是大型的卧式X Y Z W B 可以5联动的床子，要命的是我只会搞立式3联动的后处理，希望高手帮帮忙搞个4联动的卧式后处理出来！铣的圆弧面的圆心并不在转台的中心！想了很久都弄不明白，更要命的是他们用的是变量编程。程序如下（fagor系统）：
N005 G00 G90 G80 G40
N010 G51 E0.01
N015 G53
N020 Z-100 W-100
N025 (P25=100)     待加工量
+ X% K1 a! e, h% h4 \& vN030 (P19=5,P20=15)    吃刀深度及余量
' }$ \$ ~# f" v/ b/ d1 l: ?N035 (P25=P25-P19)
$ G5 }5 ^4 w, CN040 (IF (P25 LT P20) P25=P20)
, M" {1 V' y0 q! tN045 (P07=8)        转台初始角度
/ R% F7 j. i: b# \. e6 oN050 (P08=0.1,P09=78.P10=41,P15=37)
0 E) E- ~: @9 P8 d  ~N055 (P23=R)       刀具半径
N060 (P24=0.45*P23)  不明白
6 l  \& z+ z+ C& M& @: Z: fN065 (P06=3051+P25)
N070 (P1=?,P2=?)  圆弧中心距转台中心x向和z向尺寸
N075 (P3=Atan(P01/P02)+P15)
- @9 g; |8 A3 `% y8 T8 {* [N080 (P5=SQRT(P1*P1+P2*P2))
& g1 J$ ~1 e" g% q- ^; u* jN085 (P11=P5*SIN(P3-P7)+P24)
N090 (P12=206)
8 K- x- p9 v! y- L% f+ `% cN095 (P16=P06-P05*COS(P03-P07)-P05)
N100 G54
, x& h" {% C) `9 u5 z' HN105 (IF (P07 GT 0) GOTO N125)
- ]2 H- j1 |9 ~7 P" oN110 B-P07
! v3 Q( R+ M# e1 xN115 XP11 YP12
1 `  Y' U7 J6 LN120 ZP25 WP16 F100 S100 M03
N125 G01 CP11 YP12 BP07
7 s7 F" f7 v% V; E) w; E! jN130 (P07=P07+P08)
N135 IF (P07 GE P10+P15) GOTO N50 ELSE N150
8 B+ o" O- T" p, fN140 G53
N145 G00 Z-100 W-100
N150 IF (P25 GT P20) GOTO N30 ELSE N155
N155 M05
N160 M30