1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
|
/* -*- c -*- */
/*
* Copyright 2007,2008 Free Software Foundation, Inc.
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program. If not, see <http://www.gnu.org/licenses/>.
*/
#include "hal_uart.h"
#include "hal_io.h"
#include "memory_map.h"
// First pass, no interrupts
// Replaced with divisors.py which generates best divisor
//#define CALC_DIVISOR(rate) (WISHBONE_CLK_RATE / ((rate) * 16))
#define NSPEEDS 6
#define MAX_WB_DIV 4
static const uint16_t
divisor_table[MAX_WB_DIV+1][NSPEEDS] = {
{ 2, 2, 2, 2, 2, 2}, // 0: can't happen
{ 651, 326, 163, 109, 54, 27 }, // 1: 100 MHz
{ 326, 163, 81, 54, 27, 14 }, // 2: 50 MHz
{ 217, 109, 54, 36, 18, 9 }, // 3: 33.3333 MHz
{ 163, 81, 41, 27, 14, 7 }, // 4: 25 MHz
};
//we wrap hal_uart_putc hal_uart_putc_nowait, and hal_uart_getc to accept a UART pointer given by hal_get_uart. we modify hal_io.c to use the new versions.
static char uart_mode[4] = {UART_MODE_ONLCR, UART_MODE_ONLCR, UART_MODE_ONLCR, UART_MODE_ONLCR};
void
hal_uart_set_mode(int uart, int mode)
{
uart_mode[uart] = mode;
}
void
hal_uart_init(void)
{
for(int i = 0; i < 4; i++) {
hal_uart_set_mode(i, UART_MODE_ONLCR);
u->clkdiv = 217; // 230400 bps TODO: change to reflect new quad UART
}
}
void
hal_uart_putc(uart_regs_t *u, int ch)
{
if (ch == '\n')// && (uart_mode[uart] == UART_MODE_ONLCR)) //map \n->\r\n if necessary
hal_uart_putc(u, '\r');
while (u->txlevel == 0) // wait for fifo to have space
;
u->txchar = ch;
}
void
hal_uart_putc_nowait(uart_regs_t *u, int ch)
{
if (ch == '\n')// && (uart_mode[uart] == UART_MODE_ONLCR)) //map \n->\r\n if necessary
hal_uart_putc(u, '\r');
if(u->txlevel) // If fifo has space
u->txchar = ch;
}
int
hal_uart_getc(uart_regs_t *u)
{
while ((u->rxlevel) == 0) // wait for data to be ready
;
return u->rxchar;
}
uart_regs_t *
hal_get_uart(int number)
{
switch(number) {
case 0:
return uart_regs_0;
break;
case 1:
return uart_regs_1;
break;
case 2:
return uart_regs_2;
break;
case 3:
return uart_regs_3;
break;
default:
return uart_regs_0; //for safety
}
|
