io_utils.c

开放源码实时操作系统源码.

//=============================================================================
//
//      io_utils.c - Cyclone Diagnostics
//
//=============================================================================
//####ECOSGPLCOPYRIGHTBEGIN####
// -------------------------------------------
// This file is part of eCos, the Embedded Configurable Operating System.
// Copyright (C) 1998, 1999, 2000, 2001, 2002 Red Hat, Inc.
//
// eCos 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 or (at your option) any later version.
//
// eCos 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.  See the GNU General Public License
// for more details.
//
// You should have received a copy of the GNU General Public License along
// with eCos; if not, write to the Free Software Foundation, Inc.,
// 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
//
// As a special exception, if other files instantiate templates or use macros
// or inline functions from this file, or you compile this file and link it
// with other works to produce a work based on this file, this file does not
// by itself cause the resulting work to be covered by the GNU General Public
// License. However the source code for this file must still be made available
// in accordance with section (3) of the GNU General Public License.
//
// This exception does not invalidate any other reasons why a work based on
// this file might be covered by the GNU General Public License.
//
// Alternative licenses for eCos may be arranged by contacting Red Hat, Inc.
// at http://sources.redhat.com/ecos/ecos-license/
// -------------------------------------------
//####ECOSGPLCOPYRIGHTEND####
//=============================================================================
//#####DESCRIPTIONBEGIN####
//
// Author(s):   Scott Coulter, Jeff Frazier, Eric Breeden
// Contributors:
// Date:        2001-01-25
// Purpose:     
// Description: 
//
//####DESCRIPTIONEND####
//
//===========================================================================*/

/*
 * i/o routines for tests.  Greg Ames, 9/17/90.
 *
 * Version: @(#)test_io.c	1.2 8/26/93
 */
#include <redboot.h>
#include <cyg/infra/diag.h>
#define printf diag_printf


#define TRUE	1
#define FALSE	0


#define ASCII_TO_DEC 48
void atod(char a, int* b)
{
    *b = (int)(a - ASCII_TO_DEC);
}

char xgetchar(void)
{
    hal_virtual_comm_table_t* __chan = CYGACC_CALL_IF_CONSOLE_PROCS();
    
    if (__chan == NULL)
        __chan = CYGACC_CALL_IF_DEBUG_PROCS();

    return CYGACC_COMM_IF_GETC(*__chan);
}

int xgetchar_timeout(char *ch, int msec)
{
    bool res;
    int old_to;
    hal_virtual_comm_table_t *__chan;

    __chan = CYGACC_CALL_IF_CONSOLE_PROCS();
    if (__chan == NULL)
	__chan = CYGACC_CALL_IF_DEBUG_PROCS();

    old_to = CYGACC_COMM_IF_CONTROL(*__chan, __COMMCTL_SET_TIMEOUT, msec);
    res = CYGACC_COMM_IF_GETC_TIMEOUT(*__chan, ch);
    CYGACC_COMM_IF_CONTROL(*__chan, __COMMCTL_SET_TIMEOUT, old_to);

    return res;
}

/*
 * naive implementation of "gets"
 * (big difference from fgets == strips newline character)
 */
char* sgets(char *s)
{
    char *retval = s;
    char ch;
 
    while ((ch = (char)xgetchar())) {
	if (ch == 0x0d) { /* user typed enter */
	    printf("\n");
	    break;
	}
	if (ch == 0x08) { /* user typed backspace */
	    printf ("\b");
	    printf (" ");
	    printf ("\b");
	    s--;
	} else { /* user typed another character */
	    printf("%c", ch);
	    *s++ = ch;   
	}
    }
  
    *s = '\0';
    return retval; 
}


/* Returns true if theChar is a valid hex digit, false if not */
char ishex(char theChar)
{
    switch(theChar) {
    case '0':
    case '1':
    case '2':
    case '3':
    case '4':
    case '5':
    case '6':
    case '7':
    case '8':
    case '9':
    case 'A':
    case 'a':
    case 'B':
    case 'b':
    case 'C':
    case 'c':
    case 'D':
    case 'd':
    case 'E':
    case 'e':
    case 'F':
    case 'f':
	return 1;
    default:
	return 0;
    }
}


/* Returns true if theChar is a valid decimal digit, false if not */
char isdec(char theChar)
{
    switch(theChar) {
    case '0':
    case '1':
    case '2':
    case '3':
    case '4':
    case '5':
    case '6':
    case '7':
    case '8':
    case '9':
	return 1;
    default:
	return 0;
    }
}

/* Convert ascii code of hex digit to number (0-15) */
char hex2dec(char hex)
{
    if ((hex >= '0') && (hex <= '9'))
        return hex - '0';
    else if ((hex >= 'a') && (hex <= 'f'))
        return hex - 'a' + 10;
    else
        return hex - 'A' + 10;
}
 

/* Convert number (0-15) to ascii code of hex digit */
char dec2hex(char dec)
{
    return (dec <= 9) ? (dec + '0') : (dec - 10 + 'A');
}


/* Output an 8 bit number as 2 hex digits */
void hex8out(unsigned char num)
{
    printf("%02X",num);
}


/* Output an 32 bit number as 8 hex digits */
void hex32out(unsigned long num)
{
    printf("%08X",num);
}


/* Input a number as (at most 8) hex digits - returns value entered */
long hexIn(void)
{
    char input[40];
    long num;
    register int i;

    i = 0;
    num = 0;

    if (sgets (input)) { /* grab a line */
        num = hex2dec(input[i++]);            /* Convert MSD to dec */
        while(ishex(input[i]) && input[i]) {  /* Get next hex digit */
            num <<= 4;						/* Make room for next digit */
            num += hex2dec(input[i++]); 	/* Add it in */
        }
    }
    return num;
}


/* Input a number as decimal digits - returns value entered */
long decIn(void)
{
    char input[40];
    int num;
    int tmp;
    register int i;

    i = 0;
    num = 0;

    if (sgets (input)) {  /* grab a line */
        atod(input[i++], &num);      	/* Convert MSD to decimal */
        while(isdec(input[i]) && input[i]) { /* Get next decimal digit */
            num *= 10;                 	/* Make room for next digit */
	    atod(input[i++], &tmp);
            num += tmp; 			/* Add it in */
        }
    }

    return (num);
}