Subversion Repositories HelenOS

Rev

Rev 4346 | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 4346 Rev 4348
1
/*
1
/*
2
 * Copyright (c) 2008 Pavel Rimsky
2
 * Copyright (c) 2008 Pavel Rimsky
3
 * All rights reserved.
3
 * All rights reserved.
4
 *
4
 *
5
 * Redistribution and use in source and binary forms, with or without
5
 * Redistribution and use in source and binary forms, with or without
6
 * modification, are permitted provided that the following conditions
6
 * modification, are permitted provided that the following conditions
7
 * are met:
7
 * are met:
8
 *
8
 *
9
 * - Redistributions of source code must retain the above copyright
9
 * - Redistributions of source code must retain the above copyright
10
 *   notice, this list of conditions and the following disclaimer.
10
 *   notice, this list of conditions and the following disclaimer.
11
 * - Redistributions in binary form must reproduce the above copyright
11
 * - Redistributions in binary form must reproduce the above copyright
12
 *   notice, this list of conditions and the following disclaimer in the
12
 *   notice, this list of conditions and the following disclaimer in the
13
 *   documentation and/or other materials provided with the distribution.
13
 *   documentation and/or other materials provided with the distribution.
14
 * - The name of the author may not be used to endorse or promote products
14
 * - The name of the author may not be used to endorse or promote products
15
 *   derived from this software without specific prior written permission.
15
 *   derived from this software without specific prior written permission.
16
 *
16
 *
17
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
21
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
22
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
23
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
24
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
25
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27
 */
27
 */
28
 
28
 
29
/** @addtogroup sparc64
29
/** @addtogroup sparc64
30
 * @{
30
 * @{
31
 */
31
 */
32
/**
32
/**
33
 * @file
33
 * @file
34
 * @brief   SGCN driver.
34
 * @brief SGCN driver.
35
 */
35
 */
36
 
36
 
37
#include <arch.h>
37
#include <arch.h>
38
#include <arch/drivers/sgcn.h>
38
#include <arch/drivers/sgcn.h>
39
#include <arch/drivers/kbd.h>
39
#include <arch/drivers/kbd.h>
40
#include <genarch/ofw/ofw_tree.h>
40
#include <genarch/ofw/ofw_tree.h>
41
#include <debug.h>
41
#include <debug.h>
42
#include <string.h>
42
#include <string.h>
43
#include <print.h>
43
#include <print.h>
44
#include <mm/page.h>
44
#include <mm/page.h>
45
#include <proc/thread.h>
45
#include <proc/thread.h>
46
#include <console/chardev.h>
46
#include <console/chardev.h>
47
#include <console/console.h>
47
#include <console/console.h>
48
#include <sysinfo/sysinfo.h>
48
#include <sysinfo/sysinfo.h>
49
#include <synch/spinlock.h>
49
#include <synch/spinlock.h>
50
 
50
 
51
#define POLL_INTERVAL       10000
51
#define POLL_INTERVAL       10000
52
 
52
 
53
/*
53
/*
54
 * Physical address at which the SBBC starts. This value has been obtained
54
 * Physical address at which the SBBC starts. This value has been obtained
55
 * by inspecting (using Simics) memory accesses made by OBP. It is valid
55
 * by inspecting (using Simics) memory accesses made by OBP. It is valid
56
 * for the Simics-simulated Serengeti machine. The author of this code is
56
 * for the Simics-simulated Serengeti machine. The author of this code is
57
 * not sure whether this value is valid generally.
57
 * not sure whether this value is valid generally.
58
 */
58
 */
59
#define SBBC_START      0x63000000000
59
#define SBBC_START      0x63000000000
60
 
60
 
61
/* offset of SRAM within the SBBC memory */
61
/* offset of SRAM within the SBBC memory */
62
#define SBBC_SRAM_OFFSET    0x900000
62
#define SBBC_SRAM_OFFSET    0x900000
63
 
63
 
64
/* size (in bytes) of the physical memory area which will be mapped */
64
/* size (in bytes) of the physical memory area which will be mapped */
65
#define MAPPED_AREA_SIZE    (128 * 1024)
65
#define MAPPED_AREA_SIZE    (128 * 1024)
66
 
