add pivot distance in creo post processor for 5 axis

It seems that many people are reluctant to use Creo NC, and the lack of engagement indicates its limited value in the CAM manufacturing software market. Even PTC engineers seem disinterested in addressing manufacturing-related issues concerning Creo, which is telling about the community's overall response. Anyway, I make it simpler what I need. The issue is related to G43 and G43.4 output

What I want from my current PP the G43 output is fine for 3 axis, and also its placement on the right place

(N15 T1 M06
N16 S2387 M03
N17 G0 G43 Z039.343 H1

But for 4 and 5 axis, I need G43.4 instead of G43, and its placement always needs to be before rotary movement. Check the content for fil file 

REDEF/ON

A=1;B=2;C=3;D=4;E=5;F=6;G=7;H=8;I=9;J=10;K=11;L=12;M=13;N=14
O=15;P=16;Q=17;R=18;S=19;T=20;U=21;V=22;W=23;X=24;Y=25;Z=26

$$ ****************************************************
$$ * P A R T N O S e c t i o n s *
$$ ****************************************************

CIMFIL/ON,PARTNO
DMY=POSTF(13) $$ Process
CLPART=TEXT/CLW $$ extract text
CIMFIL/OFF

$$ ****************************************************
$$ * M A C H I N S e c t i o n s *
$$ ****************************************************

CIMFIL/ON,MACHIN
DMY=POSTF(13) $$ Process
PPRINT/CLPART $$ message PARTNO
INSERT/' G91G28Z0.$'
INSERT/' G91G28X0.Y0.$'
INSERT/' G91G28B0.$'
INSERT/' G91G28C0.$'
INSERT/' G00G80G40G49G90G54$'
INSERT/' G00B0.$'
INSERT/' G00C0.$'
CIMFIL/OFF

$$ ****************************************************
$$ * L O A D T L S e c t i o n s *
$$ ****************************************************

CIMFIL/ON,LOADTL
DMY=POSTF(20) $$ save record
DMY=POSTF(21) $$ retreive record
NBEL=POSTF(5) $$ Number of word
IF (NBEL.EQ.4) THEN
DMY=POSTF(9,5,(ICODEF(ADJUST)))
DMY=POSTF(10,6,(POSTF(7,4)))
DMY=POSTF(12,6)
ENDIF
DMY=POSTF(13)
INTF(1000) = 0 $$ Reset G43.4 flag for new tool
CIMFIL/OFF

$$ ****************************************************
$$ * C U T C O M S e c t i o n s *
$$ ****************************************************

CIMFIL/ON,CUTCOM
SETV=POSTF(7,4)
SETT=POSTF(6,4)
NBEL=POSTF(5)
IF(SETT.EQ.0.AND.SETV.NE.(ICODEF(OFF)).AND.NBEL.EQ.4)THEN
DMY=POSTF(10,5,(POSTF(1,3,497)))
DMY=POSTF(12,5)
ENDIF
DMY=POSTF(13)
CIMFIL/OFF

$$ ****************************************************
$$ * P P R I N T S e c t i o n s *
$$ ****************************************************

CIMFIL/ON,PPRINT
MESS=TEXT/CLW
COM=TEXT/'COMMENTS'
RSLT=INDXF(MESS,COM)
IF (RSLT.EQ.0) THEN
PPRINT/MESS
ENDIF
CIMFIL/OFF

$$ ****************************************************
$$ * G43.4 Handling for 5-Axis Machines *
$$ ****************************************************

CIMFIL/ON,START
TX1 = TEXT/'G43'
TX2 = TEXT/'G43.4'
REPLAC/TX1, TX2
CIMFIL/OFF

CIMFIL/ON,GOTO
RSLT = POSTF(13)

B_MOVE = INTF(330) $$ Rotary B active
C_MOVE = INTF(331) $$ Rotary C active

IF ((B_MOVE .EQ. 1) .OR. (C_MOVE .EQ. 1)) THEN
IF (INTF(1000) .NE. 1) THEN
TX3 = TEXT/'G43.4'
TX4 = TEXT/' H'
TX5 = INTF(497) $$ Tool number

PUNCH/TX3
PUNCH/TX4
PUNCH/TX5
PUNCH/NEWLINE $$ Ensure it's on one line

INTF(1000) = 1
ENDIF
ENDIF
CIMFIL/OFF

CIMFIL/ON,LOADTL
INTF(1000) = 0
CIMFIL/OFF

$$ ****************************************************
$$ * F I N I S e c t i o n s *
$$ ****************************************************

CIMFIL/ON,14
DMY=POSTF(20)
INSERT/' G91G28Z0.$'
INSERT/' G91G28X0.Y0.$'
INSERT/' G91G28B0.$'
INSERT/' G91G28C0.$'
INSERT/' M98P0000L0.$'
AUXFUN/30
DMY=POSTF(21)
DMY=POSTF(13)
CIMFIL/OFF