Colony » Colony Scout

/*-

 * Copyright (c) 2008-2009, Kohsuke Ohtani

 * All rights reserved.

 *

 * Redistribution and use in source and binary forms, with or without

 * modification, are permitted provided that the following conditions

 * are met:

 * 1. Redistributions of source code must retain the above copyright

 *    notice, this list of conditions and the following disclaimer.

 * 2. 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.

 * 3. Neither the name of the author nor the names of any co-contributors

 *    may be used to endorse or promote products derived from this software

 *    without specific prior written permission.

 *

 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``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 OR CONTRIBUTORS 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.

 */

/*

 * machdep.c - machine-dependent routines for ARM Integrator-CP

 */

#include <machine/syspage.h>

#include <sys/power.h>

#include <sys/bootinfo.h>

#include <kernel.h>

#include <page.h>

#include <mmu.h>

#include <cpu.h>

#include <cpufunc.h>

#include <locore.h>

#include "platform.h"

/* System control reg */

#define SC_CTRL                (*(volatile uint32_t *)(FPGA_BASE + 0x0c))

#define SCCTRL_SOFTRESET        0x08

#ifdef CONFIG_MMU

/*

 * Virtual and physical address mapping

 *

 *      { virtual, physical, size, type }

 */

struct mmumap mmumap_table[] =

{

        /*

         * Internal SRAM (4M)

         */

        { 0x80000000, 0x00000000, 0x400000, VMT_RAM },

        /*

         * FPGA core control (4K)

         */

        { 0xD0000000, 0x10000000, 0x1000, VMT_IO },

        /*

         * Counter/Timers (1M)

         */

        { 0xD3000000, 0x13000000, 0x100000, VMT_IO },

        /*

         * Interrupt controller (1M)

         */

        { 0xD4000000, 0x14000000, 0x100000, VMT_IO },

        /*

         * Real-time clock (1M)

         */

        { 0xD5000000, 0x15000000, 0x100000, VMT_IO },

        /*

         * UART 0 (1M)

         */

        { 0xD6000000, 0x16000000, 0x100000, VMT_IO },

        { 0,0,0,0 }

};

#endif

/*

 * Idle

 */

void

machine_idle(void)

{

        cpu_idle();

}

/*

 * Reset system.

 */

static void

machine_reset(void)

{

        SC_CTRL = SCCTRL_SOFTRESET;

        for (;;) ;

        /* NOTREACHED */

}

/*

 * Set system power

 */

void

machine_powerdown(int state)

{

        splhigh();

        DPRINTF(("Power down machine\n"));

        switch (state) {

        case PWR_OFF:

                for (;;)

                        cpu_idle();

                /* NOTREACHED */

                break;

        case PWR_REBOOT:

                machine_reset();

                /* NOTREACHED */

                break;

        }

}

/*

 * Return pointer to the boot information.

 */

void

machine_bootinfo(struct bootinfo **bip)

{

        *bip = (struct bootinfo *)BOOTINFO;

}

void

machine_abort(void)

{

        for (;;)

                cpu_idle();

}

/*

 * Machine-dependent startup code

 */

void

machine_startup(void)

{

        /*

         * Initialize CPU and basic hardware.

         */

        cpu_init();

        cache_init();

        /*

         * Reserve system pages.

         */

        page_reserve(kvtop(SYSPAGE), SYSPAGESZ);

        /*

         * Setup vector page.

         */

        vector_copy((vaddr_t)ptokv(CONFIG_ARM_VECTORS));

#ifdef CONFIG_MMU

        /*

         * Initialize MMU

         */

        mmu_init(mmumap_table);

#endif

}