netdebug.c

来自「基于东南大学开发的SEP3203的ARM7中的所有驱动」· C语言 代码 · 共 2,190 行 · 第 1/3 页

    

    if (level <= traceLevel[TL_UNDEF]) {

        OS_ENTER_CRITICAL();

        logNdx = logHead++ % MAXLOGSZ;

        // If the log is full, drop the oldest entry.

        if (logHead % MAXLOGSZ == logTail % MAXLOGSZ)

            logTail++;

        OS_EXIT_CRITICAL();

        

        // Note: mtime() exits with interrupts enabled.

        debugLog[logNdx].logTime = mtime();

        

        debugLog[logNdx].OSTCBPrio = OSTCBCur->OSTCBPrio + 100;

        debugLog[logNdx].tCode = 0;

        arg++;                          // Point to first arguement if any

//        if (vsprintf(debugLog[logNdx].logMsg, format, (const void *)arg) >= LOGMSGLEN)

        if (vsprintf(debugLog[logNdx].logMsg, format, (void*)arg) >= LOGMSGLEN)

            netpanic("TRACE");

    }

#endif

}





//  ntrace - a numeric trace function
//
//
/*
void ntrace(int level, NumTraceCodes tCode, ULONG arg1, ULONG arg2) 

{

#if DEBUG_SUPPORT > 0

    u_int  logNdx;

    

    if (level <= traceLevel[TL_UNDEF]) {

        OS_ENTER_CRITICAL();

        logNdx = logHead++ % MAXLOGSZ;

        // If the log is full, drop the oldest entry.

        if (logHead % MAXLOGSZ == logTail % MAXLOGSZ)

            logTail++;

        OS_EXIT_CRITICAL();

        

        // Note: mtime() exits with interrupts enabled.

        debugLog[logNdx].logTime = mtime();

        

        debugLog[logNdx].OSTCBPrio = OSTCBCur->OSTCBPrio + 100;

        debugLog[logNdx].tCode = tCode;

        debugLog[logNdx].arg1 = arg1;

        debugLog[logNdx].arg2 = arg2;

        debugLog[logNdx].logMsg[0] = '\0';

    }

#endif

}
*/


//

// logTrace - A form of printf that writes a line to the trace log if

//  the trace level for the specified module is high enough.

//

//#pragma argsused


void logTrace(int level, TraceModule tMod,  const char *format,...)

{

#if DEBUG_SUPPORT > 0

    char **arg = (char **)&format;              // ptr to arg list on stack

    u_int  logNdx;

    

    if (level <= traceLevel[tMod]) {

        OS_ENTER_CRITICAL();

        logNdx = logHead++ % MAXLOGSZ;

        /* If the log is full, drop the oldest entry. */

        if (logHead % MAXLOGSZ == logTail % MAXLOGSZ)

            logTail++;

        OS_EXIT_CRITICAL();

        

        /* Note: mtime() exits with interrupts enabled. */

        debugLog[logNdx].logTime = mtime();

        

        debugLog[logNdx].OSTCBPrio = OSTCBCur->OSTCBPrio + 100;

        debugLog[logNdx].tCode = 0;

        arg++;                          /* Point to first arguement if any */

        if (vsprintf(debugLog[logNdx].logMsg, format, (void *)arg) >= LOGMSGLEN)

           netpanic("LOGTRACE");

    }

#endif

}





/*  Generate the a string in d containing the character c if printable,

 *  otherwise a bracketed mnemonic for it.  Return d.

 */
//#pragma argsused

char *debugchr(char *d, unsigned char c)

{

#if DEBUG_SUPPORT > 0

    INT  fndx;

    char fstr[12], *dptr = d;



    switch (c) {

    case (NUL): 

        strcpy(d, "<NUL>"); 

        break;

    case (ACK): 

        strcpy(d, "<ACK>"); 

        break;

    case (NAK): 

        strcpy(d, "<NAK>"); 

        break;

    case (LF):  

        strcpy(d, "<LF>"); 

        break;

    case (FF):  

        strcpy(d, "<FF>"); 

        break;

    case (CR):  

        strcpy(d, "<CR>"); 

        break;

    case (RTS): 

        strcpy(d, "<RTS>"); 

        break;

    case (EOD): 

        strcpy(d, "<EOD>"); 

        break;

    case (EOF): 

        strcpy(d, "<EOF>"); 

        break;

    default:

        if (c < 32 || c >= 127) {

            fndx = 0;

            *dptr++ = '<';

            // Convert number

            if (c == 0) {

                fstr[fndx++] = '0';

            } else {

                while (c > 0 && fndx < 10) {

                    fstr[fndx++] = (c % 10) + '0';

                    c = c / 10;

                }

            }

            for (fndx--; fndx >= 0; fndx--) {

                *dptr++ = fstr[fndx];

            }

            *dptr++ = '>';

        } else

            *dptr++ = c;

        *dptr = '\0';

        break;

    }

#endif

    return(d);

}



