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();

}