66
 
67
/* magic string contained at the beginning of SRAM */
67
/* magic string contained at the beginning of SRAM */
68
#define SRAM_TOC_MAGIC      "TOCSRAM"
68
#define SRAM_TOC_MAGIC      "TOCSRAM"
69
 
69
 
70
/*
70
/*
71
 * Key into the SRAM table of contents which identifies the entry
71
 * Key into the SRAM table of contents which identifies the entry
72
 * describing the OBP console buffer. It is worth mentioning
72
 * describing the OBP console buffer. It is worth mentioning
73
 * that the OBP console buffer is not the only console buffer
73
 * that the OBP console buffer is not the only console buffer
74
 * which can be used. It is, however, used because when the kernel
74
 * which can be used. It is, however, used because when the kernel
75
 * is running, the OBP buffer is not used by OBP any more but OBP
75
 * is running, the OBP buffer is not used by OBP any more but OBP
76
 * has already made necessary arrangements so that the output will
76
 * has already made necessary arrangements so that the output will
77
 * be read from the OBP buffer and input will go to the OBP buffer.
77
 * be read from the OBP buffer and input will go to the OBP buffer.
78
 * Therefore HelenOS needs to make no such arrangements any more.
78
 * Therefore HelenOS needs to make no such arrangements any more.
79
 */
79
 */
80
#define CONSOLE_KEY     "OBPCONS"
80
#define CONSOLE_KEY     "OBPCONS"
81
 
81
 
82
/* magic string contained at the beginning of the console buffer */
82
/* magic string contained at the beginning of the console buffer */
83
#define SGCN_BUFFER_MAGIC   "CON"
83
#define SGCN_BUFFER_MAGIC   "CON"
84
 
84
 
85
/*
85
/*
86
 * Returns a pointer to the object of a given type which is placed at the given
86
 * Returns a pointer to the object of a given type which is placed at the given
87
 * offset from the SRAM beginning.
87
 * offset from the SRAM beginning.
88
 */
88
 */
89
#define SRAM(type, offset)  ((type *) (sram_begin + (offset)))
89
#define SRAM(type, offset)  ((type *) (sram_begin + (offset)))
90
 
90
 
91
/* Returns a pointer to the SRAM table of contents. */
91
/* Returns a pointer to the SRAM table of contents. */
92
#define SRAM_TOC        (SRAM(iosram_toc_t, 0))
92
#define SRAM_TOC        (SRAM(iosram_toc_t, 0))
93
 
93
 
94
/*
94
/*
95
 * Returns a pointer to the object of a given type which is placed at the given
95
 * Returns a pointer to the object of a given type which is placed at the given
96
 * offset from the console buffer beginning.
96
 * offset from the console buffer beginning.
97
 */
97
 */
98
#define SGCN_BUFFER(type, offset) \
98
#define SGCN_BUFFER(type, offset) \
99
    ((type *) (sgcn_buffer_begin + (offset)))
99
    ((type *) (sgcn_buffer_begin + (offset)))
100
 
100
 
101
/** Returns a pointer to the console buffer header. */
101
/** Returns a pointer to the console buffer header. */
102
#define SGCN_BUFFER_HEADER  (SGCN_BUFFER(sgcn_buffer_header_t, 0))
102
#define SGCN_BUFFER_HEADER  (SGCN_BUFFER(sgcn_buffer_header_t, 0))
103
 
103
 
104
/** defined in drivers/kbd.c */
-
 
105
extern kbd_type_t kbd_type;
-
 
106
 
-
 
107
/** starting address of SRAM, will be set by the init_sram_begin function */
104
/** starting address of SRAM, will be set by the init_sram_begin function */
108
static uintptr_t sram_begin;
105
static uintptr_t sram_begin;
109
 
106
 
110
/**
107
/**
111
 * starting address of the SGCN buffer, will be set by the
108
 * starting address of the SGCN buffer, will be set by the
112
 * init_sgcn_buffer_begin function
109
 * init_sgcn_buffer_begin function
113
 */
110
 */
114
static uintptr_t sgcn_buffer_begin;
111
static uintptr_t sgcn_buffer_begin;
115
 
112
 
