Subversion Repositories or1k_soc_on_altera_embedded_dev_kit

/*
 * udbg serial input/output routines for the Marvell MV64x60 (Discovery).
 *
 * Author: Dale Farnsworth <dale@farnsworth.org>
 *
 * 2007 (c) MontaVista Software, Inc.  This file is licensed under
 * the terms of the GNU General Public License version 2.  This program
 * is licensed "as is" without any warranty of any kind, whether express
 * or implied.
 */
 
#include <asm/io.h>
#include <asm/prom.h>
#include <asm/udbg.h>
 
#include <sysdev/mv64x60.h>
 
#define MPSC_0_CR1_OFFSET	0x000c
 
#define MPSC_0_CR2_OFFSET	0x0010
#define MPSC_CHR_2_TCS		(1 << 9)
 
#define MPSC_0_CHR_10_OFFSET	0x0030
 
#define MPSC_INTR_CAUSE_OFF_0	0x0004
#define MPSC_INTR_CAUSE_OFF_1	0x000c
#define MPSC_INTR_CAUSE_RCC	(1<<6)
 
static void __iomem *mpsc_base;
static void __iomem *mpsc_intr_cause;
 
static void mv64x60_udbg_putc(char c)
{
	if (c == '\n')
		mv64x60_udbg_putc('\r');
 
	while(in_le32(mpsc_base + MPSC_0_CR2_OFFSET) & MPSC_CHR_2_TCS)
		;
	out_le32(mpsc_base + MPSC_0_CR1_OFFSET, c);
	out_le32(mpsc_base + MPSC_0_CR2_OFFSET, MPSC_CHR_2_TCS);
}
 
static int mv64x60_udbg_testc(void)
{
	return (in_le32(mpsc_intr_cause) & MPSC_INTR_CAUSE_RCC) != 0;
}
 
static int mv64x60_udbg_getc(void)
{
	int cause = 0;
	int c;
 
	while (!mv64x60_udbg_testc())
		;
 
	c = in_8(mpsc_base + MPSC_0_CHR_10_OFFSET + 2);
	out_8(mpsc_base + MPSC_0_CHR_10_OFFSET + 2, c);
	out_le32(mpsc_intr_cause, cause & ~MPSC_INTR_CAUSE_RCC);
	return c;
}
 
static int mv64x60_udbg_getc_poll(void)
{
	if (!mv64x60_udbg_testc())
		return -1;
 
	return mv64x60_udbg_getc();
}
 
static void mv64x60_udbg_init(void)
{
	struct device_node *np, *mpscintr, *stdout = NULL;
	const char *path;
	const phandle *ph;
	struct resource r[2];
	const int *block_index;
	int intr_cause_offset;
	int err;
 
	path = of_get_property(of_chosen, "linux,stdout-path", NULL);
	if (!path)
		return;
 
	stdout = of_find_node_by_path(path);
	if (!stdout)
		return;
 
	for (np = NULL;
	     (np = of_find_compatible_node(np, "serial", "marvell,mpsc")); )
		if (np == stdout)
			break;
 
	of_node_put(stdout);
	if (!np)
		return;
 
	block_index = of_get_property(np, "block-index", NULL);
	if (!block_index)
		goto error;
 
	switch (*block_index) {
	case 0:
		intr_cause_offset = MPSC_INTR_CAUSE_OFF_0;
		break;
	case 1:
		intr_cause_offset = MPSC_INTR_CAUSE_OFF_1;
		break;
	default:
		goto error;
	}
 
	err = of_address_to_resource(np, 0, &r[0]);
	if (err)
		goto error;
 
	ph = of_get_property(np, "mpscintr", NULL);
	mpscintr = of_find_node_by_phandle(*ph);
	if (!mpscintr)
		goto error;
 
	err = of_address_to_resource(mpscintr, 0, &r[1]);
	of_node_put(mpscintr);
	if (err)
		goto error;
 
	of_node_put(np);
 
	mpsc_base = ioremap(r[0].start, r[0].end - r[0].start + 1);
	if (!mpsc_base)
		return;
 
	mpsc_intr_cause = ioremap(r[1].start, r[1].end - r[1].start + 1);
	if (!mpsc_intr_cause) {
		iounmap(mpsc_base);
		return;
	}
	mpsc_intr_cause += intr_cause_offset;
 
	udbg_putc = mv64x60_udbg_putc;
	udbg_getc = mv64x60_udbg_getc;
	udbg_getc_poll = mv64x60_udbg_getc_poll;
 
	return;
 
error:
	of_node_put(np);
}
 
void mv64x60_init_early(void)
{
	mv64x60_udbg_init();
}