Initial commit

src/display.cpp

@@ -0,0 +1,67 @@
+/*
+ * display.cpp
+ *
+ *  Created on: Aug 21, 2022
+ *      Author: kosa
+ */
+
+#include <zephyr/drivers/display.h>
+
+#include "display.hpp"
+#include "printt.h"
+#include "font.h"
+
+int Display::Init()
+{
+	k_mutex_init(&mut);
+	dev = DEVICE_DT_GET(DT_CHOSEN(zephyr_display));
+	if (!device_is_ready(dev)) {
+		printt("Device %s not ready", dev->name);
+		return 1;
+	}
+
+	if (display_set_pixel_format(dev, PIXEL_FORMAT_MONO10) != 0) {
+		printt("Failed to set required pixel format");
+		return 1;
+	}
+	printt("Initialized %s", dev->name);
+	return 0;
+}
+
+void Display::blank_off()
+{
+	k_mutex_lock(&mut, K_FOREVER);
+	display_blanking_off(dev);
+	k_mutex_unlock(&mut);
+}
+
+void Display::print_chr(int x, int y, char c)
+{
+	int idx;
+	for(idx=0;my_font_map_[idx];idx++)
+	{
+		if(my_font_map_[idx] == c)
+			break;
+	}
+	if(!my_font_map_[idx])
+		idx=0;
+
+	struct display_buffer_descriptor desc={
+			.buf_size=16,
+			.width=8,
+			.height=16,
+			.pitch=8
+	};
+
+
+	k_mutex_lock(&mut, K_FOREVER);
+	display_write(dev,x,y,&desc,my_font_[idx]);
+	k_mutex_unlock(&mut);
+
+}
+
+void Display::print_str(int x, int y, const char* str)
+{
+
+}
+