setup.c

Go to the documentation of this file.

/*
 * setup.c: Setup pointers to hardware dependent routines.
 *
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file "COPYING" in the main directory of this archive
 * for more details.
 *
 * Copyright (C) 1996, 1997, 2004 by Ralf Baechle ([email protected])
 * Copyright (C) 2006, Wind River System Inc. Rongkai.zhan <[email protected]>
 */
#include <linux/init.h>
#include <linux/string.h>
#include <linux/kernel.h>
#include <linux/pm.h>

#include <asm/io.h>
#include <asm/bootinfo.h>
#include <asm/reboot.h>
#include <asm/time.h>
#include <asm/gt64120.h>

unsigned long gt64120_base = KSEG1ADDR(0x14000000);

#ifdef WRPPMC_EARLY_DEBUG

static volatile unsigned char * wrppmc_led = \
    (volatile unsigned char *)KSEG1ADDR(WRPPMC_LED_BASE);

/*
 * PPMC LED control register:
 * -) bit[0] controls DS1 LED (1 - OFF, 0 - ON)
 * -) bit[1] controls DS2 LED (1 - OFF, 0 - ON)
 * -) bit[2] controls DS4 LED (1 - OFF, 0 - ON)
 */
void wrppmc_led_on(int mask)
{
    unsigned char value = *wrppmc_led;

    value &= (0xF8 | mask);
    *wrppmc_led = value;
}

/* If mask = 0, turn off all LEDs */
void wrppmc_led_off(int mask)
{
    unsigned char value = *wrppmc_led;

    value |= (0x7 & mask);
    *wrppmc_led = value;
}

/*
 * We assume that bootloader has initialized UART16550 correctly
 */
void __init wrppmc_early_putc(char ch)
{
    static volatile unsigned char *wrppmc_uart = \
        (volatile unsigned char *)KSEG1ADDR(WRPPMC_UART16550_BASE);
    unsigned char value;

    /* Wait until Transmit-Holding-Register is empty */
    while (1) {
        value = *(wrppmc_uart + 5);
        if (value & 0x20)
            break;
    }

    *wrppmc_uart = ch;
}

void __init wrppmc_early_printk(const char *fmt, ...)
{
    static char pbuf[256] = {'\0', };
    char *ch = pbuf;
    va_list args;
    unsigned int i;

    memset(pbuf, 0, 256);
    va_start(args, fmt);
    i = vsprintf(pbuf, fmt, args);
    va_end(args);

    /* Print the string */
    while (*ch != '\0') {
        wrppmc_early_putc(*ch);
        /* if print '\n', also print '\r' */
        if (*ch++ == '\n')
            wrppmc_early_putc('\r');
    }
}
#endif /* WRPPMC_EARLY_DEBUG */

void __init prom_free_prom_memory(void)
{
}

void __init plat_mem_setup(void)
{
    extern void wrppmc_machine_restart(char *command);
    extern void wrppmc_machine_halt(void);

    _machine_restart = wrppmc_machine_restart;
    _machine_halt    = wrppmc_machine_halt;
    pm_power_off     = wrppmc_machine_halt;

    /* This makes the operations of 'in/out[bwl]' to the
     * physical address ( < KSEG0) can work via KSEG1
     */
    set_io_port_base(KSEG1);
}

const char *get_system_type(void)
{
    return "Wind River PPMC (GT64120)";
}

/*
 * Initializes basic routines and structures pointers, memory size (as
 * given by the bios and saves the command line.
 */
void __init prom_init(void)
{
    add_memory_region(WRPPMC_SDRAM_SCS0_BASE, WRPPMC_SDRAM_SCS0_SIZE, BOOT_MEM_RAM);
    add_memory_region(WRPPMC_BOOTROM_BASE, WRPPMC_BOOTROM_SIZE, BOOT_MEM_ROM_DATA);

    wrppmc_early_printk("prom_init: GT64120 SDRAM Bank 0: 0x%x - 0x%08lx\n",
            WRPPMC_SDRAM_SCS0_BASE, (WRPPMC_SDRAM_SCS0_BASE + WRPPMC_SDRAM_SCS0_SIZE));
}