
!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


