add DET_Z motor

This commit is contained in:
2022-05-20 16:09:32 +02:00
parent 8e5b15e0ac
commit f47e111e65
6 changed files with 45 additions and 60 deletions

View File

@@ -38,7 +38,7 @@ Motor[5].IdCmd=0;Motor[5].InPosBand=10
&1
//initialization code
open plc 0
open plc 1
homez1..5
L0 = Sys.RunTime + .1
while (Sys.RunTime < L0){} //wait .1 sec
@@ -55,9 +55,13 @@ open plc 0
Motor[4].HomePos=Motor[4].HomePos-360000
if (Motor[5].ActPos-Motor[5].HomePos<-180000)
Motor[5].HomePos=Motor[5].HomePos-360000
disable plc 0
close // plc 0
disable plc 1
close // plc 1
enable plc 0
enable plc 1
//motor 1..5 use custom code to kill motor and use brake
!holding_current(m6=[0,700])