1 files changed, 42 insertions, 0 deletions
diff --git a/firmware/src/eui64.c b/firmware/src/eui64.c
new file mode 100644
index 0000000..516ff84
--- /dev/null
+++ b/firmware/src/eui64.c
@@ -0,0 +1,42 @@
+#include <stdio.h>
+#include <stdbool.h>
+
+#include <zephyr/devicetree.h>
+
+#include "eui64.h"
+
+#define UID64_NODE DT_NODELABEL(eui64)
+
+uint64_t eui64_get(void) {
+#if DT_NODE_EXISTS(UID64_NODE)
+		return *(volatile uint64_t *) DT_REG_ADDR(UID64_NODE);
+#else
+		return 0;
+#endif
+}
+
+void eui64_to_string(uint64_t uid, char *str) {
+	uint8_t *source = (uint8_t *)&uid + 7;
+	char *sink = str;
+
+	for (unsigned int i = 0; i < 8; i++) {
+		/* delimiter */
+		if (i > 0) {
+			*sink = ':';
+			sink++;
+		}
+
+		/* byte values */
+		snprintf(sink, 3, "%02x", *source);
+		source--;
+		sink += 2;
+	}
+}
+
+bool eui64_available(void) {
+#if DT_NODE_EXISTS(UID64_NODE)
+	return true;
+#else
+	return false;
+#endif
+}