Ejemplo n.º 1
0
int
rtems_gdb_tgt_install_ehandler(int action)
{
    int rval = 0, i;

    /* initialize breakpoint table */
    for ( i=0; i<NUM_BPNTS-1; i++ )
        bpntTab[i].next = bpntTab+i+1;
    bpntsFree = bpntTab;

    if ( action ) {
        /* install */
        for ( i = 0; i<sizeof(origHandlerTbl)/sizeof(origHandlerTbl[0]); i++ ) {
            if ( rtems_interrupt_catch(_m68k_gdb_exception_wrapper, origHandlerTbl[i].vec, &origHandlerTbl[i].hdl) ) {
                origHandlerTbl[i].hdl = 0;
                isr_restore(i);
                rval = -1;
                break;
            }
        }
    } else {
        /* uninstall */
        rval = isr_restore(sizeof(origHandlerTbl)/sizeof(origHandlerTbl[0]));
    }

    if ( rval ) {
        ERRMSG("ERROR: exception handler %s\n",
               action ? "already installed" : "cannot be removed; uninstall failed");
    }
    return rval;
}
Ejemplo n.º 2
0
/*
 * debug_send_byte()
 *	Send a character to the debug port.
 */
void debug_send_byte(unsigned char data)
{
    u8_t *p = (u8_t *)0x000b8000;
    fast_u8_t sreg;
    int x;

    sreg = isr_save_disable();

    if (data == '\r') {
        cx = 0;
    } else if (data == '\n') {
        cy++;
    } else if (data == '\f') {
        cx = 0;
        cy = 0;

        for (x = 0; x < (80 * 24); x++) {
            *p = ' ';
            p += 2;
        }
    } else {
        if (cx >= 80) {
            cx = 0;
            cy++;
        }

        if (cy >= 24) {
            u8_t *src = (u8_t *)(0x000b8000 + 160);

            for (x = 160; x < (160 * 24); x++) {
                *p++ = *src++;
            }
            for (x = 0; x < 160; x += 2) {
                *p = ' ';
                p += 2;
            }
            p = (u8_t *)0x000b8000;
            cy = 23;
        }

        *(p + (((cy * 80) + cx) * 2)) = data;
        cx++;
    }

    isr_restore(sreg);
}