(author: Julian Koenig)
(version: 2.0)
(date: 30.05.2024)


o<probe_safety_checks> sub

  #<tool_number_1>      = #<_ini[probe]TOOL_NUMBER_1>
  #<tool_number_2>      = #<_ini[probe]TOOL_NUMBER_2>
  #<tool_number_3>      = #<_ini[probe]TOOL_NUMBER_3>
  #<x_offset>           = #5401
  #<y_offset>           = #5402
  #<probe_range_x>      = #5411
  #<probe_range_y>      = #5412
  
  #<cal_mode>           = #1  (0 for normal; 1 for used while calibration) 
  
  #<max_xy>             = #<_ini[probe]MAX_XY_DISTANCE>
  #<max_z>              = #<_ini[probe]MAX_Z_DISTANCE>
  #<probe_slow_fr>      = #<_ini[probe]VEL_SLOW>
  #<probe_fast_fr>      = #<_ini[probe]VEL_FAST>
  #<probe_ff>           = #<_ini[probe]VEL_FF>
  #<deb_t>              = #<_ini[probe]DEBOUNCE_TIME>
  #<acc_x>              = #<_ini[AXIS_X]MAX_ACCELERATION>
  #<acc_y>              = #<_ini[AXIS_Y]MAX_ACCELERATION>
  #<acc_z>              = #<_ini[AXIS_Z]MAX_ACCELERATION>
  
  

  (Check for too high velocities)
  o140 if [[#<acc_x>] GT [#<acc_y>]]
    #<acc_xy> =  #<acc_y>
  o140 else
    #<acc_xy> =  #<acc_x>
  o140 endif
  
  #<max_vel_xy> = [60 * [SQRT[[[[#<acc_xy>]*[#<deb_t>]*0.001]*[[#<acc_xy>]*[#<deb_t>]*0.001]]  +  [2*[#<acc_xy>]*[#<max_xy>]]] - [[#<acc_xy>]*[#<deb_t>]*0.001]]]
  #<max_vel_z>  = [60 * [SQRT[[[[#<acc_z>] *[#<deb_t>]*0.001]*[[#<acc_z>] *[#<deb_t>]*0.001]]  +  [2*[#<acc_z>] *[#<max_z>]]]  - [[#<acc_z>] *[#<deb_t>]*0.001]]]
  
  o141 if [[[#<max_vel_xy>] LT [#<probe_ff>]] OR [[#<max_vel_xy>] LT [#<probe_fast_fr>]] OR [[#<max_vel_xy>] LT [#<probe_slow_fr>]]]
    (debug,Your current probe velocity values are to high for X/Y safety, so that your probe could be damaged. Please lower your values, aborting.)
    (debug,Maximum values for velocity X/Y: %.1f#<max_vel_xy>) 
    o<probe_safety_checks> return [0]
  o141 elseif [[[#<max_vel_z>] LT [#<probe_fast_fr>]] OR [[#<max_vel_z>] LT [#<probe_slow_fr>]]]
    (debug,Your current probe velocity values are to high for Z safety, so that your probe could be damaged. Please lower your values, aborting.)
    (debug,Maximum values for velocity Z: %.1f#<max_vel_z>)
    o<probe_safety_checks> return [0]
  o141 endif
 


  (return value default 0, if everything is fine value 1)
  o100 if [#5400 EQ 0]
    (MSG,No specified probe tool in spindle, aborting)
    o<probe_safety_checks> return [0]
  
  o100 elseif [[#5400 EQ #<tool_number_1>] OR [#5400 EQ #<tool_number_2>] OR [#5400 EQ #<tool_number_3>]]
  
    o110 if [#5410 EQ 0]
      (MSG,No tipdiameter specified. Please enter tipdiameter to tooltable, aborting)
      o<probe_safety_checks> return [0]
    o110 endif

    o120 if [#<cal_mode> EQ 0]
      o130 if [[#<x_offset> EQ 0] OR [#<probe_range_x> EQ 0] OR [#<y_offset> EQ 0] OR [#<probe_range_y> EQ 0]]
        (MSG,No calibration data found in tooltable. Please do a calibration, aborting)
        o<probe_safety_checks> return [0]
      o130 else
        (If everthing is fine, then value 1)
        o<probe_safety_checks> return [1]
      o130 endif
    o120 elseif [#<cal_mode> EQ 1]
      (If everthing is fine, then value 1)    
      o<probe_safety_checks> return [1]
    o120 endif

  o100 else
    (MSG,No specified probe tool in spindle, aborting)
    o<probe_safety_checks> return [0]
  o100 endif


o<probe_safety_checks> endsub
M2 (end program)