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

fl8341

新进了一家大厂，但是里面是大型的卧式X Y Z W B 可以5联动的床子，要命的是我只会搞立式3联动的后处理，希望高手帮帮忙搞个4联动的卧式后处理出来！铣的圆弧面的圆心并不在转台的中心！想了很久都弄不明白，更要命的是他们用的是变量编程。程序如下（fagor系统）：
  @; L/ F" ?8 w3 L" X7 `/ IN005 G00 G90 G80 G40
N010 G51 E0.01
' i% X5 j# p7 b# D& qN015 G53
N020 Z-100 W-100
N025 (P25=100)     待加工量
N030 (P19=5,P20=15)    吃刀深度及余量
  ]2 E2 m" @* p, g5 ]5 s- vN035 (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)  不明白
+ X2 z6 w! m2 U/ BN065 (P06=3051+P25)
N070 (P1=?,P2=?)  圆弧中心距转台中心x向和z向尺寸
N075 (P3=Atan(P01/P02)+P15)
4 X2 Z/ D4 q7 ~0 F3 z* s( w# SN080 (P5=SQRT(P1*P1+P2*P2))
N085 (P11=P5*SIN(P3-P7)+P24)
# b8 \+ I; O, V- kN090 (P12=206)
0 D, d- c. e, j4 \# }N095 (P16=P06-P05*COS(P03-P07)-P05)
. T) v+ c3 n3 r6 [N100 G54
N105 (IF (P07 GT 0) GOTO N125)
N110 B-P07
N115 XP11 YP12
N120 ZP25 WP16 F100 S100 M03
N125 G01 CP11 YP12 BP07
  b8 O' h! v0 S8 kN130 (P07=P07+P08)
( I( u3 g: ]7 o3 YN135 IF (P07 GE P10+P15) GOTO N50 ELSE N150
N140 G53
: N0 c/ f. v2 a7 R; e0 W% EN145 G00 Z-100 W-100
N150 IF (P25 GT P20) GOTO N30 ELSE N155
N155 M05
( a) B+ _8 L! S+ o8 a' ?1 p& zN160 M30