hostsim enhancements
[aversive.git] / modules / comm / uart / uart.c
1 /*  
2  *  Copyright Droids Corporation, Microb Technology, Eirbot (2005)
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; either version 2 of the License, or
7  *  (at your option) any later version.
8  *
9  *  This program is distributed in the hope that it will be useful,
10  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
11  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
12  *  GNU General Public License for more details.
13  *
14  *  You should have received a copy of the GNU General Public License
15  *  along with this program; if not, write to the Free Software
16  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
17  *
18  *  Revision : $Id: uart.c,v 1.33.4.7 2009-01-23 23:08:42 zer0 Exp $
19  *
20  */
21
22 /* Olivier MATZ, Droids-corp 2004 - 2009 */
23
24 #include <aversive.h>
25 #include <aversive/list.h>
26
27 #include <uart.h>
28 #include <uart_defs.h>
29 #include <uart_private.h>
30
31 struct cirbuf g_tx_fifo[UART_HW_NUM];
32 struct cirbuf g_rx_fifo[UART_HW_NUM];
33
34 /* global vars are initialized to 0 (NULL) */
35 event *rx_event[UART_HW_NUM];
36 event *tx_event[UART_HW_NUM];
37
38 const struct regs uart_regs[UART_HW_NUM] = {
39 #ifdef UDR0
40         {
41                 .udr = &UDR0,
42                 .ucsra = &UCSR0A,
43                 .ucsrb = &UCSR0B,
44                 .ucsrc = &UCSR0C,
45                 .ubrrl = &UBRR0L,
46                 .ubrrh = &UBRR0H,
47         },
48 #endif
49 #ifdef UDR1
50         {
51                 .udr = &UDR1,
52                 .ucsra = &UCSR1A,
53                 .ucsrb = &UCSR1B,
54                 .ucsrc = &UCSR1C,
55                 .ubrrl = &UBRR1L,
56                 .ubrrh = &UBRR1H,
57         },
58 #endif
59 #ifdef UDR2
60         {
61                 .udr = &UDR2,
62                 .ucsra = &UCSR2A,
63                 .ucsrb = &UCSR2B,
64                 .ucsrc = &UCSR2C,
65                 .ubrrl = &UBRR2L,
66                 .ubrrh = &UBRR2H,
67         },
68 #endif
69 #ifdef UDR3
70         {
71                 .udr = &UDR3,
72                 .ucsra = &UCSR3A,
73                 .ucsrb = &UCSR3B,
74                 .ucsrc = &UCSR3C,
75                 .ubrrl = &UBRR3L,
76                 .ubrrh = &UBRR3H,
77         },
78 #endif
79 };
80
81 /**
82  * This is the interruption function which occurs when the entire
83  * frame in the transmit shift register has been shifted out and 
84  * there is no new data in the transmit buffer.
85  */
86 #ifdef UART0_COMPILE
87 #ifndef SIG_UART0_DATA
88 #define SIG_UART0_DATA SIG_USART0_DATA
89 #endif
90 SIGNAL(SIG_UART0_DATA)
91 {
92         uart_send_next_char(0);
93 }
94 #endif
95 #ifdef UART1_COMPILE
96 #ifndef SIG_UART1_DATA
97 #define SIG_UART1_DATA SIG_USART1_DATA
98 #endif
99 SIGNAL(SIG_UART1_DATA)
100 {
101         uart_send_next_char(1);
102 }
103 #endif
104 #ifdef UART2_COMPILE
105 #ifndef SIG_UART2_DATA
106 #define SIG_UART2_DATA SIG_USART2_DATA
107 #endif
108 SIGNAL(SIG_UART2_DATA)
109 {
110         uart_send_next_char(2);
111 }
112 #endif
113 #ifdef UART3_COMPILE
114 #ifndef SIG_UART3_DATA
115 #define SIG_UART3_DATA SIG_USART3_DATA
116 #endif
117 SIGNAL(SIG_UART3_DATA)
118 {
119         uart_send_next_char(3);
120 }
121 #endif
122
123 static void uart_recv_next_char(uint8_t num);
124
125 /**
126  * This is the interruption function which occurs when there is
127  * a new unread data in the reception buffer.
128  */
129 #ifdef UART0_COMPILE
130 #ifndef SIG_UART0_RECV
131 #define SIG_UART0_RECV SIG_USART0_RECV
132 #endif
133 SIGNAL(SIG_UART0_RECV)
134 {
135         uart_recv_next_char(0);
136 }
137 #endif
138 #ifdef UART1_COMPILE
139 #ifndef SIG_UART1_RECV
140 #define SIG_UART1_RECV SIG_USART1_RECV
141 #endif
142 SIGNAL(SIG_UART1_RECV)
143 {
144         uart_recv_next_char(1);
145 }
146 #endif
147 #ifdef UART2_COMPILE
148 #ifndef SIG_UART2_RECV
149 #define SIG_UART2_RECV SIG_USART2_RECV
150 #endif
151 SIGNAL(SIG_UART2_RECV)
152 {
153         uart_recv_next_char(2);
154 }
155 #endif
156 #ifdef UART3_COMPILE
157 #ifndef SIG_UART3_RECV
158 #define SIG_UART3_RECV SIG_USART3_RECV
159 #endif
160 SIGNAL(SIG_UART3_RECV)
161 {
162         uart_recv_next_char(3);
163 }
164 #endif
165
166
167 /** 
168  * transmit next character of fifo if any, and call the event function.
169  * This function is executed with intr locked.
170  */
171 void uart_send_next_char(uint8_t num)
172 {
173 #ifdef CONFIG_MODULE_UART_9BITS
174         if (uart_getconf_nbits(num) == 9) {
175                 int elt = 0;
176
177                 /* for 9 bits, it uses 2 places in the fifo */
178                 if (CIRBUF_GET_LEN(&g_tx_fifo[num]) < 2) {
179                         cbi(*uart_regs[num].ucsrb, UDRIE);
180                         return;
181                 }
182
183                 cirbuf_get_buf_tail(&g_tx_fifo[num], (char *)&elt, 2);
184                 cirbuf_del_buf_tail(&g_tx_fifo[num], 2);
185
186                 uart_set_udr_9bits(num, elt);
187                 sbi(*uart_regs[num].ucsrb, UDRIE);
188         }
189         else /* 5, 6, 7 or 8 bits */
190 #endif /* CONFIG_MODULE_UART_9BITS */
191         { 
192                 char elt = 0;
193
194                 if (CIRBUF_IS_EMPTY(&g_tx_fifo[num])) {
195                         cbi(*uart_regs[num].ucsrb, UDRIE);
196                         return;
197                 }
198
199                 elt = cirbuf_get_tail(&g_tx_fifo[num]);
200                 cirbuf_del_tail(&g_tx_fifo[num]);
201                 uart_set_udr(num, elt);
202                 sbi(*uart_regs[num].ucsrb, UDRIE);
203         }
204 }
205
206 /**
207  * UART RX Interrupt
208  */
209 static void uart_recv_next_char(uint8_t num)
210 {
211 #ifdef CONFIG_MODULE_UART_9BITS
212         if (uart_getconf_nbits() == 9) {
213                 int elt = 0;
214
215                 elt = uart_get_udr_9bits(num);
216                 if (CIRBUF_GET_FREELEN(&g_rx_fifo[num]) >= 2) {
217                         cirbuf_add_buf_head(&g_rx_fifo[num], (char *)&elt, 2);
218                 }
219
220                 if (rx_event[num])
221                         ((event_9bits *)rx_event[num])(elt);
222         }
223         else 
224 #endif /* CONFIG_MODULE_UART_9BITS */
225         {
226                 char elt = 0;
227
228                 elt = uart_get_udr(num);
229                 if (!CIRBUF_IS_FULL(&g_rx_fifo[num])) {
230                         cirbuf_add_head(&g_rx_fifo[num], elt);
231                 }
232
233                 if (rx_event[num])
234                         rx_event[num](elt);
235         }
236 }
237
238 /* init all uarts */
239 void uart_init(void)
240 {
241 #if (defined UDR0) && (defined UART0_COMPILE)
242         uart_setconf(0, NULL);
243 #endif
244
245 #if (defined UDR1) && (defined UART1_COMPILE)
246         uart_setconf(1, NULL);
247 #endif
248
249 #if (defined UDR2) && (defined UART2_COMPILE)
250         uart_setconf(2, NULL);
251 #endif
252
253 #if (defined UDR3) && (defined UART3_COMPILE)
254         uart_setconf(3, NULL);
255 #endif
256 }