Download III. DELTA DIMA Module
Transcript
DELTA PROCESS-PLC System TASK 0 -------------------------------------------; ***** 1. Positioning ***** ; ; Mode 3: digital speed loop for ; both axes REGISTER_LOAD [121098 with 3] ;DigSpeedLoop for 21 REGISTER_LOAD [141098 with 3] ;DigSpeedLoop for 42 ; ; Realease and reference of bothaxes REGISTER_LOAD [121001 with 1] ;Release axis 21 REGISTER_LOAD [142001 with 1] ;Release axis 42 REGISTER_LOAD [121001 with 3] ;Ref 21 ActPos=0 REGISTER_LOAD [142001 with 3] ;Ref 42 ActPos=0 ; ; Declare axis 42 to slave in the slave REGISTER_LOAD [142001 with 33] ;42 slave (in slave) ; ; Config 4: axis 1 master, external slaves REGISTER_LOAD [124001 with 43] ;21 master, ext axis ; ; Declare axis 42 to slave in the master REGISTER_LOAD [124132 with 42] ;42isSlave(in master) ; REGISTER_LOAD [124003 with 600] ;Speed REGISTER_LOAD [124005 with 1000] ;Start ramp REGISTER_LOAD [124006 with 1000] ;Stop ramp ; ; Define positions REGISTER_LOAD [124038 with 0] ;ActPos axis 21 REGISTER_LOAD [124039 with 0] ;ActPos axis 42 REGISTER_LOAD [124030 with 10000] ;NomPos axis 21 REGISTER_LOAD [124032 with 15000] ;NomPos axis 42 ; REGISTER_LOAD [124001 with 41] ;Start interpolation WHEN AXXAR axis=21 ;Axis arrived ? AXARR axis=42 THEN DELAY 10 ; ; ***** 2. Positioning ***** ; REGISTER_LOAD [124038 with 10000] ;ActPos axis 21 REGISTER_LOAD [124039 with 15000] ;ActPos axis 42 REGISTER_LOAD [124030 with 22500] ;NomPos axis 21 REGISTER_LOAD [124032 with 20000] ;NomPos axis 42 REGISTER_LOAD [124001 with 41] ;Start interpolation WHEN AXARR axis=21 ;Axis arrived ? AXARR axis=42 THEN DELAY 10 GOTO 0 Program end DELTA DIMA Module 98