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
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
|
/**
* @file console.c
*
* This file contains the GBA console I/O package.
*/
/*
* RTEMS GBA BSP
*
* Copyright (c) 2004 Markku Puro <markku.puro@kopteri.net>
*
* 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 <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <bsp.h>
#include <rtems/bspIo.h>
#include <rtems/libio.h>
#include <rtems/termiostypes.h>
#include <termios.h>
#include <bsp/irq.h>
#include <gba.h>
#include <conio.h>
/**
* @brief gba_pollRead function read char
*
* @param minor unused
* @return character code
*/
static int gba_pollRead(int minor)
{
return(gba_getch());
}
/**
* @brief gba_write function writes chars
*
* Input parameters: minor code, buffer pointer and lenght
* @param minor unused
* @param *buf buffer pointer
* @param len lenght of buffer
* @return character code
*
*/
static ssize_t gba_write(int minor, const char *buf, size_t len)
{
int i;
for (i=0;i<len;i++) {
gba_putch((unsigned short)buf[i]);
}
return len;
}
/**
* @brief gba_setAttributes function is empty
*
* @param minor unused
* @param *t unused
* @return constant 0
*/
static int gba_setAttributes(int minor, const struct termios *t)
{
return 0;
}
/** BSP_output_char for printk support */
BSP_output_char_function_type BSP_output_char = (BSP_output_char_function_type) gba_putch;
/** BSP_poll_char for printk support */
BSP_polling_getchar_function_type BSP_poll_char = gba_getch;
/**
* @brief Console device driver INITIALIZE entry point
*
* Initilizes the I/O console driver.
*
* @param major diver major number
* @param minor driver minor mumber
* @param *arg pointer to parameters
* @return status code
*/
rtems_device_driver
console_initialize(rtems_device_major_number major,
rtems_device_minor_number minor,
void *arg)
{
rtems_status_code status;
/* Set up TERMIOS */
rtems_termios_initialize ();
/* Do device-specific initialization */
/* Allready done in bspstart.c -> gba_textmode(CO60); */
/* Register the device */
status = rtems_io_register_name ("/dev/console", major, 0);
if (status != RTEMS_SUCCESSFUL) {
printk("Error registering console device!\n");
rtems_fatal_error_occurred (status);
}
printk("Initialized GBA console\n\n");
return RTEMS_SUCCESSFUL;
}
/**
* @brief console_first_open function is empty
*
* @param major diver major number
* @param minor driver minor mumber
* @param *arg pointer to parameters
* @return status code
*/
static int console_first_open(int major, int minor, void *arg)
{
return 0;
}
/**
* @brief console_last_close function is empty
*
* @param major diver major number
* @param minor driver minor mumber
* @param *arg pointer to parameters
* @return status code
*/
static int console_last_close(int major, int minor, void *arg)
{
return 0;
}
/**
* @brief Console device driver OPEN entry point
*
* @param major diver major number
* @param minor driver minor mumber
* @param *arg pointer to parameters
* @return status code
*/
rtems_device_driver
console_open(rtems_device_major_number major,
rtems_device_minor_number minor,
void *arg)
{
rtems_status_code status;
static rtems_termios_callbacks cb =
{
console_first_open, /* firstOpen */
console_last_close, /* lastClose */
gba_pollRead, /* pollRead */
gba_write, /* write */
gba_setAttributes, /* setAttributes */
NULL, /* stopRemoteTx */
NULL, /* startRemoteTx */
TERMIOS_POLLED /* 1 = outputUsesInterrupts */
};
status = rtems_termios_open (major, minor, arg, &cb);
if (status != RTEMS_SUCCESSFUL) {
printk("Error openning console device\n");
return status;
}
return RTEMS_SUCCESSFUL;
}
/**
* @brief Console device driver CLOSE entry point
*
* @param major diver major number
* @param minor driver minor mumber
* @param *arg pointer to parameters
* @return status code
*/
rtems_device_driver
console_close(rtems_device_major_number major,
rtems_device_minor_number minor,
void *arg)
{
rtems_device_driver res = RTEMS_SUCCESSFUL;
res = rtems_termios_close (arg);
return res;
}
/**
* @brief Console device driver READ entry point.
*
* Read characters from the I/O console.
*
* @param major diver major number
* @param minor driver minor mumber
* @param *arg pointer to parameters
* @return status code
*/
rtems_device_driver
console_read(rtems_device_major_number major,
rtems_device_minor_number minor,
void *arg)
{
return rtems_termios_read (arg);
}
/**
* @brief Console device driver WRITE entry point.
*
* Write characters to the I/O console.
*
* @param major diver major number
* @param minor driver minor mumber
* @param *arg pointer to parameters
* @return status code
*/
rtems_device_driver
console_write(rtems_device_major_number major,
rtems_device_minor_number minor,
void *arg)
{
return rtems_termios_write (arg);
}
/**
* @brief Handle ioctl request.
*
* @param major diver major number
* @param minor driver minor mumber
* @param *arg pointer to parameters
* @return status code
*/
rtems_device_driver
console_control(rtems_device_major_number major,
rtems_device_minor_number minor,
void *arg
)
{
return rtems_termios_ioctl (arg);
}
|
