import time import re import math import serial import pyads import matplotlib.pyplot as plt import matplotlib.animation as animation # ========================================== # KONFIGURATION # ========================================== COM_PORT = 'COM5' BAUDRATE = 115200 AMS_NET_ID = "5.17.17.136.1.1" NC_PORT = 501 NC_SYMBOL = 'Axes.EncoderTest.ActPos' INTERVAL_MS = 200 # Abtastintervall in Millisekunden LOG_FILENAME = "messung_twincat_heidenhain_auto_incr1.csv" # Global gespeicherte Messdaten timestamps = [] tc_values = [] hh_values = [] diff_values = [] records = [] # ========================================== # HILFSFUNKTION: STRING ZU FLOAT PARSEN # ========================================== def parse_heidenhain_val(raw_str): if not raw_str: return None clean_str = raw_str.replace(',', '.') match = re.search(r'[-+]?\d*\.?\d+', clean_str) if match: try: return float(match.group()) except ValueError: return None return None # ========================================== # HARDWARE-VERBINDUNGEN INITIATIVE # ========================================== plc = pyads.Connection(AMS_NET_ID, NC_PORT) try: plc.open() print("TwinCAT ADS: Verbindung erfolgreich.") except Exception as e: print(f"Fehler ADS: {e}") exit() 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 COM: {e}") plc.close() exit() # ========================================== # MATPLOTLIB SETUP (ECHTZEIT-PLOT) # ========================================== fig, (ax1, ax2) = plt.subplots(2, 1, figsize=(10, 6), sharex=True) fig.suptitle("Echtzeit-Messung: TwinCAT vs. Heidenhain ND 287") # Linien initialisieren line_tc, = ax1.plot([], [], label="TwinCAT NC [mm]", color="blue") line_hh, = ax1.plot([], [], label="Heidenhain ND 287 [mm]", color="orange", linestyle="--") ax1.set_ylabel("Position [mm]") ax1.legend(loc="upper left") ax1.grid(True) line_diff, = ax2.plot([], [], label="Abweichung (TC - HH) [mm]", color="red") ax2.axhline(0, color="black", linestyle=":", linewidth=1) ax2.set_xlabel("Zeitstempel") ax2.set_ylabel("Differenz [mm]") ax2.legend(loc="upper left") ax2.grid(True) # ========================================== # UPDATE-FUNKTION FÜR JEDEN ZEITSCHRITT # ========================================== start_time = time.time() def update(frame): current_time_str = time.strftime("%H:%M:%S") full_timestamp = time.strftime("%Y-%m-%d %H:%M:%S") tc_val, hh_val = None, None # 1. TwinCAT lesen try: tc_val = plc.read_by_name(NC_SYMBOL, plc_datatype=pyads.PLCTYPE_LREAL) tc_str = f"{tc_val:.4f}" except Exception: tc_str = "FEHLER" # 2. Heidenhain lesen try: ser.reset_input_buffer() ser.write(b'\x02') time.sleep(0.03) 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 verarbeiten if tc_val is not None and hh_val is not None: diff = tc_val - hh_val diff_str = f"{diff:+.4f}" # Daten für Plot anhängen timestamps.append(current_time_str) tc_values.append(tc_val) hh_values.append(hh_val) diff_values.append(diff) else: diff_str = "N/A" records.append((full_timestamp, tc_str, hh_str, diff_str)) # Maximal 50 Messwerte im Plot anzeigen (rollendes Fenster) max_visible = 50 x_data = timestamps[-max_visible:] line_tc.set_data(range(len(x_data)), tc_values[-max_visible:]) line_hh.set_data(range(len(x_data)), hh_values[-max_visible:]) line_diff.set_data(range(len(x_data)), diff_values[-max_visible:]) # Achsen-Grenzen anpassen ax1.relim() ax1.autoscale_view() ax2.relim() ax2.autoscale_view() # X-Achsen Beschriftung ax2.set_xticks(range(len(x_data))) ax2.set_xticklabels(x_data, rotation=45, ha="right", fontsize=8) return line_tc, line_hh, line_diff # ========================================== # AUTOMATISCHER EXPORT BEIM BEENDEN # ========================================== def on_close(event=None): ser.close() plc.close() stat_lines = [] stat_lines.append("# " + "=" * 55) stat_lines.append("# STATISTIK DER ABWEICHUNG") stat_lines.append("# " + "=" * 55) if diff_values: count = len(diff_values) mean_diff = sum(diff_values) / count max_diff = max(diff_values) min_diff = min(diff_values) max_abs_diff = max(abs(d) for d in diff_values) if count > 1: variance = sum((x - mean_diff) ** 2 for x in diff_values) / (count - 1) std_dev_str = f"{math.sqrt(variance):.4f} mm" else: std_dev_str = "N/A" stat_lines.append(f"# Anzahl Messwerte: {count}") stat_lines.append(f"# Mittelwert Differenz: {mean_diff:+.4f} mm") stat_lines.append(f"# Maximale Abweichung (+): {max_diff:+.4f} mm") stat_lines.append(f"# Minimale Abweichung (-): {min_diff:+.4f} mm") stat_lines.append(f"# Max. Betragsabweichung: {max_abs_diff:.4f} mm") stat_lines.append(f"# Standardabweichung (s): {std_dev_str}") else: stat_lines.append("# Keine gültigen Messdaten vorhanden.") stat_lines.append("# " + "=" * 55) try: with open(LOG_FILENAME, mode='w', encoding='utf-8') as f: f.write("Zeitstempel;TwinCAT_mm;Heidenhain_mm;Differenz_mm\n") for rec in records: f.write(f"{rec[0]};{rec[1]};{rec[2]};{rec[3]}\n") f.write("\n") for line in stat_lines: f.write(line + "\n") print(f"\n[INFO] Datei gespeichert unter: {LOG_FILENAME}") except IOError as e: print(f"\n[FEHLER] Datei konnte nicht geschrieben werden: {e}") # Beenden per Fenster-Schließen abfangen fig.canvas.mpl_connect('close_event', on_close) # Animation starten ani = animation.FuncAnimation(fig, update, interval=INTERVAL_MS, cache_frame_data=False) plt.tight_layout() plt.show()