oddebug.c

来自「ATmega8实现USB接口（采用USB的CDC类」· C语言 代码 · 共 45 行

#include "oddebug.h"

#if DEBUG_LEVEL > 0

static uchar Warning__Never_compile_production_devices_with_debugging;
/* The "#warning" preprocessor directive is non-standard. The unused static
 * variable above should give a compiler warning on all compilers.
 */

static void uartPutc(char c)
{
    while(!(ODDBG_USR & (1 << ODDBG_UDRE)));    /* wait for data register empty */
    ODDBG_UDR = c;
}

static uchar    hexAscii(uchar h)
{
    h &= 0xf;
    if(h >= 10)
        h += 'a' - (uchar)10 - '0';
    h += '0';
    return h;
}

static void printHex(uchar c)
{
    uartPutc(hexAscii(c >> 4));
    uartPutc(hexAscii(c));
}

void    odDebug(uchar prefix, uchar *data, uchar len)
{
    printHex(prefix);
    uartPutc(':');
    while(len--){
        uartPutc(' ');
        printHex(*data++);
    }
    uartPutc('\r');
    uartPutc('\n');
}

#endif