altos: Show temperature in stm-demo

[fw/altos] / src / stm-demo / ao_demo.c

diff --git a/src/stm-demo/ao_demo.c b/src/stm-demo/ao_demo.c
index 544f261fcbe7be64fbbfe05e055a6b592e2fee7d..ea4dadfa89d438513c1414308569367d525bb947 100644 (file)
--- a/src/stm-demo/ao_demo.c
+++ b/src/stm-demo/ao_demo.c
@@ -50,6 +50,93 @@ void _lseek() { }
 void _exit () { }
 void _read () { }
 void _fstat() { }
+
+#define AO_DMA_TEST_INDEX      STM_DMA_INDEX(4)
+
+static void
+ao_dma_test(void) {
+       static char     src[20] = "hello, world";
+       static char     dst[20];
+       
+       dst[0] = '\0';
+       ao_dma_set_transfer(AO_DMA_TEST_INDEX, 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(AO_DMA_TEST_INDEX);
+       ao_arch_critical(
+               while (!ao_dma_done[AO_DMA_TEST_INDEX])
+                       ao_sleep(&ao_dma_done[AO_DMA_TEST_INDEX]);
+               );
+       ao_dma_done_transfer(AO_DMA_TEST_INDEX);
+       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, 4, 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);
+               stm_gpio_set(&stm_gpioc, 12, 1);
+               ao_spi_put(0);
+               printf(".");
+               flush();
+               ao_delay(100);
+       }
+}
+
+
+
+static void
+ao_temp (void)
+{
+       struct ao_adc   adc;
+       int temp;
+
+       ao_adc_get(&adc);
+
+       /*
+        * r = (110 - 25) / (ts_cal_hot - ts_cal_cold)
+        * 25 + (110 - 25) * (temp - ts_cal_cold) / (ts_cal_hot - ts_cal_cold)
+        */
+       temp = 25 + (110 - 25) * (adc.temp - stm_temp_cal.ts_cal_cold) / (stm_temp_cal.ts_cal_hot - stm_temp_cal.ts_cal_cold);
+       printf ("temp: %d\n", temp);
+}
+
+__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" },
+       { ao_temp, "t\0Show temp" },
+       { 0, NULL }
+};
+
 int
 main(void)
 {
@@ -57,10 +144,17 @@ main(void)
        
        ao_serial_init();
        ao_timer_init();
+       ao_dma_init();
        ao_cmd_init();
-       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_timer_set_adc_interval(100);
+
+       ao_adc_init();
+
+       ao_cmd_register(&ao_demo_cmds[0]);
        
        ao_start_scheduler();
        return 0;