altos: Add DMA, SPI and MS5607 drivers
[fw/altos] / src / stm-demo / ao_demo.c
1 /*
2  * Copyright © 2011 Keith Packard <keithp@keithp.com>
3  *
4  * This program is free software; you can redistribute it and/or modify
5  * it under the terms of the GNU General Public License as published by
6  * the Free Software Foundation; version 2 of the License.
7  *
8  * This program is distributed in the hope that it will be useful, but
9  * WITHOUT ANY WARRANTY; without even the implied warranty of
10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
11  * General Public License for more details.
12  *
13  * You should have received a copy of the GNU General Public License along
14  * with this program; if not, write to the Free Software Foundation, Inc.,
15  * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
16  */
17
18 #include "ao.h"
19
20 struct ao_task demo_task;
21
22 static inline int min(int a, int b) { return a < b ? a : b; }
23
24 void
25 ao_demo(void)
26 {
27         char    message[] = "Hello, Mike & Bdale --- ";
28         char    part[7];
29         int     i = 0;
30         int     len = sizeof(message) - 1;
31         int     first, second;
32
33         part[6] = '\0';
34         for (;;) {
35                 ao_delay(AO_MS_TO_TICKS(150));
36                 first = min(6, len - i);
37                 second = 6 - first;
38                 memcpy(part, message + i, first);
39                 memcpy(part + first, message, second);
40                 ao_lcd_font_string(part);
41                 if (++i >= len)
42                         i = 0;
43         }
44 }
45
46 void _close() { }
47 void _sbrk() { }
48 void _isatty() { }
49 void _lseek() { }
50 void _exit () { }
51 void _read () { }
52 void _fstat() { }
53
54 static void
55 ao_dma_test(void) {
56         static char     src[20] = "hello, world";
57         static char     dst[20];
58         
59         dst[0] = '\0';
60         ao_dma_set_transfer(STM_DMA_INDEX(1), dst, src, 13,
61                             (1 << STM_DMA_CCR_MEM2MEM) |
62                             (STM_DMA_CCR_PL_LOW << STM_DMA_CCR_PL) |
63                             (STM_DMA_CCR_MSIZE_8 << STM_DMA_CCR_MSIZE) |
64                             (STM_DMA_CCR_PSIZE_8 << STM_DMA_CCR_PSIZE) |
65                             (1 << STM_DMA_CCR_MINC) |
66                             (1 << STM_DMA_CCR_PINC) |
67                             (0 << STM_DMA_CCR_CIRC) |
68                             (STM_DMA_CCR_DIR_MEM_TO_PER << STM_DMA_CCR_DIR));
69         ao_dma_start(STM_DMA_INDEX(1));
70         cli();
71         while (!ao_dma_done[STM_DMA_INDEX(1)])
72                 ao_sleep(&ao_dma_done[STM_DMA_INDEX(1)]);
73         sei();
74         printf ("copied %s\n", dst);
75 }
76
77 static void
78 ao_spi_write(void) {
79         unsigned char   data[] = { 0x55, 0xaa, 0xff, 0x00 };
80         int i;
81
82         for (i = 0; i < 10; i++) {
83                 ao_spi_get(0);
84                 stm_gpio_set(&stm_gpioc, 12, 0);
85                 ao_spi_send(data, 1, 0);
86                 stm_gpio_set(&stm_gpioc, 12, 1);
87                 ao_spi_put(0);
88                 printf(".");
89                 flush();
90                 ao_delay(100);
91         }
92 }
93
94 static void
95 ao_spi_read(void) {
96         unsigned char   data[4];
97         int i;
98
99         for (i = 0; i < 10; i++) {
100                 ao_spi_get(0);
101                 stm_gpio_set(&stm_gpioc, 12, 0);
102                 ao_spi_recv(data, 4, 0);
103                 printf(".");
104                 flush();
105                 stm_gpio_set(&stm_gpioc, 12, 1);
106                 ao_spi_put(0);
107                 ao_delay(100);
108         }
109 }
110
111 __code struct ao_cmds ao_demo_cmds[] = {
112         { ao_dma_test,  "D\0DMA test" },
113         { ao_spi_write, "W\0SPI write" },
114         { ao_spi_read, "R\0SPI read" },
115         { 0, NULL }
116 };
117
118 int
119 main(void)
120 {
121         ao_clock_init();
122         
123         ao_serial_init();
124         ao_timer_init();
125         ao_dma_init();
126         ao_cmd_init();
127 //      ao_lcd_stm_init();
128 //      ao_lcd_font_init();
129         ao_spi_init();
130
131         ao_cmd_register(&ao_demo_cmds[0]);
132         
133         stm_rcc.ahbenr |= (1 << STM_RCC_AHBENR_GPIOCEN);
134         stm_gpio_set(&stm_gpioc, 12, 1);
135         stm_moder_set(&stm_gpioc, 12, STM_MODER_OUTPUT);
136         stm_otyper_set(&stm_gpioc, 12, STM_OTYPER_PUSH_PULL);
137
138         ao_start_scheduler();
139         return 0;
140 }