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
109
110
111
112
113
114
115
116
117
118
|
/*
* This file contains the TTY driver for the serial ports on the LEON.
*
* This driver uses the termios pseudo driver.
*
* COPYRIGHT (c) 1989-1999.
* On-Line Applications Research Corporation (OAR).
*
* Modified for LEON3 BSP.
* COPYRIGHT (c) 2011.
* Aeroflex Gaisler.
*
* The license and distribution terms for this file may be
* found in the file LICENSE in this distribution or at
* http://www.rtems.org/license/LICENSE.
*/
#include <bsp.h>
#include <leon.h>
#include <rtems/libio.h>
#include <rtems/sysinit.h>
#include <stdlib.h>
#include <assert.h>
#include <stdio.h>
#include <grlib/apbuart.h>
int leon3_debug_uart_index __attribute__((weak)) = 0;
struct apbuart_regs *leon3_debug_uart = NULL;
/* Before UART driver has registered (or when no UART is available), calls to
* printk that gets to bsp_out_char() will be filling data into the
* pre_printk_dbgbuf[] buffer, hopefully the buffer can help debugging the
* early BSP boot.. At least the last printk() will be caught.
*/
static char pre_printk_dbgbuf[32] = {0};
static int pre_printk_pos = 0;
/* Initialize the BSP system debug console layer. It will scan AMBA Plu&Play
* for a debug APBUART and enable RX/TX for that UART.
*/
static void bsp_debug_uart_init(void)
{
int i;
struct ambapp_dev *adev;
struct ambapp_apb_info *apb;
/* Update leon3_debug_uart_index to index used as debug console. Let user
* select Debug console by setting leon3_debug_uart_index. If the BSP is to
* provide the default UART (leon3_debug_uart_index==0):
* non-MP: APBUART[0] is debug console
* MP: LEON CPU index select UART
*/
if (leon3_debug_uart_index == 0) {
#if defined(RTEMS_MULTIPROCESSING)
leon3_debug_uart_index = LEON3_Cpu_Index;
#else
leon3_debug_uart_index = 0;
#endif
} else {
leon3_debug_uart_index--; /* User selected dbg-console */
}
/* Find APBUART core for System Debug Console */
i = leon3_debug_uart_index;
adev = (void *)ambapp_for_each(&ambapp_plb, (OPTIONS_ALL|OPTIONS_APB_SLVS),
VENDOR_GAISLER, GAISLER_APBUART,
ambapp_find_by_idx, (void *)&i);
if (adev) {
/* Found a matching debug console, initialize debug uart if present
* for printk
*/
apb = (struct ambapp_apb_info *)adev->devinfo;
leon3_debug_uart = (struct apbuart_regs *)apb->start;
leon3_debug_uart->ctrl |= APBUART_CTRL_RE | APBUART_CTRL_TE;
leon3_debug_uart->status = 0;
}
}
RTEMS_SYSINIT_ITEM(
bsp_debug_uart_init,
RTEMS_SYSINIT_BSP_START,
RTEMS_SYSINIT_ORDER_FOURTH
);
/* putchar/getchar for printk */
static void bsp_out_char(char c)
{
if (leon3_debug_uart == NULL) {
/* Local debug buffer when UART driver has not registered */
pre_printk_dbgbuf[pre_printk_pos++] = c;
pre_printk_pos = pre_printk_pos & (sizeof(pre_printk_dbgbuf)-1);
return;
}
apbuart_outbyte_polled(leon3_debug_uart, c, 1, 1);
}
/*
* To support printk
*/
#include <rtems/bspIo.h>
BSP_output_char_function_type BSP_output_char = bsp_out_char;
static int bsp_in_char(void)
{
int tmp;
if (leon3_debug_uart == NULL)
return EOF;
while ((tmp = apbuart_inbyte_nonblocking(leon3_debug_uart)) < 0)
;
return tmp;
}
BSP_polling_getchar_function_type BSP_poll_char = bsp_in_char;
|
