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
|
#include <rtems.h>
#include <rtems/libio.h>
#include <rtems/bspIo.h>
#include <rtems/console.h>
#include <string.h>
ssize_t app_memory_write(int minor, const char* buf, size_t len)
__attribute__(( weak, alias("__bsp_memory_write") ));
ssize_t __bsp_memory_write(int minor, const char* buf, size_t len);
ssize_t __bsp_memory_write(int minor, const char* buf, size_t len)
{
const char* const last = buf+len;
while (buf < last)
{
rtems_putc(*buf++);
}
return len;
}
static rtems_termios_callbacks gMemCallbacks = {
0, /* firstOpen */
0, /* lastClose */
0, /* PollRead */
app_memory_write, /* write */
0, /* SetAttr */
0, /* stopRemoteTx */
0, /* startRemoteTx */
0 /* outputUsesInterrupts */
};
rtems_device_driver console_initialize(rtems_device_major_number major,
rtems_device_minor_number minor,
void* arg)
{
rtems_status_code status;
rtems_termios_initialize();
status = rtems_io_register_name("/dev/console", major, 0);
if (status != RTEMS_SUCCESSFUL) rtems_fatal_error_occurred (status);
return RTEMS_SUCCESSFUL;
}
rtems_device_driver console_open(rtems_device_major_number major,
rtems_device_minor_number minor,
void* arg)
{
rtems_status_code sc;
sc = rtems_termios_open (major, minor, arg, &gMemCallbacks);
return sc;
}
rtems_device_driver console_close(rtems_device_major_number major,
rtems_device_minor_number minor,
void* arg)
{
return rtems_termios_close(arg);
}
rtems_device_driver console_read(rtems_device_major_number major,
rtems_device_minor_number minor,
void* arg)
{
return rtems_termios_read(arg);
}
rtems_device_driver console_write(rtems_device_major_number major,
rtems_device_minor_number minor,
void* arg)
{
return rtems_termios_write(arg);
}
rtems_device_driver console_control(rtems_device_major_number major,
rtems_device_minor_number minor,
void* arg)
{
return rtems_termios_ioctl(arg);
}
|