Delta Tau GEO BRICK LV Benutzerhandbuch

Seite von 271
Geo Brick LV User Manual
 
PinOuts and Software Setup 
 129 
Absolute Power-On Position Read (Yaskawa 20-bit) 
Channel 1 example PLC, 20-bit Absolute Sigma III Encoder 
End Gat 
Del Gat 
Close 
 
#define FirstWord       M1000 ; Yaskawa Data Register1, 1
st
 word 
#define SecondWord      M1001 ; Yaskawa Data Register1, 2
nd
 word 
#define STD0_19         M1002 ; Single-Turn Data 0-19 (20-bits) 
#define MTD0_15         M1003 ; Multi-Turn Data 0-15 (16-bits) 
 
FirstWord->Y:$78B20,0,24 
SecondWord->Y:$78B21,0,4 
STD0_19->* 
MTD0_15->* 
 
#define Mtr1ActPos      M162 
Mtr1ActPos->D:$00008B ; #1 Actual position (1/[Ixx08*32] cts) 
 
open plc 1 clear 
MTD0_15 = (SecondWord & $FFFF) 
STD0_19 = int ((FirstWord & $FFFFF0) / 16) 
If (MTD0_15>$7FFF) 
 
MTD0_15 = (MTD0_15^$FFFF + 1)*-1 
 
 
If (STD0_19 !=0) 
 
 
STD0_19 = (STD0_19^$FFFFF + 1)*-1 
 
Endif 
Endif 
Mtr1ActPos = ((MTD0_15 * $100000)+ STD0_19) * I108 * 32 
 
disable plc 1 
close