116
/* true iff the kernel driver should ignore pressed keys */
113
/* true iff the kernel driver should ignore pressed keys */
117
static bool kbd_disabled;
114
static bool kbd_disabled;
118
 
115
 
119
/*
116
/*
120
 * Ensures that writing to the buffer and consequent update of the write pointer
117
 * Ensures that writing to the buffer and consequent update of the write pointer
121
 * are together one atomic operation.
118
 * are together one atomic operation.
122
 */
119
 */
123
SPINLOCK_INITIALIZE(sgcn_output_lock);
120
SPINLOCK_INITIALIZE(sgcn_output_lock);
124
 
121
 
125
/*
122
/*
126
 * Prevents the input buffer read/write pointers from getting to inconsistent
123
 * Prevents the input buffer read/write pointers from getting to inconsistent
127
 * state.
124
 * state.
128
 */
125
 */
129
SPINLOCK_INITIALIZE(sgcn_input_lock);
126
SPINLOCK_INITIALIZE(sgcn_input_lock);
130
 
127
 
131
 
128
 
132
/* functions referenced from definitions of I/O operations structures */
129
/* functions referenced from definitions of I/O operations structures */
133
static void sgcn_putchar(outdev_t *, const char, bool);
130
static void sgcn_putchar(outdev_t *, const wchar_t, bool);
134
 
131
 
135
/** SGCN output device operations */
132
/** SGCN output device operations */
136
static outdev_operations_t sgcnout_ops = {
133
static outdev_operations_t sgcnout_ops = {
137
    .write = sgcn_putchar
134
    .write = sgcn_putchar
138
};
135
};
139
 
136
 
140
/** SGCN input device operations */
-
 
141
static indev_operations_t sgcnin_ops = {
-
 
142
    .poll = NULL
-
 
143
};
-
 
144
 
-
 
145
static indev_t sgcnin;      /**< SGCN input device. */
-
 
146
static outdev_t sgcnout;    /**< SGCN output device. */
137
static outdev_t sgcnout;    /**< SGCN output device. */
147
 
138
 
148
/**
139
/**
149
 * Set some sysinfo values (SRAM address and SRAM size).
140
 * Set some sysinfo values (SRAM address and SRAM size).
150
 */
141
 */
151
static void register_sram(uintptr_t sram_begin_physical)
142
static void register_sram(uintptr_t sram_begin_physical)
152
{
143
{
153
    sysinfo_set_item_val("sram.area.size", NULL, MAPPED_AREA_SIZE);
144
    sysinfo_set_item_val("sram.area.size", NULL, MAPPED_AREA_SIZE);
154
    sysinfo_set_item_val("sram.address.physical", NULL,
145
    sysinfo_set_item_val("sram.address.physical", NULL,
155
        sram_begin_physical);
146
        sram_begin_physical);
156
}
147
}
157
 
148
 
158
/**
149
/**
159
 * Initializes the starting address of SRAM.
150
 * Initializes the starting address of SRAM.
160
 *
151
 *
161
 * The SRAM starts 0x900000 + C bytes behind the SBBC start in the
152
 * The SRAM starts 0x900000 + C bytes behind the SBBC start in the
162
 * physical memory, where C is the value read from the "iosram-toc"
153
 * physical memory, where C is the value read from the "iosram-toc"
163
 * property of the "/chosen" OBP node. The sram_begin variable will
154
 * property of the "/chosen" OBP node. The sram_begin variable will
164
 * be set to the virtual address which maps to the SRAM physical
155
 * be set to the virtual address which maps to the SRAM physical
165
 * address.
156
 * address.
166
 */
157
 */
