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
|
/* -*- 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
};
#define u uart_regs
static char uart_mode = UART_MODE_ONLCR;
void
hal_uart_set_mode(int mode)
{
uart_mode = mode;
}
void
hal_uart_init(void)
{
hal_uart_set_mode(UART_MODE_ONLCR);
u->clkdiv = 217; // 230400 bps
}
void
hal_uart_putc(int ch)
{
if (ch == '\n')// && (uart_mode == UART_MODE_ONLCR)) //map \n->\r\n if necessary
hal_uart_putc('\r');
while (u->txlevel == 0) // wait for fifo to have space
;
u->txchar = ch;
}
void
hal_uart_putc_nowait(int ch)
{
if (ch == '\n')// && (uart_mode == UART_MODE_ONLCR)) //map \n->\r\n if necessary
hal_uart_putc('\r');
if(u->txlevel) // If fifo has space
u->txchar = ch;
}
int
hal_uart_getc(void)
{
while ((u->rxlevel) == 0) // wait for data to be ready
;
return u->rxchar;
}
|
