From 4c4969d0cb0f817de2aa866a7d8abfde6ecaff82 Mon Sep 17 00:00:00 2001
From: Joshua Allen <axlecrusher@gmail.com>
Date: Sat, 25 Feb 2017 14:20:28 -0500
Subject: initial commit of config parser

---
 src/survive_config.c | 182 +++++++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 182 insertions(+)
 create mode 100644 src/survive_config.c

(limited to 'src/survive_config.c')

diff --git a/src/survive_config.c b/src/survive_config.c
new file mode 100644
index 0000000..42c2c89
--- /dev/null
+++ b/src/survive_config.c
@@ -0,0 +1,182 @@
+#include <string.h>
+#include <assert.h>
+#include "survive_config.h"
+
+#define MAX_CONFIG_ENTRIES 100
+
+config_val config_values[MAX_CONFIG_ENTRIES];
+static uint16_t used_entries = 0;
+
+static FILE *config_file = NULL;
+
+void config_init() {
+	uint16_t i = 0;
+	for (i=0;i<MAX_CONFIG_ENTRIES;++i) {
+		config_values[i].str = NULL;
+		config_values[i].tag = NULL;
+	}
+
+	used_entries = 0;
+}
+
+void write_float(char* tag, float x) {
+	fprintf(config_file, "\"%s\":\"%f\"\n", tag, x);
+}
+
+void write_float_a(char* tag, float *x, uint8_t count) {
+	uint8_t i = 0;
+	char idx[4];
+	for (i=0;i<count;++i) {
+		sprintf(idx,"%d",i);
+		fprintf(config_file, "\"%s%s\":\"%f\"\n", tag,idx, x);
+	}
+	fprintf(config_file, "\"%s\":\"%f\"\n", tag, x);
+}
+
+void write_uint32(char* tag, uint32_t x) {
+	fprintf(config_file, "\"%s\":\"%d\"\n", tag, x);
+}
+
+void config_open(const char* path, const char* mode) {
+	config_file = fopen(path, mode);
+}
+
+void config_close() {
+	fclose(config_file);
+}
+
+void config_write_lighthouse(struct BaseStationData* bsd, uint8_t length) {
+	uint8_t i = 0;
+
+	float Position[3];
+	float Quaternion[4];
+	uint32_t BaseStationID;
+	float fcalphase[2];
+	float fcaltilt[2];
+	float fcalcurve[2];
+	float fcalgibpha[2];
+	float fcalgibmag[2];
+
+	for (i=0;i<length; ++i) {
+		write_uint32("id", bsd[i].BaseStationID);
+		write_float_a("position", bsd[i].Position, 3);
+		write_float_a("quaternion", bsd[i].Quaternion, 4);
+		write_float_a("quaternion", bsd[i].Quaternion, 4);
+		write_float_a("fcalphase", bsd[i].fcalphase, 2);
+		write_float_a("fcaltilt", bsd[i].fcaltilt,2);
+		write_float_a("fcalcurve", bsd[i].fcalcurve,2);
+		write_float_a("fcalgibpha", bsd[i].fcalgibpha,2);
+		write_float_a("fcalgibmag", bsd[i].fcalgibmag,2);
+	}
+}
+
+void sstrcpy(char* dest, const char *src) {
+	uint32_t len = strlen(src)+1;
+	if (dest == NULL) {
+		dest = (char*)malloc(len);
+	} else {
+		dest = (char*)realloc(dest, len);
+	}
+	strcpy(dest,src);
+}
+
+const char* config_read_str(const char *tag, const char *value, const char *def_str) {
+	uint16_t i = 0;
+	for (i=0;i<used_entries;++i) {
+		if ( strcmp(config_values[i].tag, tag) == 0 ) {
+			return config_values[i].str;
+		}
+	}
+	assert(used_entries<MAX_CONFIG_ENTRIES);
+
+	i = used_entries++;
+	sstrcpy(config_values[i].tag, tag);
+	sstrcpy(config_values[i].str, def_str);
+
+	return config_values[i].str;
+}
+
+uint32_t config_read_uint32(const char *tag, const uint32_t value, const uint32_t def) {
+	uint16_t i = 0;
+	for (i=0;i<used_entries;++i) {
+		if ( strcmp(config_values[i].tag, tag) == 0 ) {
+			return config_values[i].numeric.i;
+		}
+	}
+	assert(used_entries<MAX_CONFIG_ENTRIES);
+
+	i = used_entries++;
+	sstrcpy(config_values[i].tag, tag);
+	config_values[i].numeric.i = def;
+
+	return config_values[i].numeric.i;
+}
+
+float config_read_float(const char *tag, const float value, const float def) {
+	uint16_t i = 0;
+	for (i=0;i<used_entries;++i) {
+		if ( strcmp(config_values[i].tag, tag) == 0 ) {
+			return config_values[i].numeric.f;
+		}
+	}
+	assert(used_entries<MAX_CONFIG_ENTRIES);
+
+	i = used_entries++;
+	sstrcpy(config_values[i].tag, tag);
+	config_values[i].numeric.f = def;
+
+	return config_values[i].numeric.f;
+}
+
+const char* config_set_str(const char *tag, const char* value) {
+	uint16_t i = 0;
+
+	assert(used_entries<MAX_CONFIG_ENTRIES);
+
+	i = used_entries++;
+	sstrcpy(config_values[i].tag, tag);
+	sstrcpy(config_values[i].str, value);
+
+	return value;
+}
+
+const uint32_t config_set_uint32(const char *tag, const uint32_t value) {
+	uint16_t i = 0;
+
+	assert(used_entries<MAX_CONFIG_ENTRIES);
+
+	i = used_entries++;
+	sstrcpy(config_values[i].tag, tag);
+	config_values[i].numeric.i = value;
+
+	return value;
+}
+
+const float config_set_float(const char *tag, const float value) {
+	uint16_t i = 0;
+
+	assert(used_entries<MAX_CONFIG_ENTRIES);
+
+	i = used_entries++;
+	sstrcpy(config_values[i].tag, tag);
+	config_values[i].numeric.f = value;
+
+	return value;
+}
+void config_save(const char* path) {
+	uint16_t i = 0;
+
+	FILE* f = fopen(path, "w");
+
+	for (i=0;i<=used_entries;++i) {
+		if (config_values[i].type == CONFIG_FLOAT) {
+			fprintf(f, "\"%s\":\"%F\"\n", config_values[i].tag, config_values[i].numeric.f);
+		} else if (config_values[i].type == CONFIG_UINT32) {
+			fprintf(f, "\"%s\":\"%F\"\n", config_values[i].tag, config_values[i].numeric.i);
+		} else if (config_values[i].type == CONFIG_STRING) {
+			fprintf(f, "\"%s\":\"%s\"\n", config_values[i].tag, config_values[i].str);
+		}
+	};
+
+	fclose(f);
+}
\ No newline at end of file
-- 
cgit v1.2.3