167
static void init_sram_begin(void)
158
static void init_sram_begin(void)
168
{
159
{
169
    ofw_tree_node_t *chosen;
160
    ofw_tree_node_t *chosen;
170
    ofw_tree_property_t *iosram_toc;
161
    ofw_tree_property_t *iosram_toc;
171
    uintptr_t sram_begin_physical;
162
    uintptr_t sram_begin_physical;
172
 
163
 
173
    chosen = ofw_tree_lookup("/chosen");
164
    chosen = ofw_tree_lookup("/chosen");
174
    if (!chosen)
165
    if (!chosen)
175
        panic("Cannot find '/chosen'.");
166
        panic("Cannot find '/chosen'.");
176
 
167
 
177
    iosram_toc = ofw_tree_getprop(chosen, "iosram-toc");
168
    iosram_toc = ofw_tree_getprop(chosen, "iosram-toc");
178
    if (!iosram_toc)
169
    if (!iosram_toc)
179
        panic("Cannot find property 'iosram-toc'.");
170
        panic("Cannot find property 'iosram-toc'.");
180
    if (!iosram_toc->value)
171
    if (!iosram_toc->value)
181
        panic("Cannot find SRAM TOC.");
172
        panic("Cannot find SRAM TOC.");
182
 
173
 
183
    sram_begin_physical = SBBC_START + SBBC_SRAM_OFFSET
174
    sram_begin_physical = SBBC_START + SBBC_SRAM_OFFSET
184
        + *((uint32_t *) iosram_toc->value);
175
        + *((uint32_t *) iosram_toc->value);
185
    sram_begin = hw_map(sram_begin_physical, MAPPED_AREA_SIZE);
176
    sram_begin = hw_map(sram_begin_physical, MAPPED_AREA_SIZE);
186
   
177
   
187
    register_sram(sram_begin_physical);
178
    register_sram(sram_begin_physical);
188
}
179
}
189
 
180
 
190
/**
181
/**
191
 * Initializes the starting address of the SGCN buffer.
182
 * Initializes the starting address of the SGCN buffer.
192
 *
183
 *
193
 * The offset of the SGCN buffer within SRAM is obtained from the
184
 * The offset of the SGCN buffer within SRAM is obtained from the
194
 * SRAM table of contents. The table of contents contains
185
 * SRAM table of contents. The table of contents contains
195
 * information about several buffers, among which there is an OBP
186
 * information about several buffers, among which there is an OBP
196
 * console buffer - this one will be used as the SGCN buffer.
187
 * console buffer - this one will be used as the SGCN buffer.
197
 *
188
 *
198
 * This function also writes the offset of the SGCN buffer within SRAM
189
 * This function also writes the offset of the SGCN buffer within SRAM
199
 * under the sram.buffer.offset sysinfo key.
190
 * under the sram.buffer.offset sysinfo key.
200
 */
191
 */
201
static void sgcn_buffer_begin_init(void)
192
static void sgcn_buffer_begin_init(void)
202
{
193
{
203
    static bool initialized;
194
    static bool initialized;
204
   
195
   
205
    if (initialized)
196
    if (initialized)
206
        return;
197
        return;
207
 
198
 
208
    init_sram_begin();
199
    init_sram_begin();
209
       
200
       
210
    ASSERT(strcmp(SRAM_TOC->magic, SRAM_TOC_MAGIC) == 0);
201
    ASSERT(str_cmp(SRAM_TOC->magic, SRAM_TOC_MAGIC) == 0);
211
   
202
   
212
    /* lookup TOC entry with the correct key */
203
    /* lookup TOC entry with the correct key */
213
    uint32_t i;
204
    uint32_t i;
214
    for (i = 0; i < MAX_TOC_ENTRIES; i++) {
205
    for (i = 0; i < MAX_TOC_ENTRIES; i++) {
215
        if (strcmp(SRAM_TOC->keys[i].key, CONSOLE_KEY) == 0)
206
        if (str_cmp(SRAM_TOC->keys[i].key, CONSOLE_KEY) == 0)
216
            break;
207
            break;
217
    }
208
    }
218
    ASSERT(i < MAX_TOC_ENTRIES);
209
    ASSERT(i < MAX_TOC_ENTRIES);
219
   
210
   
220
    sgcn_buffer_begin = sram_begin + SRAM_TOC->keys[i].offset;
211
    sgcn_buffer_begin = sram_begin + SRAM_TOC->keys[i].offset;
221
   
212
   
222
    sysinfo_set_item_val("sram.buffer.offset", NULL,
213
    sysinfo_set_item_val("sram.buffer.offset", NULL,
223
        SRAM_TOC->keys[i].offset);
214
        SRAM_TOC->keys[i].offset);
224
   
215
   
225
    initialized = true;
216
    initialized = true;
226
}
217
}
227
 
218
 
