Thierry Zamofing
789224b83d
Here all IOCs were started without any hardware. So in the next steps the hardware must be tested.
72 lines
1.3 KiB
INI
72 lines
1.3 KiB
INI
//home by bove to physical limits and set these to -5000um
|
|
|
|
define(PLC_Homing='1')
|
|
|
|
open plc PLC_Homing
|
|
define(status='P100',timer='P101')
|
|
|
|
L20=Motor[2].MaxDac
|
|
Motor[2].MaxDac=500
|
|
L21=Motor[2].FatalFeLimit
|
|
Motor[2].FatalFeLimit=2000
|
|
L22=Motor[2].JogSpeed
|
|
Motor[2].JogSpeed=1
|
|
|
|
L30=Motor[3].MaxDac
|
|
Motor[3].MaxDac=500
|
|
L31=Motor[3].FatalFeLimit
|
|
Motor[3].FatalFeLimit=2000
|
|
L32=Motor[3].JogSpeed
|
|
Motor[3].JogSpeed=1
|
|
|
|
|
|
Motor[2].PhaseFindingStep=1
|
|
Motor[3].PhaseFindingStep=1
|
|
timer = Sys.RunTime + 1;while (Sys.RunTime < timer){} //wait 1 sec
|
|
|
|
jog-2; jog-3;
|
|
|
|
status=1
|
|
while(1)
|
|
{
|
|
if(Motor[2].FeWarn==1 && (status&2)==0)
|
|
{
|
|
status=status|2
|
|
jog/2
|
|
Motor[2].PhasePos=310
|
|
Motor[2].HomePos=Motor[2].ActPos+5000
|
|
jog2=0
|
|
}
|
|
if(Motor[3].FeWarn==1 && (status&4)==0)
|
|
{
|
|
status=status|4
|
|
jog/3
|
|
Motor[3].PhasePos=1210
|
|
Motor[3].HomePos=Motor[3].ActPos+5000
|
|
jog3=0
|
|
}
|
|
if(status==7)
|
|
{
|
|
status=status|8
|
|
break
|
|
}
|
|
}
|
|
|
|
timer = Sys.RunTime + 2
|
|
while (Sys.RunTime < timer){} //wait 2 sec
|
|
status=100
|
|
timer = Sys.RunTime + 2
|
|
status=200
|
|
while (Sys.RunTime < timer){} //wait 2 sec
|
|
status=201
|
|
|
|
Motor[2].MaxDac=L20
|
|
Motor[2].FatalFeLimit=L21
|
|
Motor[2].JogSpeed=L22
|
|
Motor[3].MaxDac=L30
|
|
Motor[3].FatalFeLimit=L31
|
|
Motor[3].JogSpeed=L32
|
|
|
|
disable plc PLC_Homing
|
|
close
|