msp_setup.c

Go to the documentation of this file.

/*
 * The generic setup file for PMC-Sierra MSP processors
 *
 * Copyright 2005-2007 PMC-Sierra, Inc,
 * Author: Jun Sun, [email protected] or [email protected]
 *
 * This program is free software; you can redistribute  it and/or modify it
 * under  the terms of  the GNU General  Public License as published by the
 * Free Software Foundation;  either version 2 of the  License, or (at your
 * option) any later version.
 */

#include <asm/bootinfo.h>
#include <asm/cacheflush.h>
#include <asm/r4kcache.h>
#include <asm/reboot.h>
#include <asm/smp-ops.h>
#include <asm/time.h>

#include <msp_prom.h>
#include <msp_regs.h>

#if defined(CONFIG_PMC_MSP7120_GW)
#include <msp_regops.h>
#define MSP_BOARD_RESET_GPIO    9
#endif

extern void msp_serial_setup(void);
extern void pmctwiled_setup(void);

#if defined(CONFIG_PMC_MSP7120_EVAL) || \
    defined(CONFIG_PMC_MSP7120_GW) || \
    defined(CONFIG_PMC_MSP7120_FPGA)
/*
 * Performs the reset for MSP7120-based boards
 */
void msp7120_reset(void)
{
    void *start, *end, *iptr;
    register int i;

    /* Diasble all interrupts */
    local_irq_disable();
#ifdef CONFIG_SYS_SUPPORTS_MULTITHREADING
    dvpe();
#endif

    /* Cache the reset code of this function */
    __asm__ __volatile__ (
        "   .set    push                \n"
        "   .set    mips3               \n"
        "   la  %0,startpoint           \n"
        "   la  %1,endpoint         \n"
        "   .set    pop             \n"
        : "=r" (start), "=r" (end)
        :
    );

    for (iptr = (void *)((unsigned int)start & ~(L1_CACHE_BYTES - 1));
         iptr < end; iptr += L1_CACHE_BYTES)
        cache_op(Fill, iptr);

    __asm__ __volatile__ (
        "startpoint:                    \n"
    );

    /* Put the DDRC into self-refresh mode */
    DDRC_INDIRECT_WRITE(DDRC_CTL(10), 0xb, 1 << 16);

    /*
     * IMPORTANT!
     * DO NOT do anything from here on out that might even
     * think about fetching from RAM - i.e., don't call any
     * non-inlined functions, and be VERY sure that any inline
     * functions you do call do NOT access any sort of RAM
     * anywhere!
     */

    /* Wait a bit for the DDRC to settle */
    for (i = 0; i < 100000000; i++);

#if defined(CONFIG_PMC_MSP7120_GW)
    /*
     * Set GPIO 9 HI, (tied to board reset logic)
     * GPIO 9 is the 4th GPIO of register 3
     *
     * NOTE: We cannot use the higher-level msp_gpio_mode()/out()
     * as GPIO char driver may not be enabled and it would look up
     * data inRAM!
     */
    set_value_reg32(GPIO_CFG3_REG, 0xf000, 0x8000);
    set_reg32(GPIO_DATA3_REG, 8);

    /*
     * In case GPIO9 doesn't reset the board (jumper configurable!)
     * fallback to device reset below.
     */
#endif
    /* Set bit 1 of the MSP7120 reset register */
    *RST_SET_REG = 0x00000001;

    __asm__ __volatile__ (
        "endpoint:                  \n"
    );
}
#endif

void msp_restart(char *command)
{
    printk(KERN_WARNING "Now rebooting .......\n");

#if defined(CONFIG_PMC_MSP7120_EVAL) || \
    defined(CONFIG_PMC_MSP7120_GW) || \
    defined(CONFIG_PMC_MSP7120_FPGA)
    msp7120_reset();
#else
    /* No chip-specific reset code, just jump to the ROM reset vector */
    set_c0_status(ST0_BEV | ST0_ERL);
    change_c0_config(CONF_CM_CMASK, CONF_CM_UNCACHED);
    flush_cache_all();
    write_c0_wired(0);

    __asm__ __volatile__("jr\t%0"::"r"(0xbfc00000));
#endif
}

void msp_halt(void)
{
    printk(KERN_WARNING "\n** You can safely turn off the power\n");
    while (1)
        /* If possible call official function to get CPU WARs */
        if (cpu_wait)
            (*cpu_wait)();
        else
            __asm__(".set\tmips3\n\t" "wait\n\t" ".set\tmips0");
}

void msp_power_off(void)
{
    msp_halt();
}

void __init plat_mem_setup(void)
{
    _machine_restart = msp_restart;
    _machine_halt = msp_halt;
    pm_power_off = msp_power_off;
}

extern struct plat_smp_ops msp_smtc_smp_ops;

void __init prom_init(void)
{
    unsigned long family;
    unsigned long revision;

    prom_argc = fw_arg0;
    prom_argv = (char **)fw_arg1;
    prom_envp = (char **)fw_arg2;

    /*
     * Someday we can use this with PMON2000 to get a
     * platform call prom routines for output etc. without
     * having to use grody hacks.  For now it's unused.
     *
     * struct callvectors *cv = (struct callvectors *) fw_arg3;
     */
    family = identify_family();
    revision = identify_revision();

    switch (family) {
    case FAMILY_FPGA:
        if (FPGA_IS_MSP4200(revision)) {
            /* Old-style revision ID */
            mips_machtype = MACH_MSP4200_FPGA;
        } else {
            mips_machtype = MACH_MSP_OTHER;
        }
        break;

    case FAMILY_MSP4200:
#if defined(CONFIG_PMC_MSP4200_EVAL)
        mips_machtype  = MACH_MSP4200_EVAL;
#elif defined(CONFIG_PMC_MSP4200_GW)
        mips_machtype  = MACH_MSP4200_GW;
#else
        mips_machtype = MACH_MSP_OTHER;
#endif
        break;

    case FAMILY_MSP4200_FPGA:
        mips_machtype  = MACH_MSP4200_FPGA;
        break;

    case FAMILY_MSP7100:
#if defined(CONFIG_PMC_MSP7120_EVAL)
        mips_machtype = MACH_MSP7120_EVAL;
#elif defined(CONFIG_PMC_MSP7120_GW)
        mips_machtype = MACH_MSP7120_GW;
#else
        mips_machtype = MACH_MSP_OTHER;
#endif
        break;

    case FAMILY_MSP7100_FPGA:
        mips_machtype  = MACH_MSP7120_FPGA;
        break;

    default:
        /* we don't recognize the machine */
        mips_machtype  = MACH_UNKNOWN;
        panic("***Bogosity factor five***, exiting");
        break;
    }

    prom_init_cmdline();

    prom_meminit();

    /*
     * Sub-system setup follows.
     * Setup functions can  either be called here or using the
     * subsys_initcall mechanism (i.e. see msp_pci_setup). The
     * order in which they are called can be changed by using the
     * link order in arch/mips/pmc-sierra/msp71xx/Makefile.
     *
     * NOTE: Please keep sub-system specific initialization code
     * in separate specific files.
     */
    msp_serial_setup();

    if (register_vsmp_smp_ops()) {
#ifdef CONFIG_MIPS_MT_SMTC
        register_smp_ops(&msp_smtc_smp_ops);
#endif
    }

#ifdef CONFIG_PMCTWILED
    /*
     * Setup LED states before the subsys_initcall loads other
     * dependent drivers/modules.
     */
    pmctwiled_setup();
#endif
}