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
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
|
/*
* Copyright (c) 2013 embedded brains GmbH. All rights reserved.
*
* embedded brains GmbH
* Dornierstr. 4
* 82178 Puchheim
* Germany
* <info@embedded-brains.de>
*
* The license and distribution terms for this file may be
* found in the file LICENSE in this distribution or at
* http://www.rtems.com/license/LICENSE.
*/
#include <assert.h>
#include <bsp/irq.h>
#include <bsp/arm-pl050.h>
#include <bsp/arm-pl050-regs.h>
#include <libchip/sersupp.h>
static volatile pl050 *pl050_get_regs(int minor)
{
const console_tbl *ct = Console_Port_Tbl[minor];
return (volatile pl050 *) ct->ulCtrlPort1;
}
static void pl050_interrupt(void *arg)
{
int minor = (int) arg;
const console_data *cd = &Console_Port_Data[minor];
volatile pl050 *regs = pl050_get_regs(minor);
uint32_t kmiir_rx = PL050_KMIIR_KMIRXINTR;
uint32_t kmiir_tx = (regs->kmicr & PL050_KMICR_KMITXINTREN) != 0 ?
PL050_KMIIR_KMITXINTR : 0;
uint32_t kmiir = regs->kmiir;
if ((kmiir & kmiir_rx) != 0) {
char c = (char) PL050_KMIDATA_KMIDATA_GET(regs->kmidata);
rtems_termios_enqueue_raw_characters(cd->termios_data, &c, 1);
}
if ((kmiir & kmiir_tx) != 0) {
rtems_termios_dequeue_characters(cd->termios_data, 1);
}
}
static void pl050_initialize(int minor)
{
/* Nothing to do */
}
static int pl050_first_open(int major, int minor, void *arg)
{
rtems_libio_open_close_args_t *oc = (rtems_libio_open_close_args_t *) arg;
struct rtems_termios_tty *tty = (struct rtems_termios_tty *) oc->iop->data1;
console_data *cd = &Console_Port_Data[minor];
const console_tbl *ct = Console_Port_Tbl[minor];
volatile pl050 *regs = pl050_get_regs(minor);
rtems_status_code sc;
cd->termios_data = tty;
rtems_termios_set_initial_baud(tty, (rtems_termios_baud_t) ct->pDeviceParams);
regs->kmicr = PL050_KMICR_KMIEN | PL050_KMICR_KMIRXINTREN;
sc = rtems_interrupt_handler_install(
ct->ulIntVector,
ct->sDeviceName,
RTEMS_INTERRUPT_UNIQUE,
pl050_interrupt,
(void *) minor
);
assert(sc == RTEMS_SUCCESSFUL);
return 0;
}
static int pl050_last_close(int major, int minor, void *arg)
{
const console_tbl *ct = Console_Port_Tbl[minor];
volatile pl050 *regs = pl050_get_regs(minor);
rtems_status_code sc;
regs->kmicr = 0;
sc = rtems_interrupt_handler_remove(
ct->ulIntVector,
pl050_interrupt,
(void *) minor
);
assert(sc == RTEMS_SUCCESSFUL);
return 0;
}
static ssize_t pl050_write_support(
int minor,
const char *s,
size_t n
)
{
volatile pl050 *regs = pl050_get_regs(minor);
if (n > 0) {
regs->kmidata = PL050_KMIDATA_KMIDATA(s[0]);
regs->kmicr |= PL050_KMICR_KMITXINTREN;
} else {
regs->kmicr &= ~PL050_KMICR_KMITXINTREN;
}
return 0;
}
static int pl050_set_attribues(int minor, const struct termios *term)
{
return -1;
}
const console_fns arm_pl050_fns = {
.deviceProbe = libchip_serial_default_probe,
.deviceFirstOpen = pl050_first_open,
.deviceLastClose = pl050_last_close,
.deviceRead = NULL,
.deviceWrite = pl050_write_support,
.deviceInitialize = pl050_initialize,
.deviceWritePolled = NULL,
.deviceSetAttributes = pl050_set_attribues,
.deviceOutputUsesInterrupts = true
};
|
