linux-imx
Public
Source
committed 2b9156129f8x
/* * Common data handling layer for ser_gigaset and usb_gigaset * * Copyright (c) 2005 by Tilman Schmidt <tilman@imap.cc>, * Hansjoerg Lipp <hjlipp@web.de>, * Stefan Eilers. * * ===================================================================== * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License as * published by the Free Software Foundation; either version 2 of * the License, or (at your option) any later version. * ===================================================================== *//* check if byte must be stuffed/escaped * I'm not sure which data should be encoded. * Therefore I will go the hard way and encode every value * less than 0x20, the flag sequence and the control escape char. */static inline int muststuff(unsigned char c){ if (c < PPP_TRANS) return 1; if (c == PPP_FLAG) return 1; if (c == PPP_ESCAPE) return 1; /* other possible candidates: */ /* 0x91: XON with parity set */ /* 0x93: XOFF with parity set */ return 0;}/* == data input =========================================================== *//* process a block of received bytes in command mode * (mstate != MS_LOCKED && (inputstate & INS_command)) * Append received bytes to the command response buffer and forward them * line by line to the response handler. Exit whenever a mode/state change * might have occurred. * Note: Received lines may be terminated by CR, LF, or CR LF, which will be * removed before passing the line to the response handler. * Return value: * number of processed bytes */static unsigned cmd_loop(unsigned numbytes, struct inbuf_t *inbuf){ unsigned char *src = inbuf->data + inbuf->head; struct cardstate *cs = inbuf->cs; unsigned cbytes = cs->cbytes; unsigned procbytes = 0; unsigned char c; while (procbytes < numbytes) { c = *src++; procbytes++; switch (c) { case '\n': if (cbytes == 0 && cs->respdata[0] == '\r') { /* collapse LF with preceding CR */ cs->respdata[0] = 0; break; } /* fall through */ case '\r': /* end of message line, pass to response handler */ if (cbytes >= MAX_RESP_SIZE) { dev_warn(cs->dev, "response too large (%d)\n", cbytes); cbytes = MAX_RESP_SIZE; } cs->cbytes = cbytes; gigaset_dbg_buffer(DEBUG_TRANSCMD, "received response", cbytes, cs->respdata); gigaset_handle_modem_response(cs); cbytes = 0; /* store EOL byte for CRLF collapsing */ cs->respdata[0] = c; /* cs->dle may have changed */ if (cs->dle && !(inbuf->inputstate & INS_DLE_command)) inbuf->inputstate &= ~INS_command; /* return for reevaluating state */ goto exit; case DLE_FLAG: