Subversion Repositories or1k

/*
 *  linux/arch/or32/kernel/dbgport.c
 *
 *  or32 version
 *    author(s): Simon Srot (srot@opencores.org)
 *
 *  changes:
 *  18. 11. 2003: Matjaz Breskvar (phoenix@opencores.org)
 *    initial port to or32 architecture
 *
 */
 
#include <linux/kernel.h> 
#include <linux/init.h>
#include <linux/major.h>
#include <linux/console.h>
#include <linux/serial_reg.h>
#include <asm/system.h>
#include <asm/board.h>
 
#define BASE_BAUD_OR1K ( SYS_CLK / 16 )
 
#define REG8(x) (*(volatile unsigned char *)(x))
 
#define BOTH_EMPTY (UART_LSR_TEMT | UART_LSR_THRE)
#define WAIT_FOR_XMITR \
 do { \
       lsr = REG8(UART_BASE_ADD + UART_LSR); \
 } while ((lsr & BOTH_EMPTY) != BOTH_EMPTY)
 
kdev_t or32_console_device(struct console *c)
{
	return MKDEV(TTY_MAJOR, 64 + c->index);
}
 
int or32_console_setup(struct console *co, char *options)
{
 
	int devisor;
 
	/* Reset receiver and transmiter */
	REG8(UART_BASE_ADD + UART_FCR) = UART_FCR_ENABLE_FIFO | UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT;
 
	/* Disable all interrupts */
	REG8(UART_BASE_ADD + UART_IER) = 0x00;
 
	/* Set 8 bit char, 1 stop bit, no parity */
	REG8(UART_BASE_ADD + UART_LCR) = UART_LCR_WLEN8 & ~(UART_LCR_STOP | UART_LCR_PARITY); 
 
	/* Set baud rate */
	devisor = BASE_BAUD_OR1K/OR32_CONSOLE_BAUD;
	REG8(UART_BASE_ADD + UART_LCR) |= UART_LCR_DLAB;
	REG8(UART_BASE_ADD + UART_DLL) = devisor & 0x000000ff;
	REG8(UART_BASE_ADD + UART_DLM) = (devisor >> 8) & 0x000000ff;
	REG8(UART_BASE_ADD + UART_LCR) &= ~(UART_LCR_DLAB); 
 
	return 0;
}
 
 
void or32_console_write(struct console *co, const char *buf, unsigned int len)
{
 
	char c;
	unsigned char ier, lsr;
	unsigned long flags;
 
	extern void putc(char);
 
	save_flags(flags);
	cli();
 
	ier = REG8(UART_BASE_ADD + UART_IER);
	REG8(UART_BASE_ADD + UART_IER) = 0x00;
 
	for (; len; len--, buf++) {
		c = *buf;
 
		WAIT_FOR_XMITR;
		REG8(UART_BASE_ADD + UART_TX) = c;
 
		if (c == '\n') {
			WAIT_FOR_XMITR;
			REG8(UART_BASE_ADD + UART_TX) = '\r';
		}
	}
 
	WAIT_FOR_XMITR;
	REG8(UART_BASE_ADD + UART_IER) = ier;
 
	/* Dummy read to clear all pending interrupt */
	REG8(UART_BASE_ADD + UART_IIR);
	REG8(UART_BASE_ADD + UART_LSR);
 
	restore_flags(flags);
 
	return;
}
 
static struct console or32_console = {
	name:    "ttyS",
	write:   or32_console_write,
	device:  or32_console_device,
	unblank: NULL,
	setup:   or32_console_setup,
	flags:   CON_PRINTBUFFER,
	index:   -1,
	cflag:   0,
	next:    NULL
};
 
void __init init_or32_console(void)
{
        register_console(&or32_console);
}