Subversion Repositories HelenOS

Rev

Rev 4153 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 4153 Rev 4263
1 
/*
 1 
/*
2 
 * Copyright (c) 2009 Jakub Jermar
 2 
 * Copyright (c) 2009 Jakub Jermar
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 genarch
 29 
/** @addtogroup genarch
30 
 * @{
 30 
 * @{
31 
 */
 31 
 */
32 
/**
 32 
/**
33 
 * @file
 33 
 * @file
34 
 * @brief Serial line processing.
 34 
 * @brief Serial line processing.
35 
 */
 35 
 */
36 
 
 36 
 
37 
#include <genarch/srln/srln.h>
 37 
#include <genarch/srln/srln.h>
38 
#include <console/chardev.h>
 38 
#include <console/chardev.h>
39 
#include <console/console.h>
 39 
#include <console/console.h>
40 
#include <proc/thread.h>
 40 
#include <proc/thread.h>
41 
#include <arch.h>
 41 
#include <arch.h>
- 
 
 42 
#include <string.h>
42 
 
 43 
 
43 
static indev_t srlnout;
 44 
static indev_t srlnout;
44 
 
 45 
 
45 
indev_operations_t srlnout_ops = {
 46 
indev_operations_t srlnout_ops = {
46 
    .poll = NULL
 47 
    .poll = NULL
47 
};
 48 
};
48 
 
 49 
 
49 
static void ksrln(void *arg)
 50 
static void ksrln(void *arg)
50 
{
 51 
{
51 
    indev_t *in = (indev_t *) arg;
 52 
    indev_t *in = (indev_t *) arg;
52 
    bool cr = false;
 53 
    bool cr = false;
- 
 
 54 
    uint32_t escape = 0;
53 
   
 55 
   
54 
    while (true) {
 56 
    while (true) {
55 
        uint8_t ch = _getc(in);
 57 
        wchar_t ch = _getc(in);
56 
       
 58 
       
- 
 
 59 
        /* ANSI escape sequence processing */
- 
 
 60 
        if (escape != 0) {
- 
 
 61 
            escape <<= 8;
- 
 
 62 
            escape |= ch & 0xff;
- 
 
 63 
           
- 
 
 64 
            if ((escape == 0x1b4f) || (escape == 0x1b5b) || (escape == 0x1b5b33))
- 
 
 65 
                continue;
- 
 
 66 
           
- 
 
 67 
            switch (escape) {
- 
 
 68 
            case 0x1b4f46:
- 
 
 69 
            case 0x1b5b46:
- 
 
 70 
                ch = U_END_ARROW;
- 
 
 71 
                escape = 0;
- 
 
 72 
                break;
- 
 
 73 
            case 0x1b4f48:
- 
 
 74 
            case 0x1b5b48:
- 
 
 75 
                ch = U_HOME_ARROW;
- 
 
 76 
                escape = 0;
- 
 
 77 
                break;
- 
 
 78 
            case 0x1b5b41:
- 
 
 79 
                ch = U_UP_ARROW;
- 
 
 80 
                escape = 0;
- 
 
 81 
                break;
- 
 
 82 
            case 0x1b5b42:
- 
 
 83 
                ch = U_DOWN_ARROW;
- 
 
 84 
                escape = 0;
- 
 
 85 
                break;
- 
 
 86 
            case 0x1b5b43:
- 
 
 87 
                ch = U_RIGHT_ARROW;
- 
 
 88 
                escape = 0;
- 
 
 89 
                break;
- 
 
 90 
            case 0x1b5b44:
- 
 
 91 
                ch = U_LEFT_ARROW;
- 
 
 92 
                escape = 0;
- 
 
 93 
                break;
- 
 
 94 
            case 0x1b5b337e:
- 
 
 95 
                ch = U_DELETE;
- 
 
 96 
                escape = 0;
- 
 
 97 
                break;
- 
 
 98 
            default:
- 
 
 99 
                escape = 0;
- 
 
 100 
            }
- 
 
 101 
        }
- 
 
 102 
       
- 
 
 103 
        if (ch == 0x1b) {
- 
 
 104 
            escape = ch & 0xff;
- 
 
 105 
            continue;
- 
 
 106 
        }
- 
 
 107 
       
- 
 
 108 
        /* Replace carriage return with line feed
- 
 
 109 
           and suppress any following line feed */
57 
        if ((ch == '\n') && (cr)) {
 110 
        if ((ch == '\n') && (cr)) {
58 
            cr = false;
 111 
            cr = false;
59 
            continue;
 112 
            continue;
60 
        }
 113 
        }
61 
       
 114 
       
62 
        if (ch == '\r') {
 115 
        if (ch == '\r') {
63 
            ch = '\n';
 116 
            ch = '\n';
64 
            cr = true;
 117 
            cr = true;
65 
        } else
 118 
        } else
66 
            cr = false;
 119 
            cr = false;
67 
       
 120 
       
- 
 
 121 
        /* Backspace */
68 
        if (ch == 0x7f)
 122 
        if (ch == 0x7f)
69 
            ch = '\b';
 123 
            ch = '\b';
70 
       
 124 
       
71 
        indev_push_character(stdin, ch);
 125 
        indev_push_character(stdin, ch);
72 
    }
 126 
    }
73 
}
 127 
}
74 
 
 128 
 
75 
void srln_init(indev_t *devin)
 129 
void srln_init(indev_t *devin)
76 
{
 130 
{
77 
    indev_initialize("srln", &srlnout, &srlnout_ops);
 131 
    indev_initialize("srln", &srlnout, &srlnout_ops);
78 
    thread_t *thread
 132 
    thread_t *thread
79 
        = thread_create(ksrln, devin, TASK, 0, "ksrln", false);
 133 
        = thread_create(ksrln, devin, TASK, 0, "ksrln", false);
80 
   
 134 
   
81 
    if (thread) {
 135 
    if (thread) {
82 
        stdin = &srlnout;
 136 
        stdin = &srlnout;
83 
        thread_ready(thread);
 137 
        thread_ready(thread);
84 
    }
 138 
    }
85 
}
 139 
}
86 
 
 140 
 
87 
/** @}
 141 
/** @}
88 
 */
 142 
 */
89 
 
 143