Create basic functions for BP4a

5 files changed, 30 insertions, 0 deletions

diff --git a/Kod/bilbana/yc4/display/clear_display.m b/Kod/bilbana/yc4/display/clear_display.m
new file mode 100644
index 0000000..32fdac1
--- /dev/null
+++ b/Kod/bilbana/yc4/display/clear_display.m
@@ -0,0 +1,3 @@
+function pkg = clear_display()
+	pkg = get_package('DL', [])
+end
diff --git a/Kod/bilbana/yc4/display/draw_single_line.m b/Kod/bilbana/yc4/display/draw_single_line.m
new file mode 100644
index 0000000..97cf1ae
--- /dev/null
+++ b/Kod/bilbana/yc4/display/draw_single_line.m
@@ -0,0 +1,5 @@
+function [pkg] = draw_line(x1, y1, x2, y2)
+	arg = [x1, 0, y1, 0, x2, 1, y2, 0]  % TODO nollor mellan värden? vad betyder ettan?
+
+	pkg = get_package('GD', arg)
+end
diff --git a/Kod/bilbana/yc4/display/get_package.m b/Kod/bilbana/yc4/display/get_package.m
new file mode 100644
index 0000000..7c3a01e
--- /dev/null
+++ b/Kod/bilbana/yc4/display/get_package.m
@@ -0,0 +1,10 @@
+function [pkg] = get_package(code, args)
+	DC1 = 17;
+	ESC = 27;
+
+	data = [ESC, double(code), args];
+	len = length(data);
+	initStr = [DC1, len, data];
+	bcc = mod(sum(initStr), 256);
+	pkg = [initStr, bcc];
+end
diff --git a/Kod/bilbana/yc4/display/put_text.m b/Kod/bilbana/yc4/display/put_text.m
new file mode 100644
index 0000000..95dbb26
--- /dev/null
+++ b/Kod/bilbana/yc4/display/put_text.m
@@ -0,0 +1,9 @@
+function [pkg] = put_text(x, y, justification, text)
+	code = double(join('Z', justification))
+
+	arg1 = [x, 0, y, 0]
+	arg2 = text;
+	arg3 = 0;
+
+	pkg = get_package(join('Z', justification), [arg1 arg2 arg3])
+end
diff --git a/Kod/bilbana/yc4/display/set_text_font.m b/Kod/bilbana/yc4/display/set_text_font.m
new file mode 100644
index 0000000..768d16b
--- /dev/null
+++ b/Kod/bilbana/yc4/display/set_text_font.m
@@ -0,0 +1,3 @@
+function pkg = set_text_font(font_num)
+	pkg = get_package('ZF', [font_num])
+end