From 3baabd2f8aa69a986bbb29739e6353d9a95336c5 Mon Sep 17 00:00:00 2001
From: Joshua Allen <axlecrusher@gmail.com>
Date: Sat, 25 Feb 2017 14:34:10 -0500
Subject: float to FLT

---
 src/survive_config.c | 20 ++++++--------------
 1 file changed, 6 insertions(+), 14 deletions(-)

(limited to 'src/survive_config.c')

diff --git a/src/survive_config.c b/src/survive_config.c
index 42c2c89..254e52f 100644
--- a/src/survive_config.c
+++ b/src/survive_config.c
@@ -19,11 +19,11 @@ void config_init() {
 	used_entries = 0;
 }
 
-void write_float(char* tag, float x) {
+void write_float(char* tag, FLT x) {
 	fprintf(config_file, "\"%s\":\"%f\"\n", tag, x);
 }
 
-void write_float_a(char* tag, float *x, uint8_t count) {
+void write_float_a(char* tag, FLT *x, uint8_t count) {
 	uint8_t i = 0;
 	char idx[4];
 	for (i=0;i<count;++i) {
@@ -48,15 +48,6 @@ void config_close() {
 void config_write_lighthouse(struct BaseStationData* bsd, uint8_t length) {
 	uint8_t i = 0;
 
-	float Position[3];
-	float Quaternion[4];
-	uint32_t BaseStationID;
-	float fcalphase[2];
-	float fcaltilt[2];
-	float fcalcurve[2];
-	float fcalgibpha[2];
-	float fcalgibmag[2];
-
 	for (i=0;i<length; ++i) {
 		write_uint32("id", bsd[i].BaseStationID);
 		write_float_a("position", bsd[i].Position, 3);
@@ -112,7 +103,7 @@ uint32_t config_read_uint32(const char *tag, const uint32_t value, const uint32_
 	return config_values[i].numeric.i;
 }
 
-float config_read_float(const char *tag, const float value, const float def) {
+FLT config_read_float(const char *tag, const FLT value, const FLT def) {
 	uint16_t i = 0;
 	for (i=0;i<used_entries;++i) {
 		if ( strcmp(config_values[i].tag, tag) == 0 ) {
@@ -152,7 +143,7 @@ const uint32_t config_set_uint32(const char *tag, const uint32_t value) {
 	return value;
 }
 
-const float config_set_float(const char *tag, const float value) {
+const FLT config_set_float(const char *tag, const FLT value) {
 	uint16_t i = 0;
 
 	assert(used_entries<MAX_CONFIG_ENTRIES);
@@ -179,4 +170,5 @@ void config_save(const char* path) {
 	};
 
 	fclose(f);
-}
\ No newline at end of file
+}
+
-- 
cgit v1.2.3


From 3b483ee7e15667d86be07fd49327a2cf558ab614 Mon Sep 17 00:00:00 2001
From: Joshua Allen <axlecrusher@gmail.com>
Date: Sat, 25 Feb 2017 15:14:10 -0500
Subject: integer not float

---
 src/survive_config.c | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

(limited to 'src/survive_config.c')

diff --git a/src/survive_config.c b/src/survive_config.c
index 254e52f..ed3f6cd 100644
--- a/src/survive_config.c
+++ b/src/survive_config.c
@@ -163,7 +163,7 @@ void config_save(const char* path) {
 		if (config_values[i].type == CONFIG_FLOAT) {
 			fprintf(f, "\"%s\":\"%F\"\n", config_values[i].tag, config_values[i].numeric.f);
 		} else if (config_values[i].type == CONFIG_UINT32) {
-			fprintf(f, "\"%s\":\"%F\"\n", config_values[i].tag, config_values[i].numeric.i);
+			fprintf(f, "\"%s\":\"%d\"\n", config_values[i].tag, config_values[i].numeric.i);
 		} else if (config_values[i].type == CONFIG_STRING) {
 			fprintf(f, "\"%s\":\"%s\"\n", config_values[i].tag, config_values[i].str);
 		}
-- 
cgit v1.2.3