Files
2026-09-02 07:37:44 +02:00

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()