Need Macro Program Help

I'm wondering if you guys could help trouble shoot a setup program that we use on a horizontal to set up plates to square them up. The program we use works on a KIA with a fanuc 18i but wont work on a Heckert with a 16i. The problem we're having is it seems like it wont consistently read the tool diameter offset. Some times it works other times it wont compensate for half the setup bar diameter. I'm so confused because this is a fairly simple program, I cant figure out what I'm missing.
%
O0002(SQUARING SETUP)
(**********)

(HECKERT)
(**********)

(#501 BLOCK LENGTH)
#501=20.343

(#502 BLOCK WIDTH)
#502=12.167

(#503 BLOCK THICKNESS)
#503=1.875

T2M6
G90G80G40
G59X13.9567
B90
M00
G53Z44.0945
G90G80G40
G0G90G59
G42 D2 X-14.900
X-[#502/2]
Y[#503/2]
G43H2Z[#501/2]
M00
G40X-[#502/2+1.5]
G53Z44.0945
G53Y20.0
M30
%