(author: Chris P)
(version: 0.1)
(date: 05/8/19)

(Probe calibration offset using defined width square pocket)
(Start probe position is over left side edge of pocket wall)
(inside the step off width distance and within max z distance)
(ensure all settings have been set properly according to help diagrams)

o<probe_cal_square_pocket> sub

  (uses NGCGUI style arg spec)
  (number after "=" in comment is default value)
  #<probe_tool_number> = #1    (=99)
  #<max_z_distance> = #2       (=0.5000)
  #<max_xy_distance> = #3      (=0.5000)
  #<xy_clearance> = #4         (=0.1000)
  #<z_clearance> = #5          (=0.1000)
  #<step_off_width> = #6       (=0.5000)
  #<extra_probe_depth> = #7    (=0.0000)
  #<probe_slow_fr> = #8        (=0.0)
  #<probe_fast_fr> = #9        (=10.0)
  #<calibration_offset> = #10  (=0.0000)
  #<x_hint> = #11              (=1.0000)
  #<y_hint> = #12              (=1.0000)
  #<diameter_hint> = #13       (=1.0000)
  #<edge_width> = #14          (=0.5000)
  #<probe_mode> = #15          (=0)
  #<cal_diameter> = #16        (=0.0000)
  #<x_cal_width> = #17         (=1.0000)
  #<y_cal_width> = #18         (=1.0000)
  #<sq_cal_axis> = #19         (=1)

  (Cancel G92 offsets)
  G92.1

  #<workspace_x> = #[5201 + [20 * #5220]]
  #<workspace_y> = #[5202 + [20 * #5220]]

  (Probe Tool Safety Check)
  o<110> if [#5400 NE #<probe_tool_number>]
  (MSG, Specified probe tool #<probe_tool_number> not in spindle, aborting)
   o<probe_cal_square_pocket> return
  o<110> endif

  (Probe Diameter)
  #<probe_diameter> = #5410

  (remove probe tip diam and cal offset from probed width calculations)
  #<probe_diameter_offset> = [#<probe_diameter> - [#<calibration_offset> * 2]]

  #<z_probe_stack> = [#<z_clearance> + #<probe_diameter> + #<extra_probe_depth>]

  (Call sub "probe_z_minus_sub" to Probe top of Workpiece)
  o<probe_z_minus_sub> call [#1][#2][#5][#8][#9][#15]

  (Probe X Positioning Move, Step Off Width)
  G91
  G0 X[#<step_off_width>]

  (Probe X Positioning Move, to Probing Depth)
  F[#<probe_fast_fr>]
  G1 Z-[#<z_probe_stack>]

  (Call sub "probe_x_minus" to Probe x- side of Workpiece)
  o<probe_x_minus> call [#1][#3][#4][#8][#9][#10]

  #<x_minus_probed> = #5061

  (Call sub "probe_x_plus" to Probe x+ side of Workpiece)
  o<probe_x_plus> call [#1][#3 + #11][#4][#8][#9][#10]

  #<x_plus_probed> = #5061

  (probed center calculation)
  #<x_center_probed> = [[#<x_plus_probed> + #<x_minus_probed>] / 2]

  (calculate X Width Probed)
  #<raw_width> = [#<x_plus_probed> - #<x_minus_probed>]

  (Completed probed width calculations)
  #<x_probed_width> = [#<raw_width> + #<probe_diameter_offset>]

  M68 E0 Q[#<x_probed_width>]

  M68 E10 Q[#<x_center_probed>]

  (Probe Completion Move to Z Clearance Plane, and X Zero, Y Zero)
  G90
  G0 X[#<x_center_probed>]

  (Call sub "probe_y_plus" to Probe Y+ side of Workpiece)
  o<probe_y_plus> call [#1][#3 + #12 / 2][#4][#8][#9][#10]

  #<y_plus_probed> = #5062

  (Call sub "probe_y_minus" to Probe Y- side of Workpiece)
  o<probe_y_minus> call [#1][#3 + #12][#4][#8][#9][#10]

  #<y_minus_probed> = #5062

  (probed center calculation)
  #<y_center_probed> = [[#<y_plus_probed> + #<y_minus_probed>] / 2]

  (calculate Y Width Probed)
  #<raw_width> = [#<y_plus_probed> - #<y_minus_probed>]

  (Completed probed width calculations)
  #<y_probed_width> = [#<raw_width> + #<probe_diameter_offset>]

  M68 E1 Q[#<y_probed_width>]

  M68 E11 Q[#<y_center_probed>]

  G90
  G0 Y[#<y_center_probed>]
  G91
  G0 Z[#<z_probe_stack>]

  o<120> if [#<x_cal_width> GT #<x_probed_width>]
    (calculate calibration error and adjust calibration offset)
    #<x_cal_error> = [[#<x_cal_width> - #<x_probed_width>] / 2]
    #<new_x_cal_offset> = [#<calibration_offset> + #<x_cal_error>]
  o<120> else
    #<x_cal_error> = [[#<x_probed_width> - #<x_cal_width>] / 2]
    #<new_x_cal_offset> = [#<calibration_offset> - #<x_cal_error>]
  o<120> endif

  o<130> if [#<y_cal_width> GT #<y_probed_width>]
    (calculate calibration error and adjust calibration offset)
    #<y_cal_error> = [[#<y_cal_width> - #<y_probed_width>] / 2]
    #<new_y_cal_offset> = [#<calibration_offset> + #<y_cal_error>]
  o<130> else
    #<y_cal_error> = [[#<y_probed_width> - #<y_cal_width>] / 2]
    #<new_y_cal_offset> = [#<calibration_offset> - #<y_cal_error>]
  o<130> endif

  #<new_avg_cal_offset> = [[#<new_x_cal_offset> + #<new_y_cal_offset>] / 2]

  o<140> if [#<sq_cal_axis> EQ 0]
    M68 E12 Q[ABS[#<new_avg_cal_offset>]]
  o<140> else if [#<sq_cal_axis> EQ 1]
    M68 E12 Q[ABS[#<new_x_cal_offset>]]
  o<140> else
    M68 E12 Q[ABS[#<new_y_cal_offset>]]
  o<140> endif

  #<x_zero> = [#<x_center_probed> + #<workspace_x>]

  #<y_zero> = [#<y_center_probed> + #<workspace_y>]

  (probe mode rules for WCO or probe position measuring only)
  o<150> if [#<probe_mode> EQ 0]
    (Record X Zero in selected WCO)
    G10 L2 P#5220 X[#<x_zero>] Y[#<y_zero>]
    o<probe_cal_square_pocket> return
  o<150> endif

o<probe_cal_square_pocket> endsub

M2 (end program)