From 9154476ba6bf400c1eb379f0a3aa6caae2d06d4d Mon Sep 17 00:00:00 2001
From: Sebastiano Tronto <sebastiano@tronto.net>
Date: Tue, 25 Mar 2025 14:09:14 +0100
Subject: Added NISS to coord solver

---
 src/solvers/coord/utils.h | 68 +++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 68 insertions(+)
 create mode 100644 src/solvers/coord/utils.h

(limited to 'src/solvers/coord/utils.h')

diff --git a/src/solvers/coord/utils.h b/src/solvers/coord/utils.h
new file mode 100644
index 0000000..ab4aded
--- /dev/null
+++ b/src/solvers/coord/utils.h
@@ -0,0 +1,68 @@
+STATIC coord_t *parse_coord(size_t n, const char [n]);
+STATIC uint8_t parse_axis(size_t n, const char [n]);
+STATIC void parse_coord_and_axis(size_t n, const char [n], coord_t **, uint8_t *);
+STATIC int64_t dataid_coord(const char *, char [static NISSY_DATAID_SIZE]);
+
+STATIC coord_t *
+parse_coord(size_t n, const char coord[n])
+{
+	int i;
+
+	for (i = 0; all_coordinates[i] != NULL; i++)
+		if (!strncmp(all_coordinates[i]->name, coord, n))
+			return all_coordinates[i];
+
+	return NULL;
+}
+
+STATIC uint8_t
+parse_axis(size_t n, const char axis[n])
+{
+	if (!strncmp(axis, "UD", n) || !strncmp(axis, "DU", n)) {
+		return AXIS_UD;
+	} else if (!strncmp(axis, "RL", n) || !strncmp(axis, "LR", n)) {
+		return AXIS_RL;
+	} else if (!strncmp(axis, "FB", n) || !strncmp(axis, "BF", n)) {
+		return AXIS_FB;
+	}
+
+	return UINT8_ERROR;
+}
+
+STATIC void
+parse_coord_and_axis(
+	size_t n,
+	const char str[n],
+	coord_t **coord,
+	uint8_t *axis
+)
+{
+	size_t i;
+
+	for (i = 0; i < n; i++)
+		if (str[i] == '_')
+			break;
+
+	if (coord != NULL)
+		*coord = parse_coord(i, str);
+
+	if (axis != NULL)
+		*axis = i == n ? UINT8_ERROR : parse_axis(n-i-1, str+i+1);
+}
+
+STATIC int64_t
+dataid_coord(const char *ca, char dataid[static NISSY_DATAID_SIZE])
+{
+	coord_t *c;
+
+	parse_coord_and_axis(strlen(ca), ca, &c, NULL);
+
+	if (c == NULL) {
+		LOG("dataid_coord: cannot parse coordinate from '%s'\n", ca);
+		return NISSY_ERROR_INVALID_SOLVER;
+	}
+
+	strcpy(dataid, c->name);
+
+	return NISSY_OK;
+}
-- 
cgit v1.3