X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=src%2Fcortexelf-v1%2Fao_cortexelf.c;h=1c30cd85dda20a768642261c9a2d826c186ba07f;hp=01c5165bd94d19b44551e7de44f1166ba87ad5ee;hb=2f87e182d9f0b3c2856f62149371ad70b16148cf;hpb=66b06332dadd83c309bbfe02240b7a071fd57ff2

diff --git a/src/cortexelf-v1/ao_cortexelf.c b/src/cortexelf-v1/ao_cortexelf.c
index 01c5165b..1c30cd85 100644
--- a/src/cortexelf-v1/ao_cortexelf.c
+++ b/src/cortexelf-v1/ao_cortexelf.c
@@ -22,6 +22,224 @@
 #if HAS_STACK_GUARD
 #include <ao_mpu.h>
 #endif
+#include <ao_ps2.h>
+#include <ao_vga.h>
+#include <ao_console.h>
+#include <ao_sdcard.h>
+#include <ao_fat.h>
+#include <ao_scheme.h>
+#include <ao_button.h>
+#include <ao_event.h>
+#include <ao_as1107.h>
+#include <ao_hex.h>
+#include <ao_1802.h>
+
+struct ao_task ball_task;
+
+#define BALL_WIDTH	5
+#define BALL_HEIGHT	5
+
+static int	ball_x;
+static int	ball_y;
+static int	ball_dx, ball_dy;
+
+uint8_t		ball_enable;
+
+void
+ao_ball(void)
+{
+	ball_dx = 1;
+	ball_dy = 1;
+	ball_x = 0;
+	ball_y = 0;
+	for (;;) {
+		while (!ball_enable)
+			ao_sleep(&ball_enable);
+		for (;;) {
+			ao_line(&ao_vga_bitmap,
+				-100, -100, ball_x*2, ball_y*2,
+				1, AO_XOR);
+			ao_text(&ao_vga_bitmap,
+				ball_x, ball_y - 10,
+				"Hello, Bdale!",
+				1, AO_XOR);
+			ao_rect(&ao_vga_bitmap,
+				ball_x, ball_y,
+				BALL_WIDTH,
+				BALL_HEIGHT,
+				1,
+				AO_XOR);
+			ao_delay(AO_MS_TO_TICKS(10));
+			ao_rect(&ao_vga_bitmap,
+				ball_x, ball_y,
+				BALL_WIDTH,
+				BALL_HEIGHT,
+				1,
+				AO_XOR);
+			ao_text(&ao_vga_bitmap,
+				ball_x, ball_y - 10,
+				"Hello, Bdale!",
+				1, AO_XOR);
+			ao_line(&ao_vga_bitmap,
+				-100, -100, ball_x*2, ball_y*2,
+				1, AO_XOR);
+			if (!ball_enable)
+				break;
+			ball_x += ball_dx;
+			ball_y += ball_dy;
+			if (ball_x + BALL_WIDTH > AO_VGA_WIDTH) {
+				ball_x = AO_VGA_WIDTH - BALL_WIDTH;
+				ball_dx = -ball_dx;
+			}
+			if (ball_x < 0) {
+				ball_x = -ball_x;
+				ball_dx = -ball_dx;
+			}
+			if (ball_y + BALL_HEIGHT > AO_VGA_HEIGHT) {
+				ball_y = AO_VGA_HEIGHT - BALL_HEIGHT;
+				ball_dy = -ball_dy;
+			}
+			if (ball_y < 0) {
+				ball_y = -ball_y;
+				ball_dy = -ball_dy;
+			}
+		}
+	}
+}
+
+static void
+ao_fb_init(void)
+{
+	ao_rect(&ao_vga_bitmap,
+		0, 0, AO_VGA_WIDTH, AO_VGA_HEIGHT,
+		1, AO_COPY);
+
+	ao_rect(&ao_vga_bitmap,
+		10, 10, 10, 10,
+		0, AO_COPY);
+
+	ao_rect(&ao_vga_bitmap,
+		AO_VGA_WIDTH - 20, 10, 10, 10,
+		0, AO_COPY);
+
+	ao_rect(&ao_vga_bitmap,
+		10, AO_VGA_HEIGHT - 20, 10, 10,
+		0, AO_COPY);
+
+	ao_rect(&ao_vga_bitmap,
+		AO_VGA_WIDTH - 20, AO_VGA_HEIGHT - 20, 10, 10,
+		0, AO_COPY);
+
+	ao_text(&ao_vga_bitmap,
+		20, 100,
+		"Hello, Bdale!",
+		0, AO_COPY);
+
+	ao_text(&ao_vga_bitmap,
+		1, ao_font.ascent,
+		"UL",
+		0, AO_COPY);
+
+	ao_text(&ao_vga_bitmap,
+		1, AO_VGA_HEIGHT - ao_font.descent,
+		"BL",
+		0, AO_COPY);
+}
+
+static void
+ao_video_toggle(void)
+{
+	uint16_t r = ao_cmd_decimal();
+	if (r)
+		ao_fb_init();
+	ao_vga_enable(r)
+}
+
+static void
+ao_ball_toggle(void)
+{
+	ball_enable = ao_cmd_decimal();
+	ao_wakeup(&ball_enable);
+}
+
+static void
+ao_ps2_read_keys(void)
+{
+	char	c;
+
+	for (;;) {
+		c = ao_ps2_getchar();
+		printf("%02x %c\n", c, ' ' <= c && c < 0x7f ? c : '.');
+		flush();
+		if (c == ' ')
+			break;
+	}
+}
+
+static void
+ao_console_send(void)
+{
+	char	c;
+
+	while ((c = getchar()) != '~') {
+		ao_console_putchar(c);
+		flush();
+	}
+}
+
+static void scheme_cmd() {
+	ao_scheme_read_eval_print();
+}
+
+static void
+ao_serial_blather(void)
+{
+	char c;
+
+	while ((c = getchar()) != '~') {
+		ao_serial1_putchar(c);
+		ao_serial2_putchar(c);
+	}
+}
+
+static void
+led_cmd(void)
+{
+	uint8_t	start;
+	uint8_t value;
+
+	start = ao_cmd_decimal();
+	value = ao_cmd_hex();
+	if (ao_cmd_status != ao_cmd_success)
+		return;
+	ao_as1107_write_8(start, value);
+}
+
+const struct ao_cmds ao_demo_cmds[] = {
+	{ ao_video_toggle, "V\0Toggle video" },
+	{ ao_ball_toggle, "B\0Toggle ball" },
+	{ ao_ps2_read_keys, "K\0Read keys from keyboard" },
+	{ ao_console_send, "C\0Send data to console, end with ~" },
+	{ ao_serial_blather, "S\0Blather on serial ports briefly" },
+	{ scheme_cmd, "l\0Run scheme interpreter" },
+	{ led_cmd, "L start value\0Show value (byte) at digit start" },
+	{ 0, NULL }
+};
+
+static struct ao_task event_task;
+
+static void
+ao_event_loop(void)
+{
+	for (;;) {
+		struct ao_event	ev;
+
+		ao_event_get(&ev);
+		printf("type %d uint %d tick %d value %d\n",
+		       ev.type, ev.unit, ev.tick, ev.value);
+		flush();
+	}
+}
 
 int
 main(void)
@@ -40,12 +258,31 @@ main(void)
 	ao_dma_init();
 	ao_exti_init();
 
+	ao_sdcard_init();
+	ao_fat_init();
+
+	ao_ps2_init();
+	ao_vga_init();
+	ao_console_init();
+
 	ao_cmd_init();
 
 	ao_usb_init();
 
+	ao_button_init();
+
+	ao_as1107_init();
+	ao_matrix_init();
+	ao_1802_init();
+
+	ao_hex_init();
+
 	ao_config_init();
 
+	ao_add_task(&ball_task, ao_ball, "ball");
+	ao_add_task(&event_task, ao_event_loop, "events");
+	ao_cmd_register(&ao_demo_cmds[0]);
+
 	ao_start_scheduler();
 	return 0;
 }