228
/**
219
/**
229
 * Writes a single character to the SGCN (circular) output buffer
220
 * Writes a single character to the SGCN (circular) output buffer
230
 * and updates the output write pointer so that SGCN gets to know
221
 * and updates the output write pointer so that SGCN gets to know
231
 * that the character has been written.
222
 * that the character has been written.
232
 */
223
 */
233
static void sgcn_do_putchar(const char c)
224
static void sgcn_do_putchar(const char c)
234
{
225
{
235
    uint32_t begin = SGCN_BUFFER_HEADER->out_begin;
226
    uint32_t begin = SGCN_BUFFER_HEADER->out_begin;
236
    uint32_t end = SGCN_BUFFER_HEADER->out_end;
227
    uint32_t end = SGCN_BUFFER_HEADER->out_end;
237
    uint32_t size = end - begin;
228
    uint32_t size = end - begin;
238
   
229
   
239
    /* we need pointers to volatile variables */
230
    /* we need pointers to volatile variables */
240
    volatile char *buf_ptr = (volatile char *)
231
    volatile char *buf_ptr = (volatile char *)
241
        SGCN_BUFFER(char, SGCN_BUFFER_HEADER->out_wrptr);
232
        SGCN_BUFFER(char, SGCN_BUFFER_HEADER->out_wrptr);
242
    volatile uint32_t *out_wrptr_ptr = &(SGCN_BUFFER_HEADER->out_wrptr);
233
    volatile uint32_t *out_wrptr_ptr = &(SGCN_BUFFER_HEADER->out_wrptr);
243
    volatile uint32_t *out_rdptr_ptr = &(SGCN_BUFFER_HEADER->out_rdptr);
234
    volatile uint32_t *out_rdptr_ptr = &(SGCN_BUFFER_HEADER->out_rdptr);
244
 
235
 
245
    /*
236
    /*
246
     * Write the character and increment the write pointer modulo the
237
     * Write the character and increment the write pointer modulo the
247
     * output buffer size. Note that if we are to rewrite a character
238
     * output buffer size. Note that if we are to rewrite a character
248
     * which has not been read by the SGCN controller yet (i.e. the output
239
     * which has not been read by the SGCN controller yet (i.e. the output
249
     * buffer is full), we need to wait until the controller reads some more
240
     * buffer is full), we need to wait until the controller reads some more
250
     * characters. We wait actively, which means that all threads waiting
241
     * characters. We wait actively, which means that all threads waiting
251
     * for the lock are blocked. However, this situation is
242
     * for the lock are blocked. However, this situation is
252
     *   1) rare - the output buffer is big, so filling the whole
243
     *   1) rare - the output buffer is big, so filling the whole
253
     *             output buffer is improbable
244
     *             output buffer is improbable
254
     *   2) short-lasting - it will take the controller only a fraction
245
     *   2) short-lasting - it will take the controller only a fraction
255
     *             of millisecond to pick the unread characters up
246
     *             of millisecond to pick the unread characters up
256
     *   3) not serious - the blocked threads are those that print something
247
     *   3) not serious - the blocked threads are those that print something
257
     *             to user console, which is not a time-critical operation
248
     *             to user console, which is not a time-critical operation
258
     */
249
     */
259
    uint32_t new_wrptr = (((*out_wrptr_ptr) - begin + 1) % size) + begin;
250
    uint32_t new_wrptr = (((*out_wrptr_ptr) - begin + 1) % size) + begin;
260
    while (*out_rdptr_ptr == new_wrptr)
251
    while (*out_rdptr_ptr == new_wrptr)
261
        ;
252
        ;
262
    *buf_ptr = c;
253
    *buf_ptr = c;
263
    *out_wrptr_ptr = new_wrptr;
254
    *out_wrptr_ptr = new_wrptr;
264
}
255
}
265
 
256
 
266
/**
257
/**
267
 * SGCN output operation. Prints a single character to the SGCN. If the line
258
 * SGCN output operation. Prints a single character to the SGCN. Newline
268
 * feed character is written ('\n'), the carriage return character ('\r') is
-
 
269
 * written straight away.
259
 * character is converted to CRLF.
270
 */
260
 */
