50 lines
1.3 KiB
INI
50 lines
1.3 KiB
INI
|
|
!MX3_setup()
|
|
//!MX3_setup_sim() // comment out !MX3_setup() when this is active
|
|
//!MX3_home()
|
|
//using 360000 for 1 rev. -> 1.7453292519943296e-05=np.pi/180000
|
|
//excentricity= 5mm
|
|
//height = 2mm ?
|
|
//width = 50cm ?
|
|
//length = 100cm ?
|
|
!MX3_coordTrf(exc=5000,height=2000,width=500000,length=1000000,camSf=1.7453292519943296e-05)
|
|
|
|
|
|
Coord[1].Ta=10
|
|
Coord[1].Td=10
|
|
Coord[1].AltFeedRate=1000
|
|
Coord[1].Tm=-10000 //1000um/FeedTime -> 1mm/sec
|
|
Coord[1].FeedTime=1000 //default value 1000um
|
|
|
|
|
|
|
|
//motor current off (as cpxcall 16)
|
|
Motor[1].IdCmd=0;Motor[1].InPosBand=10
|
|
Motor[2].IdCmd=0;Motor[2].InPosBand=10
|
|
Motor[3].IdCmd=0;Motor[3].InPosBand=10
|
|
Motor[4].IdCmd=0;Motor[4].InPosBand=10
|
|
Motor[5].IdCmd=0;Motor[5].InPosBand=10
|
|
|
|
#1..5hmz
|
|
#1..5j/
|
|
&1
|
|
|
|
//initialization code
|
|
open plc 0
|
|
if (Motor[1].ActPos-Motor[1].HomePos>180000)
|
|
Motor[1].HomePos=Motor[1].HomePos+360000
|
|
if (Motor[2].ActPos-Motor[2].HomePos>180000)
|
|
Motor[2].HomePos=Motor[2].HomePos+360000
|
|
if (Motor[3].ActPos-Motor[3].HomePos>180000)
|
|
Motor[3].HomePos=Motor[3].HomePos+360000
|
|
if (Motor[4].ActPos-Motor[4].HomePos>180000)
|
|
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```
|
|
|
|
enable plc 0
|
|
|
|
|