Subversion Repositories HelenOS

Rev

Rev 4223 | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
4043 jermar 1
/*
2
 * Copyright (c) 2009 Jakub Jermar
3
 * All rights reserved.
4
 *
5
 * Redistribution and use in source and binary forms, with or without
6
 * modification, are permitted provided that the following conditions
7
 * are met:
8
 *
9
 * - Redistributions of source code must retain the above copyright
10
 *   notice, this list of conditions and the following disclaimer.
11
 * - Redistributions in binary form must reproduce the above copyright
12
 *   notice, this list of conditions and the following disclaimer in the
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
15
 *   derived from this software without specific prior written permission.
16
 *
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
19
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
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
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
26
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27
 */
28
 
4092 decky 29
/** @addtogroup genarch
4043 jermar 30
 * @{
31
 */
32
/**
33
 * @file
4092 decky 34
 * @brief Serial line processing.
4043 jermar 35
 */
36
 
37
#include <genarch/srln/srln.h>
38
#include <console/chardev.h>
39
#include <console/console.h>
40
#include <proc/thread.h>
41
#include <arch.h>
4223 decky 42
#include <string.h>
4043 jermar 43
 
4311 decky 44
static indev_operations_t srln_raw_ops = {
4092 decky 45
    .poll = NULL
4043 jermar 46
};
47
 
48
static void ksrln(void *arg)
49
{
4311 decky 50
    srln_instance_t *instance = (srln_instance_t *) arg;
4092 decky 51
    bool cr = false;
4223 decky 52
    uint32_t escape = 0;
4092 decky 53
 
54
    while (true) {
4311 decky 55
        wchar_t ch = indev_pop_character(&instance->raw);
4043 jermar 56
 
4223 decky 57
        /* ANSI escape sequence processing */
58
        if (escape != 0) {
59
            escape <<= 8;
60
            escape |= ch & 0xff;
61
 
62
            if ((escape == 0x1b4f) || (escape == 0x1b5b) || (escape == 0x1b5b33))
63
                continue;
64
 
65
            switch (escape) {
66
            case 0x1b4f46:
67
            case 0x1b5b46:
68
                ch = U_END_ARROW;
69
                escape = 0;
70
                break;
71
            case 0x1b4f48:
72
            case 0x1b5b48:
73
                ch = U_HOME_ARROW;
74
                escape = 0;
75
                break;
76
            case 0x1b5b41:
77
                ch = U_UP_ARROW;
78
                escape = 0;
79
                break;
80
            case 0x1b5b42:
81
                ch = U_DOWN_ARROW;
82
                escape = 0;
83
                break;
84
            case 0x1b5b43:
85
                ch = U_RIGHT_ARROW;
86
                escape = 0;
87
                break;
88
            case 0x1b5b44:
89
                ch = U_LEFT_ARROW;
90
                escape = 0;
91
                break;
92
            case 0x1b5b337e:
93
                ch = U_DELETE;
94
                escape = 0;
95
                break;
96
            default:
97
                escape = 0;
98
            }
99
        }
100
 
101
        if (ch == 0x1b) {
102
            escape = ch & 0xff;
103
            continue;
104
        }
105
 
106
        /* Replace carriage return with line feed
107
           and suppress any following line feed */
4092 decky 108
        if ((ch == '\n') && (cr)) {
109
            cr = false;
4043 jermar 110
            continue;
4092 decky 111
        }
4043 jermar 112
 
4092 decky 113
        if (ch == '\r') {
114
            ch = '\n';
115
            cr = true;
116
        } else
117
            cr = false;
118
 
4223 decky 119
        /* Backspace */
4092 decky 120
        if (ch == 0x7f)
121
            ch = '\b';
122
 
4311 decky 123
        indev_push_character(instance->sink, ch);
4043 jermar 124
    }
125
}
126
 
4311 decky 127
srln_instance_t *srln_init(void)
4043 jermar 128
{
4311 decky 129
    srln_instance_t *instance
130
        = malloc(sizeof(srln_instance_t), FRAME_ATOMIC);
131
    if (instance) {
132
        instance->thread
133
            = thread_create(ksrln, (void *) instance, TASK, 0, "ksrln", false);
134
 
135
        if (!instance->thread) {
136
            free(instance);
137
            return NULL;
138
        }
139
 
140
        instance->sink = NULL;
141
        indev_initialize("srln", &instance->raw, &srln_raw_ops);
142
    }
4043 jermar 143
 
4311 decky 144
    return instance;
4043 jermar 145
}
146
 
4311 decky 147
indev_t *srln_wire(srln_instance_t *instance, indev_t *sink)
148
{
149
    ASSERT(instance);
150
    ASSERT(sink);
151
 
152
    instance->sink = sink;
153
    thread_ready(instance->thread);
154
 
155
    return &instance->raw;
156
}
157
 
4043 jermar 158
/** @}
4052 jermar 159
 */