271
static void sgcn_putchar(outdev_t *od, const char c, bool silent)
261
static void sgcn_putchar(outdev_t *od, const wchar_t ch, bool silent)
272
{
262
{
273
    if (!silent) {
263
    if (!silent) {
274
        spinlock_lock(&sgcn_output_lock);
264
        spinlock_lock(&sgcn_output_lock);
275
       
265
       
276
        sgcn_do_putchar(c);
266
        if (ascii_check(ch)) {
277
        if (c == '\n')
267
            if (ch == '\n')
278
            sgcn_do_putchar('\r');
268
                sgcn_do_putchar('\r');
-
 
269
            sgcn_do_putchar(ch);
-
 
270
        } else
-
 
271
            sgcn_do_putchar(U_SPECIAL);
279
       
272
       
280
        spinlock_unlock(&sgcn_output_lock);
273
        spinlock_unlock(&sgcn_output_lock);
281
    }
274
    }
282
}
275
}
283
 
276
 
284
/**
277
/**
285
 * Grabs the input for kernel.
278
 * Grabs the input for kernel.
286
 */
279
 */
287
void sgcn_grab(void)
280
void sgcn_grab(void)
288
{
281
{
289
    kbd_disabled = true;
282
    kbd_disabled = false;
290
}
283
}
291
 
284
 
292
/**
285
/**
293
 * Releases the input so that userspace can use it.
286
 * Releases the input so that userspace can use it.
294
 */
287
 */
295
void sgcn_release(void)
288
void sgcn_release(void)
296
{
289
{
297
    kbd_disabled = true;
290
    kbd_disabled = true;
298
}
291
}
299
 
292
 
300
/**
293
/**
301
 * Function regularly called by the keyboard polling thread. Finds out whether
294
 * Function regularly called by the keyboard polling thread. Finds out whether
302
 * there are some unread characters in the input queue. If so, it picks them up
295
 * there are some unread characters in the input queue. If so, it picks them up
303
 * and sends them to the upper layers of HelenOS.
296
 * and sends them to the upper layers of HelenOS.
304
 */
297
 */
305
static void sgcn_poll()
298
static void sgcn_poll(sgcn_instance_t *instance)
306
{
299
{
307
    uint32_t begin = SGCN_BUFFER_HEADER->in_begin;
300
    uint32_t begin = SGCN_BUFFER_HEADER->in_begin;
308
    uint32_t end = SGCN_BUFFER_HEADER->in_end;
301
    uint32_t end = SGCN_BUFFER_HEADER->in_end;
309
    uint32_t size = end - begin;
302
    uint32_t size = end - begin;
310
 
303
 
311
    if (kbd_disabled)
304
    if (kbd_disabled)
312
        return;
305
        return;
313
 
306
 
314
    spinlock_lock(&sgcn_input_lock);
307
    spinlock_lock(&sgcn_input_lock);
315
   
308
   
316
    /* we need pointers to volatile variables */
309
    /* we need pointers to volatile variables */
317
    volatile char *buf_ptr = (volatile char *)
310
    volatile char *buf_ptr = (volatile char *)
318
        SGCN_BUFFER(char, SGCN_BUFFER_HEADER->in_rdptr);
311
        SGCN_BUFFER(char, SGCN_BUFFER_HEADER->in_rdptr);
319
    volatile uint32_t *in_wrptr_ptr = &(SGCN_BUFFER_HEADER->in_wrptr);
312
    volatile uint32_t *in_wrptr_ptr = &(SGCN_BUFFER_HEADER->in_wrptr);
320
    volatile uint32_t *in_rdptr_ptr = &(SGCN_BUFFER_HEADER->in_rdptr);
313
    volatile uint32_t *in_rdptr_ptr = &(SGCN_BUFFER_HEADER->in_rdptr);
321
   
314
   
322
    while (*in_rdptr_ptr != *in_wrptr_ptr) {
315
    while (*in_rdptr_ptr != *in_wrptr_ptr) {
323
       
-
 
324
        buf_ptr = (volatile char *)
316
        buf_ptr = (volatile char *)
325
            SGCN_BUFFER(char, SGCN_BUFFER_HEADER->in_rdptr);
317
            SGCN_BUFFER(char, SGCN_BUFFER_HEADER->in_rdptr);
326
        char c = *buf_ptr;
318
        char c = *buf_ptr;
327
        *in_rdptr_ptr = (((*in_rdptr_ptr) - begin + 1) % size) + begin;
319
        *in_rdptr_ptr = (((*in_rdptr_ptr) - begin + 1) % size) + begin;
328
           
320
           
329
        indev_push_character(&sgcnin, c);  
321
        indev_push_character(instance->srlnin, c); 
330
    }  
322
    }  
331
 
323
 
332
    spinlock_unlock(&sgcn_input_lock);
324
    spinlock_unlock(&sgcn_input_lock);
333
}
325
}
334
 
