Subversion Repositories c0or1k

/*

 * PB11MPCORE platform-specific initialisation and setup

 *

 * Copyright (C) 2007 Bahadir Balban

 */

#include <l4/generic/platform.h>

#include <l4/generic/space.h>

#include <l4/generic/irq.h>

#include INC_ARCH(linker.h)

#include INC_SUBARCH(mm.h)

#include INC_SUBARCH(mmu_ops.h)

#include INC_GLUE(memory.h)

#include INC_GLUE(memlayout.h)

#include INC_PLAT(offsets.h)

#include INC_PLAT(platform.h)

#include INC_PLAT(uart.h)

#include INC_PLAT(irq.h)

#include INC_ARCH(asm.h)

/*

 * The devices that are used by the kernel are mapped

 * independent of these capabilities, but these provide a

 * concise description of what is used by the kernel.

 */

int platform_setup_device_caps(struct kernel_resources *kres)

{

        struct capability *uart[4], *timer[4];

        /* Setup capabilities for userspace uarts and timers */

        uart[1] =  alloc_bootmem(sizeof(*uart[1]), 0);

        uart[1]->start = __pfn(PLATFORM_UART1_BASE);

        uart[1]->end = uart[1]->start + 1;

        uart[1]->size = uart[1]->end - uart[1]->start;

        cap_set_devtype(uart[1], CAP_DEVTYPE_UART);

        cap_set_devnum(uart[1], 1);

        link_init(&uart[1]->list);

        cap_list_insert(uart[1], &kres->devmem_free);

        uart[2] =  alloc_bootmem(sizeof(*uart[2]), 0);

        uart[2]->start = __pfn(PLATFORM_UART2_BASE);

        uart[2]->end = uart[2]->start + 1;

        uart[2]->size = uart[2]->end - uart[2]->start;

        cap_set_devtype(uart[2], CAP_DEVTYPE_UART);

        cap_set_devnum(uart[2], 2);

        link_init(&uart[2]->list);

        cap_list_insert(uart[2], &kres->devmem_free);

        uart[3] =  alloc_bootmem(sizeof(*uart[3]), 0);

        uart[3]->start = __pfn(PLATFORM_UART3_BASE);

        uart[3]->end = uart[3]->start + 1;

        uart[3]->size = uart[3]->end - uart[3]->start;

        cap_set_devtype(uart[3], CAP_DEVTYPE_UART);

        cap_set_devnum(uart[3], 3);

        link_init(&uart[3]->list);

        cap_list_insert(uart[3], &kres->devmem_free);

        /* Setup timer1 capability as free */

        timer[1] =  alloc_bootmem(sizeof(*timer[1]), 0);

        timer[1]->start = __pfn(PLATFORM_TIMER1_BASE);

        timer[1]->end = timer[1]->start + 1;

        timer[1]->size = timer[1]->end - timer[1]->start;

        cap_set_devtype(timer[1], CAP_DEVTYPE_TIMER);

        cap_set_devnum(timer[1], 1);

        link_init(&timer[1]->list);

        cap_list_insert(timer[1], &kres->devmem_free);

        /* Setup timer2 capability as free */

        timer[2] =  alloc_bootmem(sizeof(*timer[2]), 0);

        timer[2]->start = __pfn(PLATFORM_TIMER2_BASE);

        timer[2]->end = timer[2]->start + 1;

        timer[2]->size = timer[2]->end - timer[2]->start;

        cap_set_devtype(timer[2], CAP_DEVTYPE_TIMER);

        cap_set_devnum(timer[2], 1);

        link_init(&timer[2]->list);

        cap_list_insert(timer[2], &kres->devmem_free);

        /* Setup timer3 capability as free */

        timer[3] =  alloc_bootmem(sizeof(*timer[3]), 0);

        timer[3]->start = __pfn(PLATFORM_TIMER3_BASE);

        timer[3]->end = timer[3]->start + 1;

        timer[3]->size = timer[3]->end - timer[3]->start;

        cap_set_devtype(timer[3], CAP_DEVTYPE_TIMER);

        cap_set_devnum(timer[3], 1);

        link_init(&timer[3]->list);

        cap_list_insert(timer[3], &kres->devmem_free);

        return 0;

}

void init_platform_irq_controller()

{

#if 0

        add_boot_mapping(PB926_VIC_BASE, PLATFORM_IRQCTRL_BASE, PAGE_SIZE,

                    MAP_IO_DEFAULT);

        add_boot_mapping(PB926_SIC_BASE, PLATFORM_SIRQCTRL_BASE, PAGE_SIZE,

                    MAP_IO_DEFAULT);

        irq_controllers_init();

#endif

}

void init_platform_devices()

{

        /* We need SYSCTRL1 for initializing TIMER2 and 3 */

        add_boot_mapping(PLATFORM_SYSCTRL1_BASE, PLATFORM_SYSCTRL1_VBASE,

                         PAGE_SIZE, MAP_IO_DEFAULT);

        /* Add userspace devices here as you develop their irq handlers */

        add_boot_mapping(PLATFORM_TIMER1_BASE, PLATFORM_TIMER1_VBASE,

                         PAGE_SIZE, MAP_IO_DEFAULT);

        add_boot_mapping(PLATFORM_TIMER2_BASE, PLATFORM_TIMER2_VBASE,

                         PAGE_SIZE, MAP_IO_DEFAULT);

        add_boot_mapping(PLATFORM_TIMER3_BASE, PLATFORM_TIMER3_VBASE,

                         PAGE_SIZE, MAP_IO_DEFAULT);

}