aboutsummaryrefslogtreecommitdiff
path: root/src/lib/libkogata
diff options
context:
space:
mode:
Diffstat (limited to 'src/lib/libkogata')
-rw-r--r--src/lib/libkogata/Makefile2
-rw-r--r--src/lib/libkogata/draw.c317
2 files changed, 318 insertions, 1 deletions
diff --git a/src/lib/libkogata/Makefile b/src/lib/libkogata/Makefile
index 48c6bc2..a8df419 100644
--- a/src/lib/libkogata/Makefile
+++ b/src/lib/libkogata/Makefile
@@ -1,5 +1,5 @@
OBJ = start.o malloc.o debug.o syscall.o user_region.o \
- mainloop.o gip.o
+ mainloop.o gip.o draw.o
LIB = ../../common/libkogata/libkogata.lib ../../common/libalgo/libalgo.lib ../../common/libc/libc.lib
diff --git a/src/lib/libkogata/draw.c b/src/lib/libkogata/draw.c
new file mode 100644
index 0000000..22ad8ba
--- /dev/null
+++ b/src/lib/libkogata/draw.c
@@ -0,0 +1,317 @@
+#include <syscall.h>
+#include <malloc.h>
+#include <string.h>
+#include <printf.h>
+
+#include <proto/font_file.h>
+
+#include <user_region.h>
+
+#include <draw.h>
+
+fb_t *g_fb_from_file(fd_t file, fb_info_t *geom) {
+ fb_t *ret = (fb_t*)malloc(sizeof(fb_t));
+ if (ret == 0) return 0;
+
+ memcpy(&ret->geom, geom, sizeof(fb_info_t));
+ ret->fd = file;
+
+ ret->data = (uint8_t*)region_alloc(geom->height * geom->pitch, "Framebuffer");
+ if (ret->data == 0) goto error;
+
+ bool map_ok = mmap_file(file, 0, ret->data, geom->height * geom->pitch, MM_READ | MM_WRITE);
+ if (!map_ok) goto error;
+
+ return ret;
+
+error:
+ if (ret && ret->data) region_free(ret->data);
+ if (ret) free(ret);
+ return 0;
+}
+
+fb_t *g_fb_from_mem(uint8_t* data, fb_info_t *geom) {
+ fb_t *ret = (fb_t*)malloc(sizeof(fb_t));
+ if (ret == 0) return 0;
+
+ memcpy(&ret->geom, geom, sizeof(fb_info_t));
+ ret->fd = 0;
+ ret->data = data;
+
+ return ret;
+}
+
+void g_delete_fb(fb_t *fb) {
+ if (fb->fd != 0) {
+ munmap(fb->data);
+ region_free(fb->data);
+ }
+ free(fb);
+}
+
+// ---- Color management
+
+color_t g_color_rgb(fb_t *f, uint8_t r, uint8_t g, uint8_t b) {
+ int m = f->geom.memory_model;
+ if (m == FB_MM_RGB24 || m == FB_MM_RGB32) return (r << 16) | (g << 8) | b;
+ if (m == FB_MM_BGR24 || m == FB_MM_BGR32) return (b << 16) | (g << 8) | r;
+ if (m == FB_MM_GREY8) return ((r + g + b) / 3) & 0xFF;
+ if (m == FB_MM_RGB16 || m == FB_MM_RGB15) return ((r >> 3) << 10) | ((g >> 3) << 5) | (b >> 3);
+ if (m == FB_MM_BGR16 || m == FB_MM_BGR15) return ((b >> 3) << 10) | ((g >> 3) << 5) | (r >> 3);
+ return 0; // unknown?
+}
+
+// ---- Plot
+
+inline void g_plot24(uint8_t* p, color_t c) {
+ p[0] = c & 0xFF;
+ p[1] = (c >> 8) & 0xFF;
+ p[2] = (c >> 16) & 0xFF;
+}
+
+void g_plot(fb_t *fb, int x, int y, color_t c) {
+ if (fb->geom.bpp == 8) {
+ fb->data[y * fb->geom.pitch + x] = (c & 0xFF);
+ } else if (fb->geom.bpp == 15 || fb->geom.bpp == 16) {
+ uint16_t *p = (uint16_t*)(fb->data + y * fb->geom.pitch + 2 * x);
+ *p = (c & 0xFFFF);
+ } else if (fb->geom.bpp == 24) {
+ g_plot24(fb->data + y * fb->geom.pitch + 3 * x, c);
+ } else if (fb->geom.bpp == 32) {
+ uint32_t *p = (uint32_t*)(fb->data + y * fb->geom.pitch + 4 * x);
+ *p = c;
+ }
+}
+
+void g_hline(fb_t *fb, int x, int y, int w, color_t c) {
+ if (fb->geom.bpp == 8) {
+ for (int u = x; u < x + w; u++) {
+ fb->data[y * fb->geom.pitch + u] = (c & 0xFF);
+ }
+ } else if (fb->geom.bpp == 15 || fb->geom.bpp == 15) {
+ for (int u = x; u < x + w; u++) {
+ uint16_t *p = (uint16_t*)(fb->data + y * fb->geom.pitch + 2 * u);
+ *p = (c & 0xFFFF);
+ }
+ } else if (fb->geom.bpp == 24) {
+ for (int u = x; u < x + w; u++) {
+ g_plot24(fb->data + y * fb->geom.pitch + 3 * u, c);
+ }
+ } else if (fb->geom.bpp == 32) {
+ for (int u = x; u < x + w; u++) {
+ uint32_t *p = (uint32_t*)(fb->data + y * fb->geom.pitch + 4 * u);
+ *p = c;
+ }
+ }
+}
+
+void g_vline(fb_t *fb, int x, int y, int h, color_t c) {
+ if (fb->geom.bpp == 8) {
+ for (int v = y; v < y + h; v++) {
+ fb->data[v * fb->geom.pitch + x] = (c & 0xFF);
+ }
+ } else if (fb->geom.bpp == 15 || fb->geom.bpp == 15) {
+ for (int v = y; v < y + h; v++) {
+ uint16_t *p = (uint16_t*)(fb->data + v * fb->geom.pitch + 2 * x);
+ *p = (c & 0xFFFF);
+ }
+ } else if (fb->geom.bpp == 24) {
+ for (int v = y; v < y + h; v++) {
+ g_plot24(fb->data + v * fb->geom.pitch + 3 * x, c);
+ }
+ } else if (fb->geom.bpp == 32) {
+ for (int v = y; v < y + h; v++) {
+ uint32_t *p = (uint32_t*)(fb->data + v * fb->geom.pitch + 4 * x);
+ *p = c;
+ }
+ }
+}
+
+void g_line(fb_t *fb, int x1, int y1, int x2, int y2, color_t c) {
+ // TODO
+}
+
+void g_rect(fb_t *fb, int x, int y, int w, int h, color_t c) {
+ g_hline(fb, x, y, w, c);
+ g_hline(fb, x, y+h-1, w, c);
+ g_vline(fb, x, y, h, c);
+ g_vline(fb, x+w-1, y, h, c);
+}
+
+void g_fillrect(fb_t *fb, int x, int y, int w, int h, color_t c) {
+ if (fb->geom.bpp == 8) {
+ for (int v = y; v < y + h; v++) {
+ for (int u = x; u < x + w; u++) {
+ fb->data[v * fb->geom.pitch + u] = (c & 0xFF);
+ }
+ }
+ } else if (fb->geom.bpp == 15 || fb->geom.bpp == 15) {
+ for (int v = y; v < y + h; v++) {
+ for (int u = x; u < x + w; u++) {
+ uint16_t *p = (uint16_t*)(fb->data + v * fb->geom.pitch + 2 * u);
+ *p = (c & 0xFFFF);
+ }
+ }
+ } else if (fb->geom.bpp == 24) {
+ for (int v = y; v < y + h; v++) {
+ for (int u = x; u < x + w; u++) {
+ g_plot24(fb->data + v * fb->geom.pitch + 3 * u, c);
+ }
+ }
+ } else if (fb->geom.bpp == 32) {
+ for (int v = y; v < y + h; v++) {
+ for (int u = x; u < x + w; u++) {
+ uint32_t *p = (uint32_t*)(fb->data + v * fb->geom.pitch + 4 * u);
+ *p = c;
+ }
+ }
+ }
+}
+
+void g_rect_r(fb_t *fb, fb_region_t reg, color_t c) {
+ g_rect(fb, reg.x, reg.y, reg.w, reg.h, c);
+}
+
+void g_fillrect_r(fb_t *fb, fb_region_t reg, color_t c) {
+ g_fillrect(fb, reg.x, reg.y, reg.w, reg.h, c);
+}
+
+void g_circle(fb_t *fb, int cx, int cy, int r, color_t c) {
+ // TODO
+}
+
+void g_fillcircle(fb_t *fb, int cx, int cy, int r, color_t c) {
+ // TODO
+}
+
+void g_blit(fb_t *dst, int x, int y, fb_t *src) {
+ fb_region_t r;
+
+ r.x = 0;
+ r.y = 0;
+ r.w = src->geom.width;
+ r.h = src->geom.height;
+
+ g_blit_region(dst, x, y, src, r);
+}
+
+void g_blit_region(fb_t *dst, int x, int y, fb_t *src, fb_region_t reg) {
+ if (src->geom.memory_model == dst->geom.memory_model) {
+ for (uint32_t i = 0; i < reg.h; i++) {
+ memcpy(
+ dst->data + (y + i) * dst->geom.pitch + x * (dst->geom.bpp / 8),
+ src->data + (reg.y + i) * src->geom.pitch + reg.x * (src->geom.bpp / 8),
+ reg.w * (src->geom.bpp / 8));
+ }
+ } else {
+ dbg_printf("Unsupported blit between different memory models.\n");
+ }
+}
+
+// ---- Text manipulation
+
+#define FONT_ASCII_BITMAP 1
+// more font types to come
+
+typedef struct font {
+ int type;
+ union {
+ struct {
+ uint8_t* data;
+ uint8_t cw, ch; // width, height of a character
+ uint32_t nchars;
+ } ascii_bitmap;
+ };
+} font_t;
+
+font_t *g_load_ascii_bitmap_font(fd_t f) {
+ font_t *font = 0;
+
+ ascii_bitmap_font_header h;
+
+ size_t s = read(f, 0, sizeof(h), (char*)&h);
+ if (s != sizeof(h)) goto error;
+
+ if (h.magic != ASCII_BITMAP_FONT_MAGIC) goto error;
+ if (h.cw != 8) goto error;
+
+ font = malloc(sizeof(font_t));
+ if (font == 0) goto error;
+ memset(font, 0, sizeof(font_t));
+
+
+ font->type = FONT_ASCII_BITMAP;
+ font->ascii_bitmap.cw = h.cw;
+ font->ascii_bitmap.ch = h.ch;
+ font->ascii_bitmap.nchars = h.nchars;
+
+
+ font->ascii_bitmap.data = (uint8_t*)malloc(h.ch * h.nchars);
+ if (font->ascii_bitmap.data == 0) goto error;
+
+ size_t rd = read(f, sizeof(h), h.ch * h.nchars, (char*)font->ascii_bitmap.data);
+ if (rd != h.ch * h.nchars) goto error;
+
+ return font;
+
+error:
+ if (font && font->ascii_bitmap.data) free(font->ascii_bitmap.data);
+ if (font) free(font);
+ close(f);
+ return 0;
+}
+
+font_t *g_load_font(const char* fontname) {
+ char buf[128];
+
+ snprintf(buf, 128, "sys:/fonts/%s.bf", fontname);
+ fd_t f = open(buf, FM_READ);
+ if (f != 0) return g_load_ascii_bitmap_font(f);
+
+ return 0;
+}
+
+void g_free_font(font_t *f) {
+ if (f->type == FONT_ASCII_BITMAP) {
+ free(f->ascii_bitmap.data);
+ }
+
+ free(f);
+}
+
+int g_text_width(font_t *font, const char* text) {
+ if (font->type == FONT_ASCII_BITMAP) {
+ return font->ascii_bitmap.cw * strlen(text);
+ }
+ return 0;
+}
+
+int g_text_height(font_t *font, const char* text) {
+ if (font->type == FONT_ASCII_BITMAP) {
+ return font->ascii_bitmap.ch;
+ }
+ return 0;
+}
+
+void g_write(fb_t *fb, int x, int y, const char* text, font_t *font, color_t c) {
+ if (font->type == FONT_ASCII_BITMAP) {
+ while (*text != 0) {
+ uint8_t id = (uint8_t)*text;
+ if (id < font->ascii_bitmap.nchars) {
+ uint8_t *d = font->ascii_bitmap.data + (id * font->ascii_bitmap.ch);
+ for (int r = 0; r < font->ascii_bitmap.ch; r++) {
+ for (int j = 0; j < 8; j++) {
+ if (d[r] & (0x80 >> j)) {
+ g_plot(fb, x + j, y + r, c);
+ }
+ }
+ }
+ }
+ text++;
+ x += font->ascii_bitmap.cw;
+ }
+ }
+}
+
+
+/* vim: set ts=4 sw=4 tw=0 noet :*/