326
 
335
/**
327
/**
336
 * Polling thread function.
328
 * Polling thread function.
337
 */
329
 */
338
static void kkbdpoll(void *arg) {
330
static void ksgcnpoll(void *instance) {
339
    while (1) {
331
    while (1) {
340
        if (!silent) {
332
        if (!silent)
341
            sgcn_poll();
333
            sgcn_poll(instance);
342
        }
-
 
343
        thread_usleep(POLL_INTERVAL);
334
        thread_usleep(POLL_INTERVAL);
344
    }
335
    }
345
}
336
}
346
 
337
 
347
/**
338
/**
348
 * A public function which initializes input from the Serengeti console.
339
 * A public function which initializes input from the Serengeti console.
349
 */
340
 */
350
indev_t *sgcnin_init(void)
341
sgcn_instance_t *sgcnin_init(void)
351
{
342
{
352
    sgcn_buffer_begin_init();
343
    sgcn_buffer_begin_init();
-
 
344
   
-
 
345
    sgcn_instance_t *instance =
-
 
346
        malloc(sizeof(sgcn_instance_t), FRAME_ATOMIC);
-
 
347
   
-
 
348
    if (instance) {
-
 
349
        instance->srlnin = NULL;
-
 
350
        instance->thread = thread_create(ksgcnpoll, instance, TASK, 0,
-
 
351
            "ksgcnpoll", true);
-
 
352
       
-
 
353
        if (!instance->thread) {
-
 
354
            free(instance);
-
 
355
            return NULL;
-
 
356
        }
-
 
357
    }
-
 
358
   
-
 
359
    return instance;
-
 
360
}
353
 
361
 
354
    kbd_type = KBD_SGCN;
362
void sgcnin_wire(sgcn_instance_t *instance, indev_t *srlnin)
355
 
363
{
356
    sysinfo_set_item_val("kbd", NULL, true);
364
    ASSERT(instance);
357
    sysinfo_set_item_val("kbd.type", NULL, KBD_SGCN);
365
    ASSERT(srlnin);
358
 
366
 
359
    thread_t *t = thread_create(kkbdpoll, NULL, TASK, 0, "kkbdpoll", true);
-
 
360
    if (!t)
-
 
361
        panic("Cannot create kkbdpoll.");
367
    instance->srlnin = srlnin;
362
    thread_ready(t);
368
    thread_ready(instance->thread);
363
   
-
 
364
    indev_initialize("sgcnin", &sgcnin, &sgcnin_ops);
-
 
365
 
369
 
366
    return &sgcnin;
370
    sysinfo_set_item_val("kbd", NULL, true);
367
}
371
}
368
 
372
 
369
/**
373
/**
370
 * A public function which initializes output to the Serengeti console.
374
 * A public function which initializes output to the Serengeti console.
371
 */
375
 */
372
void sgcnout_init(void)
376
void sgcnout_init(void)
373
{
377
{
374
    sgcn_buffer_begin_init();
378
    sgcn_buffer_begin_init();
375
 
379
 
376
    sysinfo_set_item_val("fb.kind", NULL, 4);
380
    sysinfo_set_item_val("fb.kind", NULL, 4);
377
 
381
 
378
    outdev_initialize("sgcnout", &sgcnout, &sgcnout_ops);  
382
    outdev_initialize("sgcnout", &sgcnout, &sgcnout_ops);  
379
    stdout = &sgcnout;
383
    stdout = &sgcnout;
380
}
384
}
381
 
385
 
382
/** @}
386
/** @}
383
 */
387
 */
384
 
388