125 lines
3.4 KiB
C
125 lines
3.4 KiB
C
|
|
|
|
#ifdef CONFIG_KGDB
|
|
|
|
/* --- CONFIG --- */
|
|
|
|
/* we need uint32 uint8 */
|
|
/* #include "types.h" */
|
|
typedef unsigned char uint8;
|
|
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 0xB40003F8 /* 8712 serial port 1 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)
|
|
{
|
|
/* disable interrupts */
|
|
UART16550_WRITE(OFS_INTR_ENABLE, 0);
|
|
|
|
/* set up baud 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
|