p command working to change PWM

refactgored pwm code

1 files changed, 27 insertions, 0 deletions

diff --git a/src/helpers.c b/src/helpers.c
new file mode 100644
index 0000000..b8c3373
--- /dev/null
+++ b/src/helpers.c
@@ -0,0 +1,27 @@
+/*
+ * src/helpers.c
+ * (c) 2022 Jonas Gunz <himself@jonasgunz.de>
+ * License: All rights reserved.
+ */
+
+#include "helpers.h"
+
+uint8_t hex_to_byte(char c[]) {
+	uint8_t ret = hex_to_halfbyte(c[0]);
+	ret += 16 * hex_to_halfbyte(c[1]);
+
+	return ret;
+}
+
+uint8_t hex_to_halfbyte(char c) {
+	uint8_t ret = 0;
+
+	if ( c >= 48 && c <= 57)
+		ret = c-48;
+	else if (c >= 65 && c <= 70)
+		ret = c-55;
+	else if (c >= 97 && c <= 102)
+		ret = c-87;
+
+	return ret;
+}