From 6bda703964e8cbbf73cb21f52fb7ceeb3cb3a541 Mon Sep 17 00:00:00 2001 From: Vijay Kumar Banerjee Date: Mon, 22 Mar 2021 21:05:25 -0600 Subject: Import telnetd from RTEMS repository The files have been taken from RTEMS repository with head commit at bd9e45d91f77657445400bc2c814f251c9e37cef --- libbsd.py | 22 +- rtemsbsd/include/rtems/telnetd.h | 137 ++++++ rtemsbsd/telnetd/README | 23 ++ rtemsbsd/telnetd/check_passwd.c | 106 +++++ rtemsbsd/telnetd/des.c | 873 +++++++++++++++++++++++++++++++++++++++ rtemsbsd/telnetd/des.h | 1 + rtemsbsd/telnetd/genpw.c | 79 ++++ rtemsbsd/telnetd/pty.c | 401 ++++++++++++++++++ rtemsbsd/telnetd/telnetd-init.c | 18 + rtemsbsd/telnetd/telnetd.c | 449 ++++++++++++++++++++ 10 files changed, 2100 insertions(+), 9 deletions(-) create mode 100644 rtemsbsd/include/rtems/telnetd.h create mode 100644 rtemsbsd/telnetd/README create mode 100644 rtemsbsd/telnetd/check_passwd.c create mode 100644 rtemsbsd/telnetd/des.c create mode 100644 rtemsbsd/telnetd/des.h create mode 100644 rtemsbsd/telnetd/genpw.c create mode 100644 rtemsbsd/telnetd/pty.c create mode 100644 rtemsbsd/telnetd/telnetd-init.c create mode 100644 rtemsbsd/telnetd/telnetd.c diff --git a/libbsd.py b/libbsd.py index a2056f36..f7efda43 100644 --- a/libbsd.py +++ b/libbsd.py @@ -293,6 +293,12 @@ class rtems(builder.Module): 'pppd/upap.c', 'pppd/utils.c', 'telnetd/telnetd-service.c', + 'telnetd/check_passwd.c', + 'telnetd/des.c', + 'telnetd/pty.c', + 'telnetd/genpw.c', + 'telnetd/telnetd-init.c', + 'telnetd/telnetd.c', ], mm.generator['source']() ) @@ -5368,8 +5374,7 @@ class tests(builder.Module): self.addTest(mm.generator['test']('arphole', ['test_main'], runTest = False, netTest = True)) self.addTest(mm.generator['test']('telnetd01', ['test_main'], - runTest = False, netTest = True, - extraLibs = ['telnetd'])) + runTest = False, netTest = True)) self.addTest(mm.generator['test']('unix01', ['test_main'])) self.addTest(mm.generator['test']('ftpd01', ['test_main'], netTest = True, @@ -5397,27 +5402,26 @@ class tests(builder.Module): self.addTest(mm.generator['test']('mutex01', ['test_main'])) self.addTest(mm.generator['test']('condvar01', ['test_main'])) self.addTest(mm.generator['test']('ppp01', ['test_main'], runTest = False, - extraLibs = ['ftpd', 'telnetd'])) + extraLibs = ['ftpd'])) self.addTest(mm.generator['test']('zerocopy01', ['test_main'], - runTest = False, netTest = True, - extraLibs = ['telnetd'])) + runTest = False, netTest = True)) self.addTest(mm.generator['test']('smp01', ['test_main'], extraLibs = ['rtemstest'])) self.addTest(mm.generator['test']('media01', ['test_main'], runTest = False, - extraLibs = ['ftpd', 'telnetd'])) + extraLibs = ['ftpd'])) self.addTest(mm.generator['test']('mcast01', ['test_main'])) self.addTest(mm.generator['test']('vlan01', ['test_main'], netTest = True)) self.addTest(mm.generator['test']('lagg01', ['test_main'], netTest = True)) self.addTest(mm.generator['test']('log01', ['test_main'])) self.addTest(mm.generator['test']('rcconf01', ['test_main'])) self.addTest(mm.generator['test']('rcconf02', ['test_main'], - extraLibs = ['ftpd', 'telnetd'])) + extraLibs = ['ftpd'])) self.addTest(mm.generator['test']('cdev01', ['test_main', 'test_cdev'])) self.addTest(mm.generator['test']('pf01', ['test_main'], - extraLibs = ['ftpd', 'telnetd'])) + extraLibs = ['ftpd'])) self.addTest(mm.generator['test']('pf02', ['test_main'], runTest = False, - extraLibs = ['ftpd', 'telnetd'])) + extraLibs = ['ftpd'])) self.addTest(mm.generator['test']('termios', ['test_main', 'test_termios_driver', 'test_termios_utilities'])) diff --git a/rtemsbsd/include/rtems/telnetd.h b/rtemsbsd/include/rtems/telnetd.h new file mode 100644 index 00000000..1f8e1c55 --- /dev/null +++ b/rtemsbsd/include/rtems/telnetd.h @@ -0,0 +1,137 @@ +/* + * Original Author: Fernando RUIZ CASAS (fernando.ruiz@ctv.es) + * May 2001 + * Reworked by Till Straumann and .h overhauled by Joel Sherrill. + * + * Copyright (c) 2009 embedded brains GmbH and others. + * + * embedded brains GmbH + * Obere Lagerstr. 30 + * D-82178 Puchheim + * Germany + * + * + * The license and distribution terms for this file may be + * found in the file LICENSE in this distribution or at + * http://www.rtems.org/license/LICENSE. + */ + +#ifndef _RTEMS_TELNETD_H +#define _RTEMS_TELNETD_H + +#include +#include + +#ifdef __cplusplus +extern "C" { +#endif + +bool rtems_telnetd_login_check( + const char *user, + const char *passphrase +); + +/** + * @brief Telnet command type. + */ +typedef void (*rtems_telnetd_command)( + char * /* device name */, + void * /* arg */ +); + +/** + * @brief Telnet configuration structure. + */ +typedef struct { + /** + * @brief Function invoked for each Telnet connection. + * + * The first parameter contains the device name. The second parameter + * contains the argument pointer of this configuration table. + */ + rtems_telnetd_command command; + + /** + * @brief Argument for command function. + */ + void *arg; + + /** + * @brief Task priority. + * + * Use 0 for the default value. + */ + rtems_task_priority priority; + + /** + * @brief Task stack size. + * + * Use 0 for the default value. + */ + size_t stack_size; + + /** + * @brief Login check function. + * + * Method used for login checks. Use @c NULL to disable a login check. + */ + rtems_shell_login_check_t login_check; + + /** + * @brief This is an obsolete configuration option. + * + * It must be set to false, otherwise rtems_telnetd_start() will do nothing + * and returns with a status of RTEMS_NOT_IMPLEMENTED. + */ + bool keep_stdio; + + /** + * @brief Maximum number of clients which can connect to the system at a + * time. + * + * Use 0 for the default value. + */ + uint16_t client_maximum; + + /** + * @brief Server port number in host byte order. + * + * Use 0 for the default value. + */ + uint16_t port; +} rtems_telnetd_config_table; + +/** + * @brief Starts the Telnet server using the provided configuration. + * + * @retval RTEMS_SUCCESSFUL Successful operation. + * @retval RTEMS_INVALID_ADDRESS The command function in the configuration is + * @c NULL. + * @retval RTEMS_RESOURCE_IN_USE The server port is already in use. + * @retval RTEMS_NOT_IMPLEMENTED The keep stdio configuration option is true. + * @retval RTEMS_UNSATISFIED Not enough resources to start the Telnet server or + * task priority in configuration is invalid. + */ +rtems_status_code rtems_telnetd_start(const rtems_telnetd_config_table *config); + +/** + * @brief Telnet configuration. + * + * The application must provide this configuration table. It is used by + * rtems_telnetd_initialize() to configure the Telnet subsystem. Do not modify + * the entries after the intialization since it is used internally. + */ +extern rtems_telnetd_config_table rtems_telnetd_config; + +/** + * @brief Initializes the Telnet subsystem. + * + * Uses the application provided @ref rtems_telnetd_config configuration table. + */ +rtems_status_code rtems_telnetd_initialize(void); + +#ifdef __cplusplus +} +#endif + +#endif diff --git a/rtemsbsd/telnetd/README b/rtemsbsd/telnetd/README new file mode 100644 index 00000000..3807aa5e --- /dev/null +++ b/rtemsbsd/telnetd/README @@ -0,0 +1,23 @@ +Author: fernando.ruiz@ctv.es (correo@fernando-ruiz.com) + +This directory contains a telnetd server +primary features: + + + create a user shell pseudo-terminal task. + +This code has not been extensively tested. It is provided as a tool +for RTEMS users to open more shell tcp/ip pseudo-terminal. +Suggestions and comments are appreciated. + +Read libmisc/shell for more information. + +NOTES: + +1. OOB not yet implemented. Only a reduced negotiation is implemented. + +2. If you have tcp/ip initialied you can start telnetd daemon. + You need register pseudo-terminals driver into device drivers table. + +Enjoy it. + +FUTURE: diff --git a/rtemsbsd/telnetd/check_passwd.c b/rtemsbsd/telnetd/check_passwd.c new file mode 100644 index 00000000..b4ea4d01 --- /dev/null +++ b/rtemsbsd/telnetd/check_passwd.c @@ -0,0 +1,106 @@ +/* + * Authorship + * ---------- + * This software was created by + * Till Straumann , 2003-2007 + * Stanford Linear Accelerator Center, Stanford University. + * + * Acknowledgement of sponsorship + * ------------------------------ + * This software was produced by + * the Stanford Linear Accelerator Center, Stanford University, + * under Contract DE-AC03-76SFO0515 with the Department of Energy. + * + * Government disclaimer of liability + * ---------------------------------- + * Neither the United States nor the United States Department of Energy, + * nor any of their employees, makes any warranty, express or implied, or + * assumes any legal liability or responsibility for the accuracy, + * completeness, or usefulness of any data, apparatus, product, or process + * disclosed, or represents that its use would not infringe privately owned + * rights. + * + * Stanford disclaimer of liability + * -------------------------------- + * Stanford University makes no representations or warranties, express or + * implied, nor assumes any liability for the use of this software. + * + * Stanford disclaimer of copyright + * -------------------------------- + * Stanford University, owner of the copyright, hereby disclaims its + * copyright and all other rights in this software. Hence, anyone may + * freely use it for any purpose without restriction. + * + * Maintenance of notices + * ---------------------- + * In the interest of clarity regarding the origin and status of this + * SLAC software, this and all the preceding Stanford University notices + * are to remain affixed to any copy or derivative of this software made + * or distributed by the recipient and are to be affixed to any copy of + * software made or distributed by the recipient that contains a copy or + * derivative of this software. + * + * ------------------ SLAC Software Notices, Set 4 OTT.002a, 2004 FEB 03 + * + * Copyright (c) 2009 embedded brains GmbH and others. + * + * embedded brains GmbH + * Obere Lagerstr. 30 + * D-82178 Puchheim + * Germany + * + * + * The license and distribution terms for this file may be + * found in the file LICENSE in this distribution or at + * http://www.rtems.org/license/LICENSE. + */ + +#ifdef HAVE_CONFIG_H +#include "config.h" +#endif + +#include +#include +#include +#include +#include +#include +#include + +#include + +#include "des.h" +#include + +/** + * @brief Standard Telnet login check that uses DES to encrypt the passphrase. + * + * Takes a @a passphrase, encrypts it and compares it to the encrypted + * passphrase in the @c TELNETD_PASSWD environment variable. No password is + * required if @c TELNETD_PASSWD is unset. The argument @a user is ignored. + */ +bool rtems_telnetd_login_check( + const char *user, + const char *passphrase +) +{ + char *pw = getenv( "TELNETD_PASSWD"); + char cryptbuf [21]; + char salt [3]; + + if (pw == NULL || strlen( pw) == 0) { + #ifdef TELNETD_DEFAULT_PASSWD + pw = TELNETD_DEFAULT_PASSWD; + #else + return true; + #endif + } + + strncpy( salt, pw, 2); + salt [2] = '\0'; + + return strcmp( + __des_crypt_r( passphrase, salt, cryptbuf, sizeof( cryptbuf)), + pw + ) == 0; +} diff --git a/rtemsbsd/telnetd/des.c b/rtemsbsd/telnetd/des.c new file mode 100644 index 00000000..1d0295a6 --- /dev/null +++ b/rtemsbsd/telnetd/des.c @@ -0,0 +1,873 @@ +/* + * FreeSec: libcrypt for NetBSD + * + * Copyright (c) 1994 David Burren + * All rights reserved. + * + * Ported to RTEMS and made reentrant by Till Straumann, 9/2003 + * + * Adapted for FreeBSD-2.0 by Geoffrey M. Rehmet + * this file should now *only* export crypt(), in order to make + * binaries of libcrypt exportable from the USA + * + * Adapted for FreeBSD-4.0 by Mark R V Murray + * this file should now *only* export crypt_des(), in order to make + * a module that can be optionally included in libcrypt. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. 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. + * 3. Neither the name of the author nor the names of other contributors + * may be used to endorse or promote products derived from this software + * without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``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 OR CONTRIBUTORS 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. + * + * This is an original implementation of the DES and the crypt(3) interfaces + * by David Burren . + * + * An excellent reference on the underlying algorithm (and related + * algorithms) is: + * + * B. Schneier, Applied Cryptography: protocols, algorithms, + * and source code in C, John Wiley & Sons, 1994. + * + * Note that in that book's description of DES the lookups for the initial, + * pbox, and final permutations are inverted (this has been brought to the + * attention of the author). A list of errata for this book has been + * posted to the sci.crypt newsgroup by the author and is available for FTP. + * + * ARCHITECTURE ASSUMPTIONS: + * It is assumed that the 8-byte arrays passed by reference can be + * addressed as arrays of u_int32_t's (ie. the CPU is not picky about + * alignment). + */ + +#ifdef HAVE_CONFIG_H +#include "config.h" +#endif + +#define __FORCE_GLIBC +#include +#include +#include +#include +#ifndef __rtems__ +#include +#include +#endif +#include +#include + +#include "des.h" + +#define REENTRANT +/* Re-entrantify me -- all this junk needs to be in + * struct crypt_data to make this really reentrant... */ + +/* TS; not really - only the stuff in Des_Context */ +static struct fixed1 { +u_char inv_key_perm[64]; +u_char inv_comp_perm[56]; +u_char u_sbox[8][64]; +u_char un_pbox[32]; +} des1_f; +static struct fixed2 { +u_int32_t ip_maskl[8][256], ip_maskr[8][256]; +} des2_f; +static struct fixed3 { +u_int32_t fp_maskl[8][256], fp_maskr[8][256]; +} des3_f; +static struct fixed4 { +u_int32_t key_perm_maskl[8][128], key_perm_maskr[8][128]; +u_int32_t comp_maskl[8][128], comp_maskr[8][128]; +} des4_f; + +#define inv_key_perm des1_f.inv_key_perm +#define inv_comp_perm des1_f.inv_comp_perm +#define u_sbox des1_f.u_sbox +#define un_pbox des1_f.un_pbox +#define ip_maskl des2_f.ip_maskl +#define ip_maskr des2_f.ip_maskr +#define fp_maskl des3_f.fp_maskl +#define fp_maskr des3_f.fp_maskr +#define key_perm_maskl des4_f.key_perm_maskl +#define key_perm_maskr des4_f.key_perm_maskr +#define comp_maskl des4_f.comp_maskl +#define comp_maskr des4_f.comp_maskr + +/* These need to be maintained per-process */ +struct Des_Context { +u_int32_t en_keysl[16], en_keysr[16]; +u_int32_t de_keysl[16], de_keysr[16]; +u_int32_t saltbits; +u_int32_t old_salt; +u_int32_t old_rawkey0, old_rawkey1; +}; + +#ifndef REENTRANT +static struct Des_Context single; +#endif + +#define en_keysl des_ctx->en_keysl +#define en_keysr des_ctx->en_keysr +#define de_keysl des_ctx->de_keysl +#define de_keysr des_ctx->de_keysr +#define saltbits des_ctx->saltbits +#define old_salt des_ctx->old_salt +#define old_rawkey0 des_ctx->old_rawkey0 +#define old_rawkey1 des_ctx->old_rawkey1 + +/* Static stuff that stays resident and doesn't change after + * being initialized, and therefore doesn't need to be made + * reentrant. */ +static u_char init_perm[64], final_perm[64]; +static u_char m_sbox[4][4096]; +static u_int32_t psbox[4][256]; + + + + +/* A pile of data */ +static const u_char ascii64[] = "./0123456789ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz"; + +static const u_char IP[64] = { + 58, 50, 42, 34, 26, 18, 10, 2, 60, 52, 44, 36, 28, 20, 12, 4, + 62, 54, 46, 38, 30, 22, 14, 6, 64, 56, 48, 40, 32, 24, 16, 8, + 57, 49, 41, 33, 25, 17, 9, 1, 59, 51, 43, 35, 27, 19, 11, 3, + 61, 53, 45, 37, 29, 21, 13, 5, 63, 55, 47, 39, 31, 23, 15, 7 +}; + +static const u_char key_perm[56] = { + 57, 49, 41, 33, 25, 17, 9, 1, 58, 50, 42, 34, 26, 18, + 10, 2, 59, 51, 43, 35, 27, 19, 11, 3, 60, 52, 44, 36, + 63, 55, 47, 39, 31, 23, 15, 7, 62, 54, 46, 38, 30, 22, + 14, 6, 61, 53, 45, 37, 29, 21, 13, 5, 28, 20, 12, 4 +}; + +static const u_char key_shifts[16] = { + 1, 1, 2, 2, 2, 2, 2, 2, 1, 2, 2, 2, 2, 2, 2, 1 +}; + +static const u_char comp_perm[48] = { + 14, 17, 11, 24, 1, 5, 3, 28, 15, 6, 21, 10, + 23, 19, 12, 4, 26, 8, 16, 7, 27, 20, 13, 2, + 41, 52, 31, 37, 47, 55, 30, 40, 51, 45, 33, 48, + 44, 49, 39, 56, 34, 53, 46, 42, 50, 36, 29, 32 +}; + +/* + * No E box is used, as it's replaced by some ANDs, shifts, and ORs. + */ + +static const u_char sbox[8][64] = { + { + 14, 4, 13, 1, 2, 15, 11, 8, 3, 10, 6, 12, 5, 9, 0, 7, + 0, 15, 7, 4, 14, 2, 13, 1, 10, 6, 12, 11, 9, 5, 3, 8, + 4, 1, 14, 8, 13, 6, 2, 11, 15, 12, 9, 7, 3, 10, 5, 0, + 15, 12, 8, 2, 4, 9, 1, 7, 5, 11, 3, 14, 10, 0, 6, 13 + }, + { + 15, 1, 8, 14, 6, 11, 3, 4, 9, 7, 2, 13, 12, 0, 5, 10, + 3, 13, 4, 7, 15, 2, 8, 14, 12, 0, 1, 10, 6, 9, 11, 5, + 0, 14, 7, 11, 10, 4, 13, 1, 5, 8, 12, 6, 9, 3, 2, 15, + 13, 8, 10, 1, 3, 15, 4, 2, 11, 6, 7, 12, 0, 5, 14, 9 + }, + { + 10, 0, 9, 14, 6, 3, 15, 5, 1, 13, 12, 7, 11, 4, 2, 8, + 13, 7, 0, 9, 3, 4, 6, 10, 2, 8, 5, 14, 12, 11, 15, 1, + 13, 6, 4, 9, 8, 15, 3, 0, 11, 1, 2, 12, 5, 10, 14, 7, + 1, 10, 13, 0, 6, 9, 8, 7, 4, 15, 14, 3, 11, 5, 2, 12 + }, + { + 7, 13, 14, 3, 0, 6, 9, 10, 1, 2, 8, 5, 11, 12, 4, 15, + 13, 8, 11, 5, 6, 15, 0, 3, 4, 7, 2, 12, 1, 10, 14, 9, + 10, 6, 9, 0, 12, 11, 7, 13, 15, 1, 3, 14, 5, 2, 8, 4, + 3, 15, 0, 6, 10, 1, 13, 8, 9, 4, 5, 11, 12, 7, 2, 14 + }, + { + 2, 12, 4, 1, 7, 10, 11, 6, 8, 5, 3, 15, 13, 0, 14, 9, + 14, 11, 2, 12, 4, 7, 13, 1, 5, 0, 15, 10, 3, 9, 8, 6, + 4, 2, 1, 11, 10, 13, 7, 8, 15, 9, 12, 5, 6, 3, 0, 14, + 11, 8, 12, 7, 1, 14, 2, 13, 6, 15, 0, 9, 10, 4, 5, 3 + }, + { + 12, 1, 10, 15, 9, 2, 6, 8, 0, 13, 3, 4, 14, 7, 5, 11, + 10, 15, 4, 2, 7, 12, 9, 5, 6, 1, 13, 14, 0, 11, 3, 8, + 9, 14, 15, 5, 2, 8, 12, 3, 7, 0, 4, 10, 1, 13, 11, 6, + 4, 3, 2, 12, 9, 5, 15, 10, 11, 14, 1, 7, 6, 0, 8, 13 + }, + { + 4, 11, 2, 14, 15, 0, 8, 13, 3, 12, 9, 7, 5, 10, 6, 1, + 13, 0, 11, 7, 4, 9, 1, 10, 14, 3, 5, 12, 2, 15, 8, 6, + 1, 4, 11, 13, 12, 3, 7, 14, 10, 15, 6, 8, 0, 5, 9, 2, + 6, 11, 13, 8, 1, 4, 10, 7, 9, 5, 0, 15, 14, 2, 3, 12 + }, + { + 13, 2, 8, 4, 6, 15, 11, 1, 10, 9, 3, 14, 5, 0, 12, 7, + 1, 15, 13, 8, 10, 3, 7, 4, 12, 5, 6, 11, 0, 14, 9, 2, + 7, 11, 4, 1, 9, 12, 14, 2, 0, 6, 10, 13, 15, 3, 5, 8, + 2, 1, 14, 7, 4, 10, 8, 13, 15, 12, 9, 0, 3, 5, 6, 11 + } +}; + +static const u_char pbox[32] = { + 16, 7, 20, 21, 29, 12, 28, 17, 1, 15, 23, 26, 5, 18, 31, 10, + 2, 8, 24, 14, 32, 27, 3, 9, 19, 13, 30, 6, 22, 11, 4, 25 +}; + +static const u_int32_t bits32[32] = +{ + 0x80000000, 0x40000000, 0x20000000, 0x10000000, + 0x08000000, 0x04000000, 0x02000000, 0x01000000, + 0x00800000, 0x00400000, 0x00200000, 0x00100000, + 0x00080000, 0x00040000, 0x00020000, 0x00010000, + 0x00008000, 0x00004000, 0x00002000, 0x00001000, + 0x00000800, 0x00000400, 0x00000200, 0x00000100, + 0x00000080, 0x00000040, 0x00000020, 0x00000010, + 0x00000008, 0x00000004, 0x00000002, 0x00000001 +}; + +static const u_char bits8[8] = { 0x80, 0x40, 0x20, 0x10, 0x08, 0x04, 0x02, 0x01 }; +static const u_int32_t *bits28, *bits24; + + +static int +ascii_to_bin(char ch) +{ + if (ch > 'z') + return(0); + if (ch >= 'a') + return(ch - 'a' + 38); + if (ch > 'Z') + return(0); + if (ch >= 'A') + return(ch - 'A' + 12); + if (ch > '9') + return(0); + if (ch >= '.') + return(ch - '.'); + return(0); +} + +static struct Des_Context * +des_ctx_init(void) +{ +struct Des_Context *des_ctx; +#ifdef REENTRANT + des_ctx = malloc(sizeof(*des_ctx)); +#else + des_ctx = &single; +#endif + old_rawkey0 = old_rawkey1 = 0L; + saltbits = 0L; + old_salt = 0L; + + return des_ctx; +} + +static void +des_init(void) +{ + int i, j, b, k, inbit, obit; + u_int32_t *p, *il, *ir, *fl, *fr; + static int des_initialised = 0; + + if (des_initialised==1) + return; + +#ifndef REENTRANT + des_ctx_init(); +#endif + + bits24 = (bits28 = bits32 + 4) + 4; + + /* + * Invert the S-boxes, reordering the input bits. + */ + for (i = 0; i < 8; i++) + for (j = 0; j < 64; j++) { + b = (j & 0x20) | ((j & 1) << 4) | ((j >> 1) & 0xf); + u_sbox[i][j] = sbox[i][b]; + } + + /* + * Convert the inverted S-boxes into 4 arrays of 8 bits. + * Each will handle 12 bits of the S-box input. + */ + for (b = 0; b < 4; b++) + for (i = 0; i < 64; i++) + for (j = 0; j < 64; j++) + m_sbox[b][(i << 6) | j] = + (u_char)((u_sbox[(b << 1)][i] << 4) | + u_sbox[(b << 1) + 1][j]); + + /* + * Set up the initial & final permutations into a useful form, and + * initialise the inverted key permutation. + */ + for (i = 0; i < 64; i++) { + init_perm[final_perm[i] = IP[i] - 1] = (u_char)i; + inv_key_perm[i] = 255; + } + + /* + * Invert the key permutation and initialise the inverted key + * compression permutation. + */ + for (i = 0; i < 56; i++) { + inv_key_perm[key_perm[i] - 1] = (u_char)i; + inv_comp_perm[i] = 255; + } + + /* + * Invert the key compression permutation. + */ + for (i = 0; i < 48; i++) { + inv_comp_perm[comp_perm[i] - 1] = (u_char)i; + } + + /* + * Set up the OR-mask arrays for the initial and final permutations, + * and for the key initial and compression permutations. + */ + for (k = 0; k < 8; k++) { + for (i = 0; i < 256; i++) { + *(il = &ip_maskl[k][i]) = 0L; + *(ir = &ip_maskr[k][i]) = 0L; + *(fl = &fp_maskl[k][i]) = 0L; + *(fr = &fp_maskr[k][i]) = 0L; + for (j = 0; j < 8; j++) { + inbit = 8 * k + j; + if (i & bits8[j]) { + if ((obit = init_perm[inbit]) < 32) + *il |= bits32[obit]; + else + *ir |= bits32[obit-32]; + if ((obit = final_perm[inbit]) < 32) + *fl |= bits32[obit]; + else + *fr |= bits32[obit - 32]; + } + } + } + for (i = 0; i < 128; i++) { + *(il = &key_perm_maskl[k][i]) = 0L; + *(ir = &key_perm_maskr[k][i]) = 0L; + for (j = 0; j < 7; j++) { + inbit = 8 * k + j; + if (i & bits8[j + 1]) { + if ((obit = inv_key_perm[inbit]) == 255) + continue; + if (obit < 28) + *il |= bits28[obit]; + else + *ir |= bits28[obit - 28]; + } + } + *(il = &comp_maskl[k][i]) = 0L; + *(ir = &comp_maskr[k][i]) = 0L; + for (j = 0; j < 7; j++) { + inbit = 7 * k + j; + if (i & bits8[j + 1]) { + if ((obit=inv_comp_perm[inbit]) == 255) + continue; + if (obit < 24) + *il |= bits24[obit]; + else + *ir |= bits24[obit - 24]; + } + } + } + } + + /* + * Invert the P-box permutation, and convert into OR-masks for + * handling the output of the S-box arrays setup above. + */ + for (i = 0; i < 32; i++) + un_pbox[pbox[i] - 1] = (u_char)i; + + for (b = 0; b < 4; b++) + for (i = 0; i < 256; i++) { + *(p = &psbox[b][i]) = 0L; + for (j = 0; j < 8; j++) { + if (i & bits8[j]) + *p |= bits32[un_pbox[8 * b + j]]; + } + } + + des_initialised = 1; +} + + +static void +setup_salt(long salt, struct Des_Context *des_ctx) +{ + u_int32_t obit, saltbit; + int i; + + if (salt == old_salt) + return; + old_salt = salt; + + saltbits = 0L; + saltbit = 1; + obit = 0x800000; + for (i = 0; i < 24; i++) { + if (salt & saltbit) + saltbits |= obit; + saltbit <<= 1; + obit >>= 1; + } +} + + +static int +des_setkey(const char *key, struct Des_Context *des_ctx) +{ + u_int32_t k0, k1, rawkey0, rawkey1; + int shifts, round; + + des_init(); + + rawkey0 = ntohl(*(const u_int32_t *) key); + rawkey1 = ntohl(*(const u_int32_t *) (key + 4)); + + if ((rawkey0 | rawkey1) + && rawkey0 == old_rawkey0 + && rawkey1 == old_rawkey1) { + /* + * Already setup for this key. + * This optimisation fails on a zero key (which is weak and + * has bad parity anyway) in order to simplify the starting + * conditions. + */ + return(0); + } + old_rawkey0 = rawkey0; + old_rawkey1 = rawkey1; + + /* + * Do key permutation and split into two 28-bit subkeys. + */ + k0 = key_perm_maskl[0][rawkey0 >> 25] + | key_perm_maskl[1][(rawkey0 >> 17) & 0x7f] + | key_perm_maskl[2][(rawkey0 >> 9) & 0x7f] + | key_perm_maskl[3][(rawkey0 >> 1) & 0x7f] + | key_perm_maskl[4][rawkey1 >> 25] + | key_perm_maskl[5][(rawkey1 >> 17) & 0x7f] + | key_perm_maskl[6][(rawkey1 >> 9) & 0x7f] + | key_perm_maskl[7][(rawkey1 >> 1) & 0x7f]; + k1 = key_perm_maskr[0][rawkey0 >> 25] + | key_perm_maskr[1][(rawkey0 >> 17) & 0x7f] + | key_perm_maskr[2][(rawkey0 >> 9) & 0x7f] + | key_perm_maskr[3][(rawkey0 >> 1) & 0x7f] + | key_perm_maskr[4][rawkey1 >> 25] + | key_perm_maskr[5][(rawkey1 >> 17) & 0x7f] + | key_perm_maskr[6][(rawkey1 >> 9) & 0x7f] + | key_perm_maskr[7][(rawkey1 >> 1) & 0x7f]; + /* + * Rotate subkeys and do compression permutation. + */ + shifts = 0; + for (round = 0; round < 16; round++) { + u_int32_t t0, t1; + + shifts += key_shifts[round]; + + t0 = (k0 << shifts) | (k0 >> (28 - shifts)); + t1 = (k1 << shifts) | (k1 >> (28 - shifts)); + + de_keysl[15 - round] = + en_keysl[round] = comp_maskl[0][(t0 >> 21) & 0x7f] + | comp_maskl[1][(t0 >> 14) & 0x7f] + | comp_maskl[2][(t0 >> 7) & 0x7f] + | comp_maskl[3][t0 & 0x7f] + | comp_maskl[4][(t1 >> 21) & 0x7f] + | comp_maskl[5][(t1 >> 14) & 0x7f] + | comp_maskl[6][(t1 >> 7) & 0x7f] + | comp_maskl[7][t1 & 0x7f]; + + de_keysr[15 - round] = + en_keysr[round] = comp_maskr[0][(t0 >> 21) & 0x7f] + | comp_maskr[1][(t0 >> 14) & 0x7f] + | comp_maskr[2][(t0 >> 7) & 0x7f] + | comp_maskr[3][t0 & 0x7f] + | comp_maskr[4][(t1 >> 21) & 0x7f] + | comp_maskr[5][(t1 >> 14) & 0x7f] + | comp_maskr[6][(t1 >> 7) & 0x7f] + | comp_maskr[7][t1 & 0x7f]; + } + return(0); +} + + +static int +do_des( u_int32_t l_in, u_int32_t r_in, u_int32_t *l_out, u_int32_t *r_out, int count, struct Des_Context *des_ctx) +{ + /* + * l_in, r_in, l_out, and r_out are in pseudo-"big-endian" format. + */ + u_int32_t l, r, *kl, *kr, *kl1, *kr1; + u_int32_t f, r48l, r48r; + int round; + + if (count == 0) { + return(1); + } else if (count > 0) { + /* + * Encrypting + */ + kl1 = en_keysl; + kr1 = en_keysr; + } else { + /* + * Decrypting + */ + count = -count; + kl1 = de_keysl; + kr1 = de_keysr; + } + + /* + * Do initial permutation (IP). + */ + l = ip_maskl[0][l_in >> 24] + | ip_maskl[1][(l_in >> 16) & 0xff] + | ip_maskl[2][(l_in >> 8) & 0xff] + | ip_maskl[3][l_in & 0xff] + | ip_maskl[4][r_in >> 24] + | ip_maskl[5][(r_in >> 16) & 0xff] + | ip_maskl[6][(r_in >> 8) & 0xff] + | ip_maskl[7][r_in & 0xff]; + r = ip_maskr[0][l_in >> 24] + | ip_maskr[1][(l_in >> 16) & 0xff] + | ip_maskr[2][(l_in >> 8) & 0xff] + | ip_maskr[3][l_in & 0xff] + | ip_maskr[4][r_in >> 24] + | ip_maskr[5][(r_in >> 16) & 0xff] + | ip_maskr[6][(r_in >> 8) & 0xff] + | ip_maskr[7][r_in & 0xff]; + + while (count--) { + /* + * Do each round. + */ + kl = kl1; + kr = kr1; + round = 16; + while (round--) { + /* + * Expand R to 48 bits (simulate the E-box). + */ + r48l = ((r & 0x00000001) << 23) + | ((r & 0xf8000000) >> 9) + | ((r & 0x1f800000) >> 11) + | ((r & 0x01f80000) >> 13) + | ((r & 0x001f8000) >> 15); + + r48r = ((r & 0x0001f800) << 7) + | ((r & 0x00001f80) << 5) + | ((r & 0x000001f8) << 3) + | ((r & 0x0000001f) << 1) + | ((r & 0x80000000) >> 31); + /* + * Do salting for crypt() and friends, and + * XOR with the permuted key. + */ + f = (r48l ^ r48r) & saltbits; + r48l ^= f ^ *kl++; + r48r ^= f ^ *kr++; + /* + * Do sbox lookups (which shrink it back to 32 bits) + * and do the pbox permutation at the same time. + */ + f = psbox[0][m_sbox[0][r48l >> 12]] + | psbox[1][m_sbox[1][r48l & 0xfff]] + | psbox[2][m_sbox[2][r48r >> 12]] + | psbox[3][m_sbox[3][r48r & 0xfff]]; + /* + * Now that we've permuted things, complete f(). + */ + f ^= l; + l = r; + r = f; + } + r = l; + l = f; + } + /* + * Do final permutation (inverse of IP). + */ + *l_out = fp_maskl[0][l >> 24] + | fp_maskl[1][(l >> 16) & 0xff] + | fp_maskl[2][(l >> 8) & 0xff] + | fp_maskl[3][l & 0xff] + | fp_maskl[4][r >> 24] + | fp_maskl[5][(r >> 16) & 0xff] + | fp_maskl[6][(r >> 8) & 0xff] + | fp_maskl[7][r & 0xff]; + *r_out = fp_maskr[0][l >> 24] + | fp_maskr[1][(l >> 16) & 0xff] + | fp_maskr[2][(l >> 8) & 0xff] + | fp_maskr[3][l & 0xff] + | fp_maskr[4][r >> 24] + | fp_maskr[5][(r >> 16) & 0xff] + | fp_maskr[6][(r >> 8) & 0xff] + | fp_maskr[7][r & 0xff]; + return(0); +} + + +#if 0 +static int +des_cipher(const char *in, char *out, u_int32_t salt, int count) +{ + u_int32_t l_out, r_out, rawl, rawr; + int retval; + union { + u_int32_t *ui32; + const char *c; + } trans; + + des_init(); + + setup_salt(salt); + + trans.c = in; + rawl = ntohl(*trans.ui32++); + rawr = ntohl(*trans.ui32); + + retval = do_des(rawl, rawr, &l_out, &r_out, count); + + trans.c = out; + *trans.ui32++ = htonl(l_out); + *trans.ui32 = htonl(r_out); + return(retval); +} +#endif + + +#ifndef REENTRANT +void +setkey(const char *key) +{ + int i, j; + u_int32_t packed_keys[2]; + u_char *p; + + p = (u_char *) packed_keys; + + for (i = 0; i < 8; i++) { + p[i] = 0; + for (j = 0; j < 8; j++) + if (*key++ & 1) + p[i] |= bits8[j]; + } + des_setkey(p, &single); +} +#endif + + +#ifndef REENTRANT +void +encrypt(char *block, int flag) +{ + u_int32_t io[2]; + u_char *p; + int i, j; + + des_init(); + + setup_salt(0L, &single); + p = block; + for (i = 0; i < 2; i++) { + io[i] = 0L; + for (j = 0; j < 32; j++) + if (*p++ & 1) + io[i] |= bits32[j]; + } + do_des(io[0], io[1], io, io + 1, flag ? -1 : 1, &single); + for (i = 0; i < 2; i++) + for (j = 0; j < 32; j++) + block[(i << 5) | j] = (io[i] & bits32[j]) ? 1 : 0; +} + +#endif + +char * +__des_crypt_r(const char *key, const char *setting, char *output, int sz) +{ + char *rval = 0; + struct Des_Context *des_ctx; + u_int32_t count, salt, l, r0, r1, keybuf[2]; + u_char *p, *q; + + if (sz < 21) + return NULL; + + des_init(); + des_ctx = des_ctx_init(); + + /* + * Copy the key, shifting each character up by one bit + * and padding with zeros. + */ + q = (u_char *)keybuf; + while (q - (u_char *)keybuf - 8) { + *q++ = *key << 1; + if (*(q - 1)) + key++; + } + if (des_setkey((char *)keybuf, des_ctx)) + goto bailout; + +#if 0 + if (*setting == _PASSWORD_EFMT1) { + int i; + /* + * "new"-style: + * setting - underscore, 4 bytes of count, 4 bytes of salt + * key - unlimited characters + */ + for (i = 1, count = 0L; i < 5; i++) + count |= ascii_to_bin(setting[i]) << ((i - 1) * 6); + + for (i = 5, salt = 0L; i < 9; i++) + salt |= ascii_to_bin(setting[i]) << ((i - 5) * 6); + + while (*key) { + /* + * Encrypt the key with itself. + */ + if (des_cipher((char *)keybuf, (char *)keybuf, 0L, 1)) + goto bailout; + /* + * And XOR with the next 8 characters of the key. + */ + q = (u_char *)keybuf; + while (q - (u_char *)keybuf - 8 && *key) + *q++ ^= *key++ << 1; + + if (des_setkey((char *)keybuf)) + goto bailout; + } + strncpy(output, setting, 9); + + /* + * Double check that we weren't given a short setting. + * If we were, the above code will probably have created + * wierd values for count and salt, but we don't really care. + * Just make sure the output string doesn't have an extra + * NUL in it. + */ + output[9] = '\0'; + p = (u_char *)output + strlen(output); + } else +#endif + { + /* + * "old"-style: + * setting - 2 bytes of salt + * key - up to 8 characters + */ + count = 25; + + salt = (ascii_to_bin(setting[1]) << 6) + | ascii_to_bin(setting[0]); + + output[0] = setting[0]; + /* + * If the encrypted password that the salt was extracted from + * is only 1 character long, the salt will be corrupted. We + * need to ensure that the output string doesn't have an extra + * NUL in it! + */ + output[1] = setting[1] ? setting[1] : output[0]; + + p = (u_char *)output + 2; + } + setup_salt(salt, des_ctx); + /* + * Do it. + */ + if (do_des(0L, 0L, &r0, &r1, (int)count, des_ctx)) + goto bailout; + /* + * Now encode the result... + */ + l = (r0 >> 8); + *p++ = ascii64[(l >> 18) & 0x3f]; + *p++ = ascii64[(l >> 12) & 0x3f]; + *p++ = ascii64[(l >> 6) & 0x3f]; + *p++ = ascii64[l & 0x3f]; + + l = (r0 << 16) | ((r1 >> 16) & 0xffff); + *p++ = ascii64[(l >> 18) & 0x3f]; + *p++ = ascii64[(l >> 12) & 0x3f]; + *p++ = ascii64[(l >> 6) & 0x3f]; + *p++ = ascii64[l & 0x3f]; + + l = r1 << 2; + *p++ = ascii64[(l >> 12) & 0x3f]; + *p++ = ascii64[(l >> 6) & 0x3f]; + *p++ = ascii64[l & 0x3f]; + *p = 0; + + rval = output; +bailout: + free(des_ctx); + return rval; +} + +#ifdef DEBUG + +void +des_snap(void **pf, void **pd) +{ + uint8* pfc; + *pf = malloc(sizeof(struct fixed1) + sizeof(struct fixed2) + sizeof(struct fixed3) + sizeof(struct fixed4)); + pfc = *pf; + memcpy(pfc, &des1_f, sizeof(des1_f)); + pfc += sizeof(des1_f); + memcpy(pfc, &des2_f, sizeof(des2_f)); + pfc += sizeof(des2_f); + memcpy(pfc, &des3_f, sizeof(des3_f)); + pfc += sizeof(des3_f); + memcpy(pfc, &des4_f, sizeof(des4_f)); +// *pd = malloc(sizeof(struct Des_Context)); +// memcpy(*pd, &des_ctx, sizeof(des_ctx)); +} + +void +des_check(void *pf, void *pd) +{ + uint8* pfc1, pfc2, pfc3, pfc4; + pfc1 = pf; + pfc2 = pfc1 + sizeof(des1_f); + pfc3 = pfc2 + sizeof(des2_f); + pfc4 = pfc3 + sizeof(des3_f); + printf("Fixed: do%s differ"/*", Context: do%s differ"*/"\n", + (memcmp(pfc1, &des1_f, sizeof(des1_f)) || + memcmp(pfc2, &des2_f, sizeof(des2_f)) || + memcmp(pfc3, &des4_f, sizeof(des3_f)) || + memcmp(pfc4, &des4_f, sizeof(des4_f))) ? "" : "nt"); +} + +#endif diff --git a/rtemsbsd/telnetd/des.h b/rtemsbsd/telnetd/des.h new file mode 100644 index 00000000..382dab7a --- /dev/null +++ b/rtemsbsd/telnetd/des.h @@ -0,0 +1 @@ +char *__des_crypt_r(const char *, const char *, char *, int); diff --git a/rtemsbsd/telnetd/genpw.c b/rtemsbsd/telnetd/genpw.c new file mode 100644 index 00000000..1cb30bc6 --- /dev/null +++ b/rtemsbsd/telnetd/genpw.c @@ -0,0 +1,79 @@ +/* + * Authorship + * ---------- + * This software was created by + * Till Straumann , 2003-2007 + * Stanford Linear Accelerator Center, Stanford University. + * + * Acknowledgement of sponsorship + * ------------------------------ + * This software was produced by + * the Stanford Linear Accelerator Center, Stanford University, + * under Contract DE-AC03-76SFO0515 with the Department of Energy. + * + * Government disclaimer of liability + * ---------------------------------- + * Neither the United States nor the United States Department of Energy, + * nor any of their employees, makes any warranty, express or implied, or + * assumes any legal liability or responsibility for the accuracy, + * completeness, or usefulness of any data, apparatus, product, or process + * disclosed, or represents that its use would not infringe privately owned + * rights. + * + * Stanford disclaimer of liability + * -------------------------------- + * Stanford University makes no representations or warranties, express or + * implied, nor assumes any liability for the use of this software. + * + * Stanford disclaimer of copyright + * -------------------------------- + * Stanford University, owner of the copyright, hereby disclaims its + * copyright and all other rights in this software. Hence, anyone may + * freely use it for any purpose without restriction. + * + * Maintenance of notices + * ---------------------- + * In the interest of clarity regarding the origin and status of this + * SLAC software, this and all the preceding Stanford University notices + * are to remain affixed to any copy or derivative of this software made + * or distributed by the recipient and are to be affixed to any copy of + * software made or distributed by the recipient that contains a copy or + * derivative of this software. + * + * ------------------ SLAC Software Notices, Set 4 OTT.002a, 2004 FEB 03 + */ + +#ifdef HAVE_CONFIG_H +#include "config.h" +#endif + +#include +#include +#include + +static void +usage(char *nm) +{ + fprintf(stderr,"Usage: %s [-h] [-s salt] cleartext_password\n", nm); +} + +int +main(int argc, char **argv) +{ +int ch; +char *salt="td"; + while ( (ch=getopt(argc, argv, "hs:")) >=0 ) { + switch (ch) { + default: fprintf(stderr,"Unknown Option '%c'\n",ch); + case 'h': usage(argv[0]); + return 0; + case 's': salt=optarg; + break; + } + } + if ( optind >= argc ) { + usage(argv[0]); + return 1; + } + printf("#define TELNETD_DEFAULT_PASSWD \"%s\"\n",crypt(argv[optind],salt)); +} diff --git a/rtemsbsd/telnetd/pty.c b/rtemsbsd/telnetd/pty.c new file mode 100644 index 00000000..a593bbd2 --- /dev/null +++ b/rtemsbsd/telnetd/pty.c @@ -0,0 +1,401 @@ +/* + * /dev/ptyXX (Support for pseudo-terminals) + * + * Original Author: Fernando RUIZ CASAS (fernando.ruiz@ctv.es) + * May 2001 + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. + * + * Till Straumann + * + * - converted into a loadable module + * - NAWS support / ioctls for querying/setting the window + * size added. + * - don't delete the running task when the connection + * is closed. Rather let 'read()' return a 0 count so + * they may cleanup. Some magic hack works around termios + * limitation. + */ + +#ifdef HAVE_CONFIG_H +#include "config.h" +#endif + +#define DEBUG_WH (1<<0) +#define DEBUG_DETAIL (1<<1) + +/* #define DEBUG DEBUG_WH */ + +/*-----------------------------------------*/ +#include +#include +#include +#include +#include +/*-----------------------------------------*/ +#include +#include +#include +#include +#include +#include +/*-----------------------------------------*/ +#define IAC_ESC 255 +#define IAC_DONT 254 +#define IAC_DO 253 +#define IAC_WONT 252 +#define IAC_WILL 251 +#define IAC_SB 250 +#define IAC_GA 249 +#define IAC_EL 248 +#define IAC_EC 247 +#define IAC_AYT 246 +#define IAC_AO 245 +#define IAC_IP 244 +#define IAC_BRK 243 +#define IAC_DMARK 242 +#define IAC_NOP 241 +#define IAC_SE 240 +#define IAC_EOR 239 + +#define SB_MAX RTEMS_PTY_SB_MAX + +static bool ptyPollInitialize(rtems_termios_tty *, + rtems_termios_device_context *, struct termios *, + rtems_libio_open_close_args_t *); +static void ptyShutdown(rtems_termios_tty *, + rtems_termios_device_context *, rtems_libio_open_close_args_t *); +static void ptyPollWrite(rtems_termios_device_context *, const char *, size_t); +static int ptyPollRead(rtems_termios_device_context *); +static bool ptySetAttributes(rtems_termios_device_context *, + const struct termios *); +static int my_pty_control(rtems_termios_device_context *, + ioctl_command_t, void *); + +static const rtems_termios_device_handler pty_handler = { + .first_open = ptyPollInitialize, + .last_close = ptyShutdown, + .poll_read = ptyPollRead, + .write = ptyPollWrite, + .set_attributes = ptySetAttributes, + .ioctl = my_pty_control +}; + +static +int send_iac(rtems_pty_context *pty, unsigned char mode, unsigned char option) +{ + unsigned char buf[3]; + + buf[0]=IAC_ESC; + buf[1]=mode; + buf[2]=option; + return write(pty->socket, buf, sizeof(buf)); +} + +const char *rtems_pty_initialize(rtems_pty_context *pty, uintptr_t unique) +{ + rtems_status_code sc; + + memset(pty, 0, sizeof(*pty)); + (void)snprintf(pty->name, sizeof(pty->name), "/dev/pty%" PRIuPTR, unique); + rtems_termios_device_context_initialize(&pty->base, "pty"); + pty->socket = -1; + sc = rtems_termios_device_install(pty->name, &pty_handler, NULL, &pty->base); + if (sc != RTEMS_SUCCESSFUL) { + return NULL; + } + + return pty->name; +} + +void rtems_pty_close_socket(rtems_pty_context *pty) +{ + if (pty->socket >= 0) { + (void)close(pty->socket); + pty->socket = -1; + } +} + +void rtems_pty_set_socket(rtems_pty_context *pty, int socket) +{ + struct timeval t; + + rtems_pty_close_socket(pty); + pty->socket = socket; + + /* set a long polling interval to save CPU time */ + t.tv_sec=2; + t.tv_usec=00000; + (void)setsockopt(socket, SOL_SOCKET, SO_RCVTIMEO, &t, sizeof(t)); + + /* inform the client that we will echo */ + send_iac(pty, IAC_WILL, 1); +} + +/*-----------------------------------------------------------*/ +/* + * The NVT terminal is negociated in PollRead and PollWrite + * with every BYTE sendded or received. + * A litle status machine in the pty_read_byte(int minor) + * + */ +static const char IAC_AYT_RSP[]="\r\nAYT? Yes, RTEMS-SHELL is here\r\n"; +static const char IAC_BRK_RSP[]="<*Break*>"; +static const char IAC_IP_RSP []="<*Interrupt*>"; + +static int +handleSB(rtems_pty_context *pty) +{ + switch (pty->sb_buf[0]) { + case 31: /* NAWS */ + pty->width = (pty->sb_buf[1]<<8) + pty->sb_buf[2]; + pty->height = (pty->sb_buf[3]<<8) + pty->sb_buf[4]; +#if DEBUG & DEBUG_WH + fprintf(stderr, + "Setting width/height to %ix%i\n", + pty->width, + pty->height); +#endif + break; + default: + break; + } + return 0; +} + +static int ptyPollRead(rtems_termios_device_context *base) +{ /* Characters written to the client side*/ + rtems_pty_context *pty = (rtems_pty_context *)base; + unsigned char value; + unsigned int omod; + int count; + int result; + + count=read(pty->socket,&value,sizeof(value)); + if (count<0) + return -1; + + if (count<1) { + /* Unfortunately, there is no way of passing an EOF + * condition through the termios driver. Hence, we + * resort to an ugly hack. Setting cindex>ccount + * causes the termios driver to return a read count + * of '0' which is what we want here. We leave + * 'errno' untouched. + */ + pty->ttyp->cindex=pty->ttyp->ccount+1; + return pty->ttyp->termios.c_cc[VEOF]; + }; + + omod=pty->iac_mode; + pty->iac_mode=0; + switch(omod & 0xff) { + case IAC_ESC: + switch(value) { + case IAC_ESC : + /* in case this is an ESC ESC sequence in SB mode */ + pty->iac_mode = omod>>8; + return IAC_ESC; + case IAC_DONT: + case IAC_DO : + case IAC_WONT: + case IAC_WILL: + pty->iac_mode=value; + return -1; + case IAC_SB : +#if DEBUG & DEBUG_DETAIL + printk("SB\n"); +#endif + pty->iac_mode=value; + pty->sb_ind=0; + return -100; + case IAC_GA : + return -1; + case IAC_EL : + return 0x03; /* Ctrl-C*/ + case IAC_EC : + return '\b'; + case IAC_AYT : + write(pty->socket,IAC_AYT_RSP,strlen(IAC_AYT_RSP)); + return -1; + case IAC_AO : + return -1; + case IAC_IP : + write(pty->socket,IAC_IP_RSP,strlen(IAC_IP_RSP)); + return -1; + case IAC_BRK : + write(pty->socket,IAC_BRK_RSP,strlen(IAC_BRK_RSP)); + return -1; + case IAC_DMARK: + return -2; + case IAC_NOP : + return -1; + case IAC_SE : +#if DEBUG & DEBUG_DETAIL + { + int i; + printk("SE"); + for (i=0; isb_ind; i++) + printk(" %02x",pty->sb_buf[i]); + printk("\n"); + } +#endif + handleSB(pty); + return -101; + case IAC_EOR : + return -102; + default : + return -1; + }; + break; + + case IAC_SB: + pty->iac_mode=omod; + if (IAC_ESC==value) { + pty->iac_mode=(omod<<8)|value; + } else { + if (pty->sb_ind < SB_MAX) + pty->sb_buf[pty->sb_ind++]=value; + } + return -1; + + case IAC_WILL: + if (value==34){ + send_iac(pty,IAC_DONT, 34); /*LINEMODE*/ + send_iac(pty,IAC_DO , 1); /*ECHO */ + } else if (value==31) { + send_iac(pty,IAC_DO , 31); /*NAWS */ +#if DEBUG & DEBUG_DETAIL + printk("replied DO NAWS\n"); +#endif + } else { + send_iac(pty,IAC_DONT,value); + } + return -1; + case IAC_DONT: + return -1; + case IAC_DO : + if (value==3) { + send_iac(pty,IAC_WILL, 3); /* GO AHEAD*/ + } else if (value==1) { + send_iac(pty,IAC_WILL, 1); /* ECHO */ + } else { + send_iac(pty,IAC_WONT,value); + }; + return -1; + case IAC_WONT: + if (value==1) { + send_iac(pty,IAC_WILL, 1); + } else { /* ECHO */ + send_iac(pty,IAC_WONT,value); + } + return -1; + default: + if (value==IAC_ESC) { + pty->iac_mode=value; + return -1; + } else { + result=value; + if ( 0 + /* map CRLF to CR for symmetry */ + || ((value=='\n') && pty->last_cr) + /* map telnet CRNUL to CR down here */ + || ((value==0) && pty->last_cr) + ) result=-1; + pty->last_cr=(value=='\r'); + return result; + }; + }; + /* should never get here but keep compiler happy */ + return -1; +} + +/*-----------------------------------------------------------*/ +/* Set the 'Hardware' */ +/*-----------------------------------------------------------*/ +static bool +ptySetAttributes(rtems_termios_device_context *base, const struct termios *t) +{ + rtems_pty_context *pty = (rtems_pty_context *)base; + pty->c_cflag = t->c_cflag; + return true; +} +/*-----------------------------------------------------------*/ +static bool +ptyPollInitialize(rtems_termios_tty *ttyp, + rtems_termios_device_context *base, struct termios *t, + rtems_libio_open_close_args_t *args) +{ + rtems_pty_context *pty = (rtems_pty_context *)base; + pty->ttyp = ttyp; + pty->iac_mode = 0; + pty->sb_ind = 0; + pty->width = 0; + pty->height = 0; + return ptySetAttributes(&pty->base, t); +} +/*-----------------------------------------------------------*/ +static void +ptyShutdown(rtems_termios_tty *ttyp, + rtems_termios_device_context *base, rtems_libio_open_close_args_t *arg) +{ + rtems_pty_context *pty = (rtems_pty_context *)base; + close(pty->socket); +} +/*-----------------------------------------------------------*/ +/* Write Characters into pty device */ +/*-----------------------------------------------------------*/ +static void +ptyPollWrite(rtems_termios_device_context *base, const char *buf, size_t len) +{ + rtems_pty_context *pty = (rtems_pty_context *)base; + + while (len > 0) { + ssize_t n = write(pty->socket, buf, len); + if (n <= 0) { + break; + } + + buf += (size_t)n; + len -= (size_t)n; + } +} + +static int +my_pty_control(rtems_termios_device_context *base, + ioctl_command_t request, void *buffer) +{ + rtems_pty_context *p = (rtems_pty_context *)base; + struct winsize *wp = buffer; + + switch (request) { + case TIOCGWINSZ: + wp->ws_row = p->height; + wp->ws_col = p->width; +#if DEBUG & DEBUG_WH + fprintf(stderr, + "ioctl(TIOCGWINSZ), returning %ix%i\n", + wp->ws_col, + wp->ws_row); +#endif + break; + case TIOCSWINSZ: +#if DEBUG & DEBUG_WH + fprintf(stderr, + "ioctl(TIOCGWINSZ), setting %ix%i\n", + wp->ws_col, + wp->ws_row); +#endif + + p->height = wp->ws_row; + p->width = wp->ws_col; + break; + default: + rtems_set_errno_and_return_minus_one(EINVAL); + break; + } + + return 0; +} diff --git a/rtemsbsd/telnetd/telnetd-init.c b/rtemsbsd/telnetd/telnetd-init.c new file mode 100644 index 00000000..586aaef7 --- /dev/null +++ b/rtemsbsd/telnetd/telnetd-init.c @@ -0,0 +1,18 @@ +/* + * Copyright (c) 2018 embedded brains GmbH. All rights reserved. + * + * The license and distribution terms for this file may be + * found in the file LICENSE in this distribution or at + * http://www.rtems.org/license/LICENSE. + */ + +#ifdef HAVE_CONFIG_H +#include "config.h" +#endif + +#include + +rtems_status_code rtems_telnetd_initialize( void ) +{ + return rtems_telnetd_start( &rtems_telnetd_config ); +} diff --git a/rtemsbsd/telnetd/telnetd.c b/rtemsbsd/telnetd/telnetd.c new file mode 100644 index 00000000..705e0956 --- /dev/null +++ b/rtemsbsd/telnetd/telnetd.c @@ -0,0 +1,449 @@ +/***********************************************************/ +/* + * + * The telnet DAEMON + * + * Author: 17,may 2001 + * + * WORK: fernando.ruiz@ctv.es + * HOME: correo@fernando-ruiz.com + * + * After start the net you can start this daemon. + * It uses the previously inited pseudo-terminales (pty.c) + * getting a new terminal with getpty(). This function + * gives a terminal name passing a opened socket like parameter. + * + * With register_telnetd() you add a new command in the shell to start + * this daemon interactively. (Login in /dev/console of course) + * + * Sorry but OOB is not still implemented. (This is the first version) + * + * Till Straumann + * - made the 'shell' interface more generic, i.e. it is now + * possible to have 'telnetd' run an arbitrary 'shell' + * program. + * + * Copyright (c) 2009, 2018 embedded brains GmbH and others. + * + * embedded brains GmbH + * Dornierstr. 4 + * D-82178 Puchheim + * Germany + * + * + * The license and distribution terms for this file may be + * found in the file LICENSE in this distribution or at + * http://www.rtems.org/license/LICENSE. + */ + +#ifdef HAVE_CONFIG_H +#include "config.h" +#endif + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include +#include +#include +#include +#include + +#define TELNETD_EVENT_SUCCESS RTEMS_EVENT_0 + +#define TELNETD_EVENT_ERROR RTEMS_EVENT_1 + +typedef struct telnetd_context telnetd_context; + +typedef struct telnetd_session { + rtems_pty_context pty; + char peername[16]; + telnetd_context *ctx; + rtems_id task_id; + LIST_ENTRY(telnetd_session) link; +} telnetd_session; + +struct telnetd_context { + rtems_telnetd_config_table config; + int server_socket; + rtems_id task_id; + rtems_mutex mtx; + LIST_HEAD(, telnetd_session) free_sessions; + telnetd_session sessions[RTEMS_ZERO_LENGTH_ARRAY]; +}; + +typedef union { + struct sockaddr_in sin; + struct sockaddr sa; +} telnetd_address; + +RTEMS_NO_RETURN static void telnetd_session_fatal_error( + const telnetd_context *ctx +) +{ + (void)rtems_event_send(ctx->task_id, TELNETD_EVENT_ERROR); + rtems_task_exit(); +} + +static bool telnetd_login(telnetd_context *ctx, telnetd_session *session) +{ + bool success; + + if (ctx->config.login_check == NULL) { + return true; + } + + success = rtems_shell_login_prompt( + stdin, + stderr, + session->pty.name, + ctx->config.login_check + ); + + if (!success) { + syslog( + LOG_AUTHPRIV | LOG_WARNING, + "telnetd: too many wrong passwords entered from %s", + session->peername + ); + } + + return success; +} + +static void telnetd_session_task(rtems_task_argument arg) +{ + rtems_status_code sc; + telnetd_session *session; + telnetd_context *ctx; + const char *path; + + session = (telnetd_session *) arg; + ctx = session->ctx; + + sc = rtems_libio_set_private_env(); + if (sc != RTEMS_SUCCESSFUL) { + telnetd_session_fatal_error(ctx); + } + + path = rtems_pty_get_path(&session->pty); + + stdin = fopen(path, "r+"); + if (stdin == NULL) { + telnetd_session_fatal_error(ctx); + } + + stdout = fopen(path, "r+"); + if (stdout == NULL) { + telnetd_session_fatal_error(ctx); + } + + stderr = fopen(path, "r+"); + if (stderr == NULL) { + telnetd_session_fatal_error(ctx); + } + + (void)rtems_event_send(ctx->task_id, TELNETD_EVENT_SUCCESS); + + while (true) { + rtems_event_set events; + + (void)rtems_event_system_receive( + RTEMS_EVENT_SYSTEM_SERVER, + RTEMS_WAIT | RTEMS_EVENT_ALL, + RTEMS_NO_TIMEOUT, + &events + ); + + syslog( + LOG_DAEMON | LOG_INFO, + "telnetd: accepted connection from %s on %s", + session->peername, + path + ); + + if (telnetd_login(ctx, session)) { + (*ctx->config.command)(session->pty.name, ctx->config.arg); + } + + syslog( + LOG_DAEMON | LOG_INFO, + "telnetd: releasing connection from %s on %s", + session->peername, + path + ); + + rtems_pty_close_socket(&session->pty); + + rtems_mutex_lock(&ctx->mtx); + LIST_INSERT_HEAD(&ctx->free_sessions, session, link); + rtems_mutex_unlock(&ctx->mtx); + } +} + +static void telnetd_sleep_after_error(void) +{ + /* If something went wrong, sleep for some time */ + rtems_task_wake_after(10 * rtems_clock_get_ticks_per_second()); +} + +static void telnetd_server_task(rtems_task_argument arg) +{ + telnetd_context *ctx; + + ctx = (telnetd_context *) arg; + + while (true) { + telnetd_address peer; + socklen_t address_len; + int session_socket; + telnetd_session *session; + + address_len = sizeof(peer.sin); + session_socket = accept(ctx->server_socket, &peer.sa, &address_len); + if (session_socket < 0) { + syslog(LOG_DAEMON | LOG_ERR, "telnetd: cannot accept session"); + telnetd_sleep_after_error(); + continue; + }; + + rtems_mutex_lock(&ctx->mtx); + session = LIST_FIRST(&ctx->free_sessions); + + if (session == NULL) { + rtems_mutex_unlock(&ctx->mtx); + + (void)close(session_socket); + syslog(LOG_DAEMON | LOG_ERR, "telnetd: no free session available"); + telnetd_sleep_after_error(); + continue; + } + + LIST_REMOVE(session, link); + rtems_mutex_unlock(&ctx->mtx); + + rtems_pty_set_socket(&session->pty, session_socket); + + if ( + inet_ntop( + AF_INET, + &peer.sin.sin_addr, + session->peername, + sizeof(session->peername) + ) == NULL + ) { + strlcpy(session->peername, "", sizeof(session->peername)); + } + + (void)rtems_event_system_send(session->task_id, RTEMS_EVENT_SYSTEM_SERVER); + } +} + +static void telnetd_destroy_context(telnetd_context *ctx) +{ + telnetd_session *session; + + LIST_FOREACH(session, &ctx->free_sessions, link) { + if (session->task_id != 0) { + (void)rtems_task_delete(session->task_id); + } + + (void)unlink(rtems_pty_get_path(&session->pty)); + } + + if (ctx->server_socket >= 0) { + (void)close(ctx->server_socket); + } + + rtems_mutex_destroy(&ctx->mtx); + free(ctx); +} + +static rtems_status_code telnetd_create_server_socket(telnetd_context *ctx) +{ + telnetd_address srv; + socklen_t address_len; + int enable; + + ctx->server_socket = socket(PF_INET, SOCK_STREAM, 0); + if (ctx->server_socket < 0) { + syslog(LOG_DAEMON | LOG_ERR, "telnetd: cannot create server socket"); + return RTEMS_UNSATISFIED; + } + + enable = 1; + (void)setsockopt( + ctx->server_socket, + SOL_SOCKET, + SO_KEEPALIVE, + &enable, + sizeof(enable) + ); + + memset(&srv, 0, sizeof(srv)); + srv.sin.sin_family = AF_INET; + srv.sin.sin_port = htons(ctx->config.port); + address_len = sizeof(srv.sin); + + if (bind(ctx->server_socket, &srv.sa, address_len) != 0) { + syslog(LOG_DAEMON | LOG_ERR, "telnetd: cannot bind server socket"); + return RTEMS_RESOURCE_IN_USE; + }; + + if (listen(ctx->server_socket, ctx->config.client_maximum) != 0) { + syslog(LOG_DAEMON | LOG_ERR, "telnetd: cannot listen on server socket"); + return RTEMS_UNSATISFIED; + }; + + return RTEMS_SUCCESSFUL; +} + +static rtems_status_code telnetd_create_session_tasks(telnetd_context *ctx) +{ + uint16_t i; + + ctx->task_id = rtems_task_self(); + + for (i = 0; i < ctx->config.client_maximum; ++i) { + telnetd_session *session; + rtems_status_code sc; + const char *path; + rtems_event_set events; + + session = &ctx->sessions[i]; + session->ctx = ctx; + rtems_mutex_init(&ctx->mtx, "Telnet"); + LIST_INSERT_HEAD(&ctx->free_sessions, session, link); + + sc = rtems_task_create( + rtems_build_name('T', 'N', 'T', 'a' + i % 26), + ctx->config.priority, + ctx->config.stack_size, + RTEMS_DEFAULT_MODES, + RTEMS_FLOATING_POINT, + &session->task_id + ); + if (sc != RTEMS_SUCCESSFUL) { + syslog(LOG_DAEMON | LOG_ERR, "telnetd: cannot create session task"); + return RTEMS_UNSATISFIED; + } + + path = rtems_pty_initialize(&session->pty, i); + if (path == NULL) { + syslog(LOG_DAEMON | LOG_ERR, "telnetd: cannot create session PTY"); + return RTEMS_UNSATISFIED; + } + + (void)rtems_task_start( + session->task_id, + telnetd_session_task, + (rtems_task_argument) session + ); + + (void)rtems_event_receive( + TELNETD_EVENT_SUCCESS | TELNETD_EVENT_ERROR, + RTEMS_WAIT | RTEMS_EVENT_ANY, + RTEMS_NO_TIMEOUT, + &events + ); + + if ((events & TELNETD_EVENT_ERROR) != 0) { + syslog(LOG_DAEMON | LOG_ERR, "telnetd: cannot initialize session task"); + return RTEMS_UNSATISFIED; + } + } + + return RTEMS_SUCCESSFUL; +} + +rtems_status_code rtems_telnetd_start(const rtems_telnetd_config_table* config) +{ + telnetd_context *ctx; + rtems_status_code sc; + uint16_t client_maximum; + + if (config->command == NULL) { + syslog(LOG_DAEMON | LOG_ERR, "telnetd: configuration with invalid command"); + return RTEMS_INVALID_ADDRESS; + } + + if (config->client_maximum == 0) { + client_maximum = 5; + } else { + client_maximum = config->client_maximum; + } + + ctx = calloc( + 1, + sizeof(*ctx) + client_maximum * sizeof(ctx->sessions[0]) + ); + if (ctx == NULL) { + syslog(LOG_DAEMON | LOG_ERR, "telnetd: cannot allocate server context"); + return RTEMS_UNSATISFIED; + } + + ctx->config = *config; + ctx->config.client_maximum = client_maximum; + ctx->server_socket = -1; + LIST_INIT(&ctx->free_sessions); + + if (ctx->config.priority == 0) { + ctx->config.priority = 100; + } + + /* Check stack size */ + if (ctx->config.stack_size == 0) { + ctx->config.stack_size = (size_t)32 * 1024; + } + + if (ctx->config.port == 0) { + ctx->config.port = 23; + } + + sc = telnetd_create_server_socket(ctx); + if (sc != RTEMS_SUCCESSFUL) { + telnetd_destroy_context(ctx); + return sc; + } + + sc = telnetd_create_session_tasks(ctx); + if (sc != RTEMS_SUCCESSFUL) { + telnetd_destroy_context(ctx); + return sc; + } + + sc = rtems_task_create( + rtems_build_name('T', 'N', 'T', 'D'), + ctx->config.priority, + RTEMS_MINIMUM_STACK_SIZE, + RTEMS_DEFAULT_MODES, + RTEMS_FLOATING_POINT, + &ctx->task_id + ); + if (sc != RTEMS_SUCCESSFUL) { + syslog(LOG_DAEMON | LOG_ERR, "telnetd: cannot create server task"); + telnetd_destroy_context(ctx); + return RTEMS_UNSATISFIED; + } + + (void)rtems_task_start( + ctx->task_id, + telnetd_server_task, + (rtems_task_argument) ctx + ); + + syslog( + LOG_DAEMON | LOG_INFO, + "telnetd: started successfully on port %" PRIu16, ctx->config.port + ); + return RTEMS_SUCCESSFUL; +} -- cgit v1.2.3