Z - Höhe automatisch ermitteln

Hallo zusammen,

ich würde meinen Kossel gerne um folgenden Feature erweitern.
Nachdem ich den Druckkopf mit einen FSR Sensor ausgestattet habe, um die "Auto Bed Leveling" Funktion zu nutzen,
möchte ich nun die Z-Höhe vor jeden Druck automatisch ermitteln und im Eprom hinterlegen/ speichern.

Jedoch weiß ich nicht so recht wie ich es mittels G-Codes realisieren soll

Nehmen wir an ich habe eine Druckbare Bauraumhöhe von 300 mm. Im Startskript müsste dann folgendes stehen:

G28 ; Endstops anfahren
G1 X0 Y0 Z2 ; Z Höhe anfahren
G30 ; Druckbett abtasten
M114 ; Offset Wert auslesen
..........

Wie kann ich jetzt den ermittelten Offset Wert im Eprom abspeichern?

Würde mich freuen wenn ihr mir weiterhelfen würdet