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

fl8341

新进了一家大厂，但是里面是大型的卧式X Y Z W B 可以5联动的床子，要命的是我只会搞立式3联动的后处理，希望高手帮帮忙搞个4联动的卧式后处理出来！铣的圆弧面的圆心并不在转台的中心！想了很久都弄不明白，更要命的是他们用的是变量编程。程序如下（fagor系统）：
N005 G00 G90 G80 G40
' E& `( n% H, _" r% SN010 G51 E0.01
9 y$ V( c. X7 }N015 G53
/ y" i: r6 W) l, h  J# HN020 Z-100 W-100
N025 (P25=100)     待加工量
1 k+ ]" w* T# R% o8 EN030 (P19=5,P20=15)    吃刀深度及余量
N035 (P25=P25-P19)
N040 (IF (P25 LT P20) P25=P20)
N045 (P07=8)        转台初始角度
N050 (P08=0.1,P09=78.P10=41,P15=37)
N055 (P23=R)       刀具半径
N060 (P24=0.45*P23)  不明白
N065 (P06=3051+P25)
N070 (P1=?,P2=?)  圆弧中心距转台中心x向和z向尺寸
  D# n4 X: K' o4 f. c0 [6 G  u6 aN075 (P3=Atan(P01/P02)+P15)
- @  g( h( @0 t* W  a& s  J, M/ y1 oN080 (P5=SQRT(P1*P1+P2*P2))
N085 (P11=P5*SIN(P3-P7)+P24)
/ H8 z( w& |" \4 W' m8 S; b7 y( \N090 (P12=206)
- R3 b5 G+ N/ h; h) u& h% uN095 (P16=P06-P05*COS(P03-P07)-P05)
1 |. y! `6 d& X1 y, g8 AN100 G54
N105 (IF (P07 GT 0) GOTO N125)
N110 B-P07
* g+ ?1 a0 S6 z5 H9 w# gN115 XP11 YP12
N120 ZP25 WP16 F100 S100 M03
' J5 V/ A3 h9 {) X7 c3 ?N125 G01 CP11 YP12 BP07
! E4 o. p* w1 W& i- qN130 (P07=P07+P08)
N135 IF (P07 GE P10+P15) GOTO N50 ELSE N150
N140 G53
$ S# W( Y. o( aN145 G00 Z-100 W-100
6 G- j# k' f- V: }7 \; ]5 \8 {N150 IF (P25 GT P20) GOTO N30 ELSE N155
6 R7 q7 M: u9 B7 k( j6 wN155 M05
2 o& O' B% w+ V# G2 ?$ ~N160 M30