SET
SAVE
= L 16.1
L #Peripheral_Addr
ITD
L L#8
*D
LAR1
L PID [AR1,P#0.0]
T #Dword_temp
T #actual_position
L DW#16#10070001
T LD 18
L DINO
T LW 22
TAR2
+ L#16
T LD 24
L DW#16#10020004
T LD 28
L W#16#0
T LW 32
L DW#16#87000030
T LD 34
TAR2 LD 38
UC "BLKMOV"
P#L 18.0
P#L 42.0
P#L 28.0
LAR2 LD 38
L LW 42
T #SFC_FAULT
L 10
T #no_loops
A #preset_finished
NOT
A #preset_active
O #enable_preset
JCN A7d0
L #i
L 1
+I
T #i
SET
= #preset_active
A #preset_value_valid
NOT
JCN A7d1
L #no_loops
>=I
JCN A7d2
SET
= #preset_value_valid
L 0
T #i
A7d2: L DW#16#10020004
T LD 18
L W#16#0
T LW 22
L DW#16#87000030
T LD 24
L DW#16#10060001
T LD 28
L W#16#0
T LW 32
L DW#16#87000050
T LD 34
TAR2 LD 38
UC "BLKMOV"
P#L 18.0
P#L 42.0
P#L 28.0
LAR2 LD 38
L LW 42
T #SFC_FAULT
L #Peripheral_Addr
ITD
L L#8
*D
L #temp_preset_value
TAK
LAR1
TAK
T PQD [AR1,P#0.0]
A7d1: CLR
A #preset_value_valid
JCN A7d0
L #i
L #no_loops
>=I
JCN A7d4
SET
= #preset_finished
A7d4: SET
= #temp_preset_array[7]
L DW#16#10020004
T LD 18
L W#16#0
T LW 22
L DW#16#87000030
T LD 24
L DW#16#10060001
T LD 28
L W#16#0
T LW 32
L DW#16#87000050
T LD 34
TAR2 LD 38
UC "BLKMOV"
P#L 18.0
P#L 42.0
P#L 28.0
LAR2 LD 38
L LW 42
T #SFC_FAULT
L #Peripheral_Addr
ITD
L L#8
*D
L #temp_preset_value
TAK
LAR1
TAK
T PQD [AR1,P#0.0]
A7d0: CLR
A #enable_preset
NOT
A #preset_finished
JCN A7d5
L 0
T #i
CLR
= #preset_finished
= #preset_active
= #preset_value_valid
A7d5: SET
= L 16.1
SAVE
BE