source: mainline/kernel/arch/sparc32/src/machine/leon3/leon3.c@ bbb94545

/*
 * Copyright (c) 2013 Jakub Klama
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */

/** @addtogroup sparc32
 * @{
 */
/** @file
 */

#include <arch.h>
#include <typedefs.h>
#include <arch/interrupt.h>
#include <arch/asm.h>
#include <arch/machine_func.h>

#include <arch/machine/leon3/leon3.h>

#include <genarch/drivers/grlib_uart/grlib_uart.h>
#include <genarch/drivers/grlib_irqmp/grlib_irqmp.h>
#include <genarch/srln/srln.h>

#include <func.h>
#include <config.h>
#include <errno.h>
#include <context.h>
#include <fpu_context.h>
#include <interrupt.h>
#include <syscall/copy.h>
#include <ddi/irq.h>
#include <proc/thread.h>
#include <syscall/syscall.h>
#include <console/console.h>
#include <macros.h>
#include <memstr.h>
#include <str.h>

static void leon3_init(bootinfo_t *);
static void leon3_cpu_halt(void);
static void leon3_get_memory_extents(uintptr_t *, size_t *);
static void leon3_timer_start(void);
static void leon3_irq_exception(unsigned int, istate_t *);
static void leon3_output_init(void);
static void leon3_input_init(void);
static size_t leon3_get_irq_count(void);
static const char *leon3_get_platform_name(void);

struct leon3_machine_t
{
        bootinfo_t *bootinfo;
        outdev_t *scons_dev;
        grlib_irqmp_t irqmp;
        //grlib_timer_t timer;
};

struct sparc_machine_ops leon3_machine_ops = {
        leon3_init,
        leon3_cpu_halt,
        leon3_get_memory_extents,
        leon3_timer_start,
        leon3_irq_exception,
        leon3_output_init,
        leon3_input_init,
        leon3_get_irq_count,
        leon3_get_platform_name
};

static struct leon3_machine_t machine;

static void leon3_init(bootinfo_t *bootinfo)
{
        machine.bootinfo = bootinfo;

        grlib_irqmp_init(&machine.irqmp, bootinfo);
}

static void leon3_cpu_halt(void)
{
        for (;;);
}

static void leon3_get_memory_extents(uintptr_t *start, size_t *size)
{
        *start = LEON3_SDRAM_START;
        *size = 64 * 1024 * 1024;//machine.bootinfo->memsize;
}

static void leon3_timer_start(void)
{
        //machine.timer = grlib_timer_init(machine.bootinfo->timer_base, machine.bootinfo->timer_irq);
}

static void leon3_irq_exception(unsigned int exc_no, istate_t *istate)
{
        int irqnum = grlib_irqmp_inum_get(&machine.irqmp);

        grlib_irqmp_clear(&machine.irqmp, irqnum);

        irq_t *irq = irq_dispatch_and_lock(irqnum);
        if (irq) {
                irq->handler(irq);
                spinlock_unlock(&irq->lock);
        } else
                printf("cpu%d: spurious interrupt (irq=%d)\n", CPU->id, irqnum);
}

static void leon3_output_init(void)
{
        printf("leon3_output_init\n");
        printf("machine.bootinfo=%p, machine.bootinfo->uart_base=0x%08x\n", machine.bootinfo, machine.bootinfo->uart_base);

        machine.scons_dev = grlib_uart_init(machine.bootinfo->uart_base, machine.bootinfo->uart_irq);

        if (machine.scons_dev)
                stdout_wire(machine.scons_dev);
}

static void leon3_input_init(void)
{
#if 0
        grlib_uart_t *scons_inst;
        
        if (machine.scons_dev) {
                /* Create input device. */
                scons_inst = (void *)machine.scons_dev->data;

                srln_instance_t *srln_instance = srln_init();
                if (srln_instance) {
                        indev_t *sink = stdin_wire();
                        indev_t *srln = srln_wire(srln_instance, sink);
                        grlib_uart_input_wire(scons_inst, srln);

                        /* Enable interrupts from UART */
                        grlib_irqmp_unmask(&machine.irqmp, machine.bootinfo->uart_irq);
                }
        }
#endif
}

static size_t leon3_get_irq_count(void)
{
        return LEON3_IRQ_COUNT;
}

static const char *leon3_get_platform_name(void)
{
        return "LEON3";
}