/* * Copyright (c) 2009 Jakub Jermar * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * * - Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * - Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * - The name of the author may not be used to endorse or promote products * derived from this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. */ /** @addtogroup genarch * @{ */ /** * @file * @brief Serial line processing. */ #include #include #include #include #include #include static indev_t srlnout; indev_operations_t srlnout_ops = { .poll = NULL }; static void ksrln(void *arg) { indev_t *in = (indev_t *) arg; bool cr = false; uint32_t escape = 0; while (true) { wchar_t ch = _getc(in); /* ANSI escape sequence processing */ if (escape != 0) { escape <<= 8; escape |= ch & 0xff; if ((escape == 0x1b4f) || (escape == 0x1b5b) || (escape == 0x1b5b33)) continue; switch (escape) { case 0x1b4f46: case 0x1b5b46: ch = U_END_ARROW; escape = 0; break; case 0x1b4f48: case 0x1b5b48: ch = U_HOME_ARROW; escape = 0; break; case 0x1b5b41: ch = U_UP_ARROW; escape = 0; break; case 0x1b5b42: ch = U_DOWN_ARROW; escape = 0; break; case 0x1b5b43: ch = U_RIGHT_ARROW; escape = 0; break; case 0x1b5b44: ch = U_LEFT_ARROW; escape = 0; break; case 0x1b5b337e: ch = U_DELETE; escape = 0; break; default: escape = 0; } } if (ch == 0x1b) { escape = ch & 0xff; continue; } /* Replace carriage return with line feed and suppress any following line feed */ if ((ch == '\n') && (cr)) { cr = false; continue; } if (ch == '\r') { ch = '\n'; cr = true; } else cr = false; /* Backspace */ if (ch == 0x7f) ch = '\b'; indev_push_character(stdin, ch); } } void srln_init(indev_t *devin) { indev_initialize("srln", &srlnout, &srlnout_ops); thread_t *thread = thread_create(ksrln, devin, TASK, 0, "ksrln", false); if (thread) { stdin = &srlnout; thread_ready(thread); } } /** @} */