'툴교환을 한뒤 툴 끝의 0지점을 찾는 프로그램

Sub Main()


'Z축의 0지점을 찾기위해 사용하는 변수 설정 부분
ZeroOffsetZ = 5.35 '센서의 측정 위치에서 바닥까지 거리

UpStep = 1/320 '센서를 끄기 위해 위로 이동하는 간격 값 (모터의 1스텝 값)
StepZ = 100 * UpStep '센서를 끄기 위해 위로 빠르게 이동하는 간격 값

ProbeX = -33.5 '센서가 있는 X축의 기계 좌표 값
ProbeY = 386.2 '센서가 있는 Y축의 기계 좌표 값

DownFeed = 1500 '센서를 찾을 때 축의 이동 속도

MinLimitZ = GetOEMDro(158) 'Z축이 움직일 수 있는 최저 높이 (Softlimit Z Minimum DRO)

SafeZ = GetOEMDro(152) - 5 'Z축이 움직일 수 있는 최고 높이 값에서 -5한 값을 안전 높이로 정함 (Softlimit Z Maximum DRO)



'CNC의 현재 상태를 저장하는 부분
CurrentFeed = GetOemDRO(818) '현재의 이송 속도를 저장합니다.

SetOEMDro(54, SafeZ) 'Z축의 안전높이를 저장함 (Safe Z DRO)

'UserFixture = GetOEMDro(46) '현재 유저좌표를 저장합니다.



'영점을 잡기위해 CNC를 초기화하는 부분
If GetOEMLed(16) Then '표시가 기계좌표(G53)이면 유저좌표(G54)로 바꿉니다.
  Code "G54" '사용자 좌표(G54)로 바꿉니다.
  DoOemButton(107) '유저좌표를 표시합니다.
End If

Code "M5" '스핀들 회전을 멈춥니다.
Code "M9" '기름 분출을 멈춥니다.

Code "G90"
Code "G0 G53 Z" & SafeZ 'Z축을 안전한 높이로 올립니다.
Code "G0 G53 X" & ProbeX & " Y" & ProbeY '센서 위치로 이동합니다.

While IsMoving() '위의 작업이 끝날 때까지 기다립니다.
Wend

if GetLED(0) Then Goto Exit_Loop 'Reset이 걸리면 프로그램을 종료합니다.



'빠르게 센서를 검출하는 부분
'GetOemLed(825)는 Digitize LED상태입니다.
If GetOemLed(825) = 1 Then '현제 센서가 동작하고 있으면 에러메세지 출력
  MsgBox ("센서 문제가 있습니다.")
  Exit Sub
End If

CurrentZ = GetOEMDro(802) - SafeZ + MinLimitZ '센서 검출을 위한 Z축의 값을 계산합니다.
Code "G31 Z" & CurrentZ & " F" & DownFeed '센서 검출을 하면서 Z축을 내립니다.

While IsMoving() '위의 작업이 끝날 때까지 기다립니다.
Wend

if GetLED(0) Then Goto Exit_Loop 'Reset이 걸리면 프로그램을 종료합니다.

If GetOemLed(825) = 0 Then '센서가 동작하지 않으면 에러메세지 출력
  MsgBox ("센서가 감지 되지 않습니다.")
  Exit Sub
End If



'정확하게 영점을 잡기 위해 센서의 위치를 검출하는 부분
CurrentZ = GetOEMDro(802) 'GetOEMDro(802)는 Z축의 유저좌표입니다.

While (GetOemLed(825)) '센서 감지가 없을 때까지 조금씩 Z축을 위로 올립니다.
Tool_Up_Loop:
  CurrentZ = CurrentZ + StepZ

  Code "G0 Z" & CurrentZ

  While IsMoving() '위의 작업이 끝날 때까지 기다립니다.
  Wend

  if GetLED(0) Then Goto Exit_Loop 'Reset이 걸리면 프로그램을 종료합니다.
Wend

'Z축을 다시 약간 내려서 Z축이 센서에 닿게 합니다.
if StepZ <> UpStep Then
  CurrentZ = CurrentZ - (1.5 * StepZ)
  StepZ = UpStep
  Goto Tool_Up_Loop
End If  



'찾은 영점 좌표로 유저좌표를 영점 조정하는 부분
SetOEMDro(802, ZeroOffsetZ) '현재의 Z축을 유저좌표에 0점 조정함

Code "G4 P0.1" 'Z축 좌표 설정후에 다음 작업을 하도록 G4 코드를 넣습니다.

While IsMoving() '위의 작업이 끝날 때까지 기다립니다.
Wend



'프로그램을 마무리하는 부분
Code "G0 G53 Z" & SafeZ

While IsMoving() '위의 작업이 끝날 때까지 기다립니다.
Wend

Exit_Loop:
SetOemDRO(818,CurrentFeed) '영점 맞추기 전의 이송 속도로 복귀합니다.
'SetOEMDro(46,UserFixture) '영점 맞추기 전의 유저좌표로 복귀합니다.

End Sub

Main