//

// Print the given lines from the trace log in readable form to the

//  specified file stream.  The previous start and max lines are saved so

//  that if they are passed as -1, the dump displays the next set of lines.

///

//#pragma argsused

void traceDump(void* _fptr, int startLine, int maxLines)

{

#if DEBUG_SUPPORT > 0

    int rc;

    static UINT curLine = 0;

    static int curMax = MAXSENDLINES;

    UINT endLine, logNdx;



    FILE* fptr = (FILE*)_fptr;

    

    // Load parameters

    if (startLine >= 0)

        curLine = startLine;

    if (maxLines > 0)

        curMax = maxLines;

    if (curLine < logTail)

        curLine = logTail;

    else if (curLine > logHead)

        curLine = logHead;

    endLine = curLine + curMax;

    if (endLine > logHead)

        endLine = logHead;

        

    for (; curLine < endLine; curLine++) {

        logNdx = curLine % MAXLOGSZ; 

        

        if (debugLog[logNdx].tCode == tUndef) {

            rc = fprintf(fptr, "%4u>%9lu: %.*s\r\n", 

                    curLine,

                    debugLog[logNdx].logTime,

                    LOGMSGLEN,

                    debugLog[logNdx].logMsg);

        } else {

            rc = fprintf(fptr, "%4u>%9lu: %u %lu %lu %.*s\r\n", 

                    curLine,

                    debugLog[logNdx].logTime,

                    debugLog[logNdx].tCode,

                    debugLog[logNdx].arg1,

                    debugLog[logNdx].arg2,

                    LOGMSGLEN,

                    debugLog[logNdx].logMsg);

        }

        /* 

         * If we wrote more characters than fit on a terminal line, count it

         * as 2 lines.  We don't count the leading CR/LF.

         */

        if (rc > TERMWIDTH + 2)

            endLine--;

    }

    fflush(fptr);

#endif

}





/**********************************/

/*** LOCAL FUNCTION DEFINITIONS ***/

/**********************************/

/*

 * monitorMain0 - an interactive diagnostics monitor designed to be run as a

 * task connected via a telnet connection.

 */

#if DEBUG_SUPPORT > 0

static void monitorMain0(void *md)

{

    MonitorControl *mc = &monitorControl[(int)md];

    #define READBUFSZ 50

    struct sockaddr_in localAddr, peerAddr;

    u_int tdListen;

    u_int tcpd;

    u_int inCnt;

    int st;

    char rBuf[READBUFSZ];

    char devName[] = "TCP0";

    

    localAddr.ipAddr = 0;

    localAddr.sin_port = TCPPORT_ACCUVOTE;

    mc->cmdLen = 0;

    mc->commandFcn = monDump;

    tcpd = -1;

    

    if ((tdListen = tcpOpen()) < 0) {

        DIAGMONTRACE((LOG_ERR, "monitorMain[%d]: Unable to open TCP (%d)", 

                    (int)md, tdListen));

    } else if ((inCnt = MONTCP_KEEPALIVE) != 0 

            && (st = tcpIOCtl(tdListen, TCPCTLS_KEEPALIVE, &inCnt)) < 0) {

        DIAGMONTRACE((LOG_ERR, "monitorMain[%d]: Error %d setting keep alive", 

                    (int)md, st));

    } else for (;;) {

        if ((st = tcpBind(tdListen, &localAddr)) < 0) {

            DIAGMONTRACE((LOG_ERR, "monitorMain[%d]: Error %d on bind", (int)md, st));

            break;

        } else if ((tcpd = tcpAccept(tdListen, &peerAddr)) < 0) {

            DIAGMONTRACE((LOG_ERR, "monitorMain[%d]: Error %d on accept", (int)md, tcpd));

            break;

        } else if (devName[3] = '0' + tcpd, (mc->fp = fopen(devName, "w+")) == NULL) {

            DIAGMONTRACE((LOG_ERR, "monitorMain[%d]: Error %d on fopen", (int)md, mc->fp));

            break;

        } else if ((st = fputs(MONPROMPT, mc->fp)) < 0 || fflush(mc->fp) < 0) {

            DIAGMONTRACE((LOG_ERR, "monitorMain[%d]: Error %d on write", (int)md, st));

            break;

        } else {

            DIAGMONTRACE((LOG_INFO, "monitorMain[%d]: connect %s:%u", (int)md,

                        ip_ntoa(htonl(peerAddr.sin_addr.s_addr)),

                        peerAddr.sin_port));

            inCnt = LOG_DETAIL;

            tcpIOCtl(tdListen, TCPCTLS_TRACELEVEL, &inCnt);

            while ((inCnt = tcpRead(tcpd, rBuf, READBUFSZ)) >= 0) {

                if ((st = tcpWrite(tcpd, rBuf, inCnt)) < 0) {

                    DIAGMONTRACE((LOG_ERR, "monitorMain[%d]: Error %d on write", 

                                (int)md, st));

                    break;

                } else {

                    (void)monProcInput(mc, rBuf, inCnt);

                }

            }

            DIAGMONTRACE((LOG_ERR, "monitorMain[%d]: Read=>%d st=%d", 

                        (int)md, inCnt, st));

            inCnt = LOG_INFO;

            tcpIOCtl(tdListen, TCPCTLS_TRACELEVEL, &inCnt);

        }

        if (tcpd >= 0) {

            DIAGMONTRACE((LOG_INFO, "monitorMain[%d]: disconnect %d %s:%u", (int)md,

                        tcpd,

                        ip_ntoa(htonl(peerAddr.sin_addr.s_addr)),

                        peerAddr.sin_port));

            if ((st = tcpDisconnect(tcpd)) < 0) {

                DIAGMONTRACE((LOG_ERR, "monitorMain[%d]: Disconnect err %d", 

                            (int)md, st));

                break;

                

            } else if ((st = tcpWait(tcpd)) < 0) {

                DIAGMONTRACE((LOG_ERR, "monitorMain[%d]: Close wait err %d", 

                            (int)md, st));

                break;

            }

        }

    }

    if (mc->fp != NULL) {

        DIAGMONTRACE((LOG_INFO, "monitorMain[%d]: closing", (int)md));

        fclose(mc->fp);

    }

    if (tdListen >= 0 && tdListen != tcpd) {

        DIAGMONTRACE((LOG_INFO, "monitorMain[%d]: disconnect %d %s:%u", (int)md, tdListen,

                    ip_ntoa(htonl(peerAddr.sin_addr.s_addr)),

                    peerAddr.sin_port));

        if ((st = tcpDisconnect(tdListen)) < 0) {

            DIAGMONTRACE((LOG_ERR, "monitorMain[%d]: Disconnect err %d", 

                        (int)md, st));

        }

    }

    OSTaskDel(OS_PRIO_SELF);

}



#if DEBUGMONPORT > 0

/*

 * monitorMain1 - an interactive diagnostics monitor designed to be run as a

 * task connected via a serial port.

 */

static void monitorMain1(void *md)

{

    MonitorControl *mc = &monitorControl[(int)md];

    #define READBUFSZ 50

    FILE *fptr;

    int inCnt, st;

    char rBuf[READBUFSZ];

    

    mc->cmdLen = 0;

    mc->commandFcn = monDump;

    

    if ((mc->fp = fopen("COM1", "rw")) == NULL) {

        DIAGMONTRACE((LOG_ERR, "monitorMain[%d]: Unable to open sio (%d)", 

                    (int)md, fptr));

    } else {

        inCnt = B9600;

        ioctl(fileno(mc->fp), SETBAUD, &inCnt);

        

        if ((st = nWrite(fileno(mc->fp), MONPROMPT, MONPROMPTLEN)) < 0) {

            DIAGMONTRACE((LOG_ERR, "monitorMain[%d]: Error %d on write", (int)md, st));

        } else {

            while ((inCnt = read(fileno(mc->fp), rBuf, READBUFSZ)) >= 0) {

                if ((st = nWrite(fileno(mc->fp), rBuf, inCnt)) < 0) {

                    DIAGMONTRACE((LOG_ERR, "monitorMain[%d]: Error %d on write", 

                                (int)md, st));

                    break;

                } else {

                    (void)monProcInput(mc, rBuf, inCnt);

                }

            }

        }

    }

    if (mc->fp != NULL) {

        DIAGMONTRACE((LOG_INFO, "monitorMain[%d]: closing", (int)md));

        fclose(mc->fp);

    }

    OSTaskDel(OS_PRIO_SELF);

}

#endif



/*

 * monProcInput - process incoming monitor data.  This function takes user

 * input to build the command line which when complete, is parsed and

 * executed.  Because this may be called with any fragment or even character

 * by character, it must maintain state in the monitor control block.

 * Return 0 on success, an error code on failure.

 */

static int monProcInput(MonitorControl *mc, char *rBuf, int inCnt)

{

    int st = 0;

    int curNdx;

    char c;

    

    for (curNdx = 0; st == 0 && curNdx < inCnt; curNdx++) {

        c = rBuf[curNdx];