124 lines
3.7 KiB
Python
124 lines
3.7 KiB
Python
import time
|
|
import serial
|
|
import pyads
|
|
import re
|
|
|
|
# --- KONFIGURATION ---
|
|
# ADS / TwinCAT
|
|
ADS_NETID = "5.17.17.136.1.1"
|
|
ADS_PORT = 501 # NC-Port
|
|
ADS_SYMBOL = 'Axes.EncoderTest.ActPos'
|
|
|
|
# Serielle Schnittstelle (Heidenhain ND 287)
|
|
COM_PORT = 'COM5'
|
|
BAUDRATE = 115200
|
|
|
|
# Intervall zwischen den Messungen (in Sekunden)
|
|
INTERVAL = 0.5
|
|
|
|
|
|
# ==========================================
|
|
# HILFSFUNKTION: STRING ZU FLOAT PARSEN
|
|
# ==========================================
|
|
def parse_heidenhain_val(raw_str):
|
|
"""
|
|
Extrahiert die erste Zahl (inkl. Vorzeichen und Dezimalpunkt/Komma)
|
|
aus dem Heidenhain-Antwortstring.
|
|
"""
|
|
if not raw_str:
|
|
return None
|
|
|
|
# Komma durch Punkt ersetzen (falls deutsches Format gesendet wird)
|
|
clean_str = raw_str.replace(',', '.')
|
|
|
|
# Regulärer Ausdruck für Zahlen mit optionalem Vorzeichen und Nachkommastellen
|
|
match = re.search(r'[-+]?\d*\.?\d+', clean_str)
|
|
if match:
|
|
try:
|
|
return float(match.group())
|
|
except ValueError:
|
|
return None
|
|
return None
|
|
|
|
# ==========================================
|
|
# HAUPTPROGRAMM
|
|
# ==========================================
|
|
def main():
|
|
plc = pyads.Connection(ADS_NETID, ADS_PORT)
|
|
try:
|
|
plc.open()
|
|
print("TwinCAT ADS: Verbindung erfolgreich.")
|
|
except Exception as e:
|
|
print(f"Fehler bei TwinCAT-Verbindung: {e}")
|
|
return
|
|
|
|
try:
|
|
ser = serial.Serial(
|
|
port=COM_PORT,
|
|
baudrate=BAUDRATE,
|
|
bytesize=serial.EIGHTBITS,
|
|
parity=serial.PARITY_NONE,
|
|
stopbits=serial.STOPBITS_ONE,
|
|
timeout=1.0
|
|
)
|
|
print(f"Heidenhain ND 287: Verbindung auf {COM_PORT} erfolgreich.\n")
|
|
except serial.SerialException as e:
|
|
print(f"Fehler bei COM-Port {COM_PORT}: {e}")
|
|
plc.close()
|
|
return
|
|
|
|
# Formatierten Header für die Tabelle ausgeben
|
|
print("=" * 75)
|
|
print(f"{'Zeit':<10} | {'TwinCAT [mm]':<14} | {'Heidenhain [mm]':<16} | {'Differenz [mm]':<15}")
|
|
print("=" * 75)
|
|
print("--> Messung läuft. Drücke [STRG + C] zum Beenden. <--\n")
|
|
|
|
try:
|
|
while True:
|
|
timestamp = time.strftime("%H:%M:%S")
|
|
tc_val = None
|
|
hh_val = None
|
|
|
|
# 1. TwinCAT NC Wert lesen
|
|
try:
|
|
tc_val = plc.read_by_name(ADS_SYMBOL, plc_datatype=pyads.PLCTYPE_LREAL)
|
|
tc_str = f"{tc_val:.4f}"
|
|
except Exception:
|
|
tc_str = "FEHLER"
|
|
|
|
# 2. Heidenhain ND 287 Wert lesen & parsen
|
|
try:
|
|
ser.reset_input_buffer()
|
|
ser.write(b'\x02') # CTRL+B senden
|
|
time.sleep(0.05)
|
|
|
|
raw_response = ser.readline().decode('utf-8', errors='ignore').strip()
|
|
hh_val = parse_heidenhain_val(raw_response)
|
|
|
|
hh_str = f"{hh_val:.4f}" if hh_val is not None else "N/A"
|
|
except Exception:
|
|
hh_str = "FEHLER"
|
|
|
|
# 3. Differenz berechnen (TwinCAT - Heidenhain)
|
|
if tc_val is not None and hh_val is not None:
|
|
diff = tc_val - hh_val
|
|
diff_str = f"{diff:+.4f}" # Mit explizitem Vorzeichen (+/-)
|
|
else:
|
|
diff_str = "N/A"
|
|
|
|
# 4. Tabellenzeile ausgeben
|
|
print(f"{timestamp:<10} | {tc_str:<14} | {hh_str:<16} | {diff_str:<15}")
|
|
|
|
time.sleep(INTERVAL)
|
|
|
|
except KeyboardInterrupt:
|
|
print("\n" + "=" * 75)
|
|
print("Messung durch Benutzer abgebrochen.")
|
|
|
|
finally:
|
|
ser.close()
|
|
plc.close()
|
|
print("Verbindungen zu TwinCAT und ND 287 geschlossen.")
|
|
|
|
if __name__ == '__main__':
|
|
main() |