1 files changed, 68 insertions, 0 deletions
diff --git a/client/rl.cpp b/client/rl.cpp
new file mode 100644
index 0000000..32a4df0
--- /dev/null
+++ b/client/rl.cpp
@@ -0,0 +1,68 @@
+#include <stdlib.h>
+#include <stdio.h>
+#include <stdbool.h>
+#include <stdarg.h>
+
+#include <readline/readline.h>
+#include <readline/history.h>
+
+#include "rl.h"
+#include "sock.h"
+
+void rl_printf(const char *fmt, ...) {
+	// save line
+	char* saved_line = rl_copy_text(0, rl_end);
+	int saved_point = rl_point;
+	int saved_end = rl_end;
+	
+	// clear line
+	rl_save_prompt();
+	rl_replace_line("", 0);
+	rl_redisplay();
+
+	// printf
+	va_list args;
+	va_start(args, fmt);
+	vprintf(fmt, args);
+	va_end(args);
+
+	// restore line
+	rl_restore_prompt();
+	rl_replace_line(saved_line, 0);
+	rl_point = saved_point;
+	rl_end = saved_end;
+	rl_redisplay();
+
+	free(saved_line);
+}
+
+void cmd_test() {
+	const char* data = "Hello world!";
+	i2c_send(0x39, (char*) data, strlen(data));
+}
+
+int cli_main() {
+	char* input = NULL;
+	while (1) {
+		if (input != NULL) free(input);
+		input = readline(CLI_PROMPT);
+
+		// exit on ^D or ^C (EOF)
+		if (input == NULL) return EXIT_SUCCESS;
+
+		// add non-empty line to history
+		if (*input) add_history(input);
+
+		if (strcmp(input, "exit") == 0) return EXIT_SUCCESS;
+
+		if (strcmp(input, "test") == 0) {
+			cmd_test();
+			continue;
+		}
+
+		printf("unknown command!\n");
+	}	
+
+	return EXIT_SUCCESS;
+}
+