diff options
Diffstat (limited to 'cfe/cfe/net/dev_tcpconsole.c')
-rw-r--r-- | cfe/cfe/net/dev_tcpconsole.c | 341 |
1 files changed, 341 insertions, 0 deletions
diff --git a/cfe/cfe/net/dev_tcpconsole.c b/cfe/cfe/net/dev_tcpconsole.c new file mode 100644 index 0000000..43b4f1c --- /dev/null +++ b/cfe/cfe/net/dev_tcpconsole.c @@ -0,0 +1,341 @@ +/* ********************************************************************* + * Broadcom Common Firmware Environment (CFE) + * + * TCP Console Driver File: dev_tcpconsole.c + * + * Evil hack: A console driver that uses a TCP socket. + * + * Author: Mitch Lichtenberg (mpl@broadcom.com) + * + ********************************************************************* + * + * Copyright 2000,2001,2002,2003 + * Broadcom Corporation. All rights reserved. + * + * This software is furnished under license and may be used and + * copied only in accordance with the following terms and + * conditions. Subject to these conditions, you may download, + * copy, install, use, modify and distribute modified or unmodified + * copies of this software in source and/or binary form. No title + * or ownership is transferred hereby. + * + * 1) Any source code used, modified or distributed must reproduce + * and retain this copyright notice and list of conditions + * as they appear in the source file. + * + * 2) No right is granted to use any trade name, trademark, or + * logo of Broadcom Corporation. The "Broadcom Corporation" + * name may not be used to endorse or promote products derived + * from this software without the prior written permission of + * Broadcom Corporation. + * + * 3) THIS SOFTWARE IS PROVIDED "AS-IS" AND ANY EXPRESS OR + * IMPLIED WARRANTIES, INCLUDING BUT NOT LIMITED TO, ANY IMPLIED + * WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR + * PURPOSE, OR NON-INFRINGEMENT ARE DISCLAIMED. IN NO EVENT + * SHALL BROADCOM BE LIABLE FOR ANY DAMAGES WHATSOEVER, AND IN + * PARTICULAR, BROADCOM SHALL NOT BE LIABLE FOR 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), EVEN IF ADVISED OF + * THE POSSIBILITY OF SUCH DAMAGE. + ********************************************************************* */ + + +#include "lib_types.h" +#include "lib_malloc.h" +#include "lib_printf.h" +#include "cfe_iocb.h" +#include "cfe_device.h" +#include "cfe_ioctl.h" +#include "addrspace.h" + +#include "cfe_timer.h" + +#include "bsp_config.h" + +#if CFG_TCP +#include "net_ebuf.h" +#include "net_api.h" + +/* + * Friendly warning: Don't put printfs in here or enable any + * debugging messages in the TCP stack if you're really + * going to use this for your console device. You'll end up + * with a recursion loop! + */ + +/* ********************************************************************* + * Constants + ********************************************************************* */ + +#define TCPCONSOLE_DEFAULT_PORT 23 /* telnet */ + +/* ********************************************************************* + * Forward + ********************************************************************* */ + +static void tcpconsole_probe(cfe_driver_t *drv, + unsigned long probe_a, unsigned long probe_b, + void *probe_ptr); + +static int tcpconsole_open(cfe_devctx_t *ctx); +static int tcpconsole_read(cfe_devctx_t *ctx,iocb_buffer_t *buffer); +static int tcpconsole_inpstat(cfe_devctx_t *ctx,iocb_inpstat_t *inpstat); +static int tcpconsole_write(cfe_devctx_t *ctx,iocb_buffer_t *buffer); +static int tcpconsole_ioctl(cfe_devctx_t *ctx,iocb_buffer_t *buffer); +static int tcpconsole_close(cfe_devctx_t *ctx); + +const static cfe_devdisp_t tcpconsole_dispatch = { + tcpconsole_open, + tcpconsole_read, + tcpconsole_inpstat, + tcpconsole_write, + tcpconsole_ioctl, + tcpconsole_close, + NULL, + NULL +}; + +const cfe_driver_t tcpconsole = { + "TCP Console", + "tcpconsole", + CFE_DEV_SERIAL, + &tcpconsole_dispatch, + tcpconsole_probe +}; + + +/* ********************************************************************* + * tcpconsole structure + ********************************************************************* */ + +/* + * States our connection can be in + */ + +#define TCPCONSTAT_IDLE 0 +#define TCPCONSTAT_LISTEN 1 +#define TCPCONSTAT_CONNECTED 2 +#define TCPCONSTAT_DISCONNECTED 3 +#define TCPCONSTAT_BROKEN 4 + +/* + * state information + */ + +typedef struct tcpconsole_s { + int tcp_socket; + int tcp_status; + int tcp_port; +} tcpconsole_t; + + +static void tcpconsole_probe(cfe_driver_t *drv, + unsigned long probe_a, unsigned long probe_b, + void *probe_ptr) +{ + tcpconsole_t *softc; + char descr[80]; + + softc = (tcpconsole_t *) KMALLOC(sizeof(tcpconsole_t),0); + if (softc) { + softc->tcp_socket = -1; + softc->tcp_status = TCPCONSTAT_IDLE; + xsprintf(descr, "%s", drv->drv_description); + + if (probe_a == 0) probe_a = TCPCONSOLE_DEFAULT_PORT; + + softc->tcp_port = (int)probe_a; + + cfe_attach(drv, softc, NULL, descr); + } +} + + +static int tcpconsole_isready(tcpconsole_t *softc,int *rxbytes) +{ + int res; + int connstat,rxeof; + + res = tcp_status(softc->tcp_socket,&connstat,rxbytes,&rxeof); + + /* + * Return: + * -1 if we could not get status + * 0 if we are not connected or are connected and at EOF + * 1 if we are connected. + */ + + if (res < 0) return res; + if (connstat != TCPSTATUS_CONNECTED) return 0; + if (!rxeof) return 1; + + return 0; +} + + +static int tcpconsole_process(tcpconsole_t *softc) +{ + int res = 0; + + switch (softc->tcp_status) { + case TCPCONSTAT_IDLE: + /* Idle, set up listening socket */ + res = tcp_socket(); + if (res < 0) { + softc->tcp_status = TCPCONSTAT_BROKEN; + return res; + } + softc->tcp_socket = res; + + res = tcp_listen(softc->tcp_socket,softc->tcp_port); + + if (res < 0) { + tcp_close(softc->tcp_socket); + softc->tcp_status = TCPCONSTAT_BROKEN; + softc->tcp_socket = -1; + return res; + } + softc->tcp_status = TCPCONSTAT_LISTEN; + break; + + case TCPCONSTAT_LISTEN: + /* Still waiting for a connection */ + res = 0; + if (tcpconsole_isready(softc,NULL) > 0) { + softc->tcp_status = TCPCONSTAT_CONNECTED; + } + break; + + case TCPCONSTAT_CONNECTED: + res = 0; /* do nothing, we're okay */ + break; + + case TCPCONSTAT_DISCONNECTED: + /* Currently connected, kill off this connection */ + tcp_close(softc->tcp_socket); + softc->tcp_socket = -1; + softc->tcp_status = TCPCONSTAT_IDLE; + break; + + case TCPCONSTAT_BROKEN: + /* Broken. Stay broken. */ + res = 0; + break; + } + + return res; +} + + +static int tcpconsole_open(cfe_devctx_t *ctx) +{ + return 0; +} + +static int tcpconsole_read(cfe_devctx_t *ctx, iocb_buffer_t *buffer) +{ + tcpconsole_t *softc = ctx->dev_softc; + unsigned char *bptr; + int blen; + int res; + + POLL(); + tcpconsole_process(softc); + + buffer->buf_retlen = 0; + + if (softc->tcp_status == TCPCONSTAT_CONNECTED) { + bptr = buffer->buf_ptr; + blen = buffer->buf_length; + + if (tcpconsole_isready(softc,NULL) <= 0) { + softc->tcp_status = TCPCONSTAT_DISCONNECTED; + return 0; + } + + res = tcp_recv(softc->tcp_socket,bptr,blen); + + if (res > 0) { + buffer->buf_retlen = res; + } + } + + return 0; +} + +static int tcpconsole_inpstat(cfe_devctx_t *ctx, iocb_inpstat_t *inpstat) +{ + tcpconsole_t *softc = ctx->dev_softc; + unsigned int rxbytes; + + POLL(); + tcpconsole_process(softc); + + inpstat->inp_status = 0; + + if (softc->tcp_status == TCPCONSTAT_CONNECTED) { + if (tcpconsole_isready(softc,&rxbytes) <= 0) { + softc->tcp_status = TCPCONSTAT_DISCONNECTED; + } + else { + inpstat->inp_status = (rxbytes > 0); + } + } + + return 0; +} + +static int tcpconsole_write(cfe_devctx_t *ctx, iocb_buffer_t *buffer) +{ + tcpconsole_t *softc = ctx->dev_softc; + unsigned char *bptr; + int blen; + int res; + + POLL(); + tcpconsole_process(softc); + + buffer->buf_retlen = 0; + + if (softc->tcp_status == TCPCONSTAT_CONNECTED) { + bptr = buffer->buf_ptr; + blen = buffer->buf_length; + + if (tcpconsole_isready(softc,NULL) <= 0) { + softc->tcp_status = TCPCONSTAT_DISCONNECTED; + return 0; + } + + res = tcp_send(softc->tcp_socket,bptr,blen); + + if (res > 0) { + buffer->buf_retlen = res; + } + } + + return 0; +} + +static int tcpconsole_ioctl(cfe_devctx_t *ctx, iocb_buffer_t *buffer) +{ + return -1; +} + +static int tcpconsole_close(cfe_devctx_t *ctx) +{ + tcpconsole_t *softc = ctx->dev_softc; + + if (softc->tcp_status == TCPCONSTAT_CONNECTED) { + softc->tcp_status = TCPCONSTAT_DISCONNECTED; + } + + return 0; +} + + +#endif |