
#include <linux/config.h>

#ifdef CONFIG_REMOTE_DEBUG

/* --- CONFIG --- */

/* we need uint32 uint8 */
typedef         unsigned char  uint8;
typedef         unsigned short uint16;
typedef         unsigned int   uint32;

/* --- END OF CONFIG --- */

#define         UART16550_BAUD_2400             2400
#define         UART16550_BAUD_4800             4800
#define         UART16550_BAUD_9600             9600
#define         UART16550_BAUD_19200            19200
#define         UART16550_BAUD_38400            38400
#define         UART16550_BAUD_57600            57600
#define         UART16550_BAUD_115200           115200

#define         UART16550_PARITY_NONE           0
#define         UART16550_PARITY_ODD            0x08
#define         UART16550_PARITY_EVEN           0x18
#define         UART16550_PARITY_MARK           0x28
#define         UART16550_PARITY_SPACE          0x38

#define         UART16550_DATA_5BIT             0x0
#define         UART16550_DATA_6BIT             0x1
#define         UART16550_DATA_7BIT             0x2
#define         UART16550_DATA_8BIT             0x3

#define         UART16550_STOP_1BIT             0x0
#define         UART16550_STOP_2BIT             0x4

/* ----------------------------------------------------- */

/* === CONFIG === */

/* [stevel] we use the IT8712 serial port for kgdb */
#define	DEBUG_BASE  0xAF000820 /* NEC VR4122 DSIU base address */
#define MAX_BAUD    115200

/* === END OF CONFIG === */

/* register offset */
#define         OFS_RCV_BUFFER          0
#define         OFS_TRANS_HOLD          0
#define         OFS_SEND_BUFFER         0
#define         OFS_INTR_ENABLE         1
#define         OFS_INTR_ID             2
#define         OFS_DATA_FORMAT         3
#define         OFS_LINE_CONTROL        3
#define         OFS_MODEM_CONTROL       4
#define         OFS_RS232_OUTPUT        4
#define         OFS_LINE_STATUS         5
#define         OFS_MODEM_STATUS        6
#define         OFS_RS232_INPUT         6
#define         OFS_SCRATCH_PAD         7

#define         OFS_DIVISOR_LSB         0
#define         OFS_DIVISOR_MSB         1


/* memory-mapped read/write of the port */
#define UART16550_READ(y)    (*((volatile uint8*)(DEBUG_BASE + y)))
#define UART16550_WRITE(y,z) ((*((volatile uint8*)(DEBUG_BASE + y))) = z)

void debugInit(uint32 baud, uint8 data, uint8 parity, uint8 stop)
{
    uint16 mask;

    /* disable interrupts */
    UART16550_WRITE(OFS_INTR_ENABLE, 0);

    /* turn on the clocks to the serial port */
    mask = *((volatile uint16 *)(0xAF000808));
    mask &= ~0x0001;
    *((volatile uint16 *)(0xAF000808)) = mask;

    mask = *((volatile uint16 *)(0xAF000060));
    mask |= 0x0802;
    *((volatile uint16 *)(0xAF000060)) = mask;

    /* set up buad rate */
    { 
        uint32 divisor;
       
        /* set DIAB bit */
        UART16550_WRITE(OFS_LINE_CONTROL, 0x80);
        
        /* set divisor */
        divisor = MAX_BAUD / baud;
        UART16550_WRITE(OFS_DIVISOR_LSB, divisor & 0xff);
        UART16550_WRITE(OFS_DIVISOR_MSB, (divisor & 0xff00)>>8);

        /* clear DIAB bit */
        UART16550_WRITE(OFS_LINE_CONTROL, 0x0);
    }

    /* set data format */
    UART16550_WRITE(OFS_DATA_FORMAT, data | parity | stop);
}

static int remoteDebugInitialized = 0;

uint8 getDebugChar(void)
{
    if (!remoteDebugInitialized) {
	remoteDebugInitialized = 1;
	debugInit(UART16550_BAUD_115200,
		  UART16550_DATA_8BIT,
		  UART16550_PARITY_NONE,
		  UART16550_STOP_1BIT);
    }

    while((UART16550_READ(OFS_LINE_STATUS) & 0x1) == 0);
    return UART16550_READ(OFS_RCV_BUFFER);
}


int putDebugChar(uint8 byte)
{
    if (!remoteDebugInitialized) {
	remoteDebugInitialized = 1;
	debugInit(UART16550_BAUD_115200,
		  UART16550_DATA_8BIT,
		  UART16550_PARITY_NONE,
		  UART16550_STOP_1BIT);
    }

    while ((UART16550_READ(OFS_LINE_STATUS) &0x20) == 0);
    UART16550_WRITE(OFS_SEND_BUFFER, byte);
    return 1;
}

#endif
