X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=src%2Fstm-demo%2Fao_demo.c;h=54f7c8f2efb72f46dd5cb93a9bbc1327c791c7a8;hp=a672964b885bca831e6f16a86fd5054984fc60ca;hb=9b12bc445fe482306e4587ad60c6d2daf65a60f3;hpb=d236a5c7cd6e9b1d7192e801d63b4bd348cc2f12

diff --git a/src/stm-demo/ao_demo.c b/src/stm-demo/ao_demo.c
index a672964b..54f7c8f2 100644
--- a/src/stm-demo/ao_demo.c
+++ b/src/stm-demo/ao_demo.c
@@ -19,16 +19,27 @@
 
 struct ao_task demo_task;
 
+static inline int min(int a, int b) { return a < b ? a : b; }
+
 void
 ao_demo(void)
 {
+	char	message[] = "Hello, Mike & Bdale --- ";
+	char	part[7];
+	int	i = 0;
+	int	len = sizeof(message) - 1;
+	int	first, second;
+
+	part[6] = '\0';
 	for (;;) {
-		ao_led_on(AO_LED_BLUE);
-		ao_delay(AO_MS_TO_TICKS(500));
-		ao_led_off(AO_LED_BLUE);
-		ao_led_on(AO_LED_GREEN);
-		ao_delay(AO_MS_TO_TICKS(500));
-		ao_led_off(AO_LED_GREEN);
+		ao_delay(AO_MS_TO_TICKS(150));
+		first = min(6, len - i);
+		second = 6 - first;
+		memcpy(part, message + i, first);
+		memcpy(part + first, message, second);
+		ao_lcd_font_string(part);
+		if (++i >= len)
+			i = 0;
 	}
 }
 
@@ -39,6 +50,71 @@ void _lseek() { }
 void _exit () { }
 void _read () { }
 void _fstat() { }
+
+static void
+ao_dma_test(void) {
+	static char	src[20] = "hello, world";
+	static char	dst[20];
+	
+	dst[0] = '\0';
+	ao_dma_set_transfer(STM_DMA_INDEX(1), dst, src, 13,
+			    (1 << STM_DMA_CCR_MEM2MEM) |
+			    (STM_DMA_CCR_PL_LOW << STM_DMA_CCR_PL) |
+			    (STM_DMA_CCR_MSIZE_8 << STM_DMA_CCR_MSIZE) |
+			    (STM_DMA_CCR_PSIZE_8 << STM_DMA_CCR_PSIZE) |
+			    (1 << STM_DMA_CCR_MINC) |
+			    (1 << STM_DMA_CCR_PINC) |
+			    (0 << STM_DMA_CCR_CIRC) |
+			    (STM_DMA_CCR_DIR_MEM_TO_PER << STM_DMA_CCR_DIR));
+	ao_dma_start(STM_DMA_INDEX(1));
+	cli();
+	while (!ao_dma_done[STM_DMA_INDEX(1)])
+		ao_sleep(&ao_dma_done[STM_DMA_INDEX(1)]);
+	sei();
+	printf ("copied %s\n", dst);
+}
+
+static void
+ao_spi_write(void) {
+	unsigned char	data[] = { 0x55, 0xaa, 0xff, 0x00 };
+	int i;
+
+	for (i = 0; i < 10; i++) {
+		ao_spi_get(0);
+		stm_gpio_set(&stm_gpioc, 12, 0);
+		ao_spi_send(data, 1, 0);
+		stm_gpio_set(&stm_gpioc, 12, 1);
+		ao_spi_put(0);
+		printf(".");
+		flush();
+		ao_delay(100);
+	}
+}
+
+static void
+ao_spi_read(void) {
+	unsigned char	data[4];
+	int i;
+
+	for (i = 0; i < 10; i++) {
+		ao_spi_get(0);
+		stm_gpio_set(&stm_gpioc, 12, 0);
+		ao_spi_recv(data, 4, 0);
+		printf(".");
+		flush();
+		stm_gpio_set(&stm_gpioc, 12, 1);
+		ao_spi_put(0);
+		ao_delay(100);
+	}
+}
+
+__code struct ao_cmds ao_demo_cmds[] = {
+	{ ao_dma_test,	"D\0DMA test" },
+	{ ao_spi_write, "W\0SPI write" },
+	{ ao_spi_read, "R\0SPI read" },
+	{ 0, NULL }
+};
+
 int
 main(void)
 {
@@ -46,12 +122,19 @@ main(void)
 	
 	ao_serial_init();
 	ao_timer_init();
+	ao_dma_init();
 	ao_cmd_init();
-//	ao_led_init(LEDS_AVAILABLE);
-	ao_lcd_stm_init();
-	ao_lcd_font_init();
-//	ao_add_task(&demo_task, ao_demo, "demo");
+//	ao_lcd_stm_init();
+//	ao_lcd_font_init();
+	ao_spi_init();
+
+	ao_cmd_register(&ao_demo_cmds[0]);
 	
+	stm_rcc.ahbenr |= (1 << STM_RCC_AHBENR_GPIOCEN);
+	stm_gpio_set(&stm_gpioc, 12, 1);
+	stm_moder_set(&stm_gpioc, 12, STM_MODER_OUTPUT);
+	stm_otyper_set(&stm_gpioc, 12, STM_OTYPER_PUSH_PULL);
+
 	ao_start_scheduler();
 	return 0;
 }