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