Subversion Repositories or1k_soc_on_altera_embedded_dev_kit

/*

 * Common boot and setup code for both 32-bit and 64-bit.

 * Extracted from arch/powerpc/kernel/setup_64.c.

 *

 * Copyright (C) 2001 PPC64 Team, IBM Corp

 *

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

 */

#undef DEBUG

#include <linux/module.h>

#include <linux/string.h>

#include <linux/sched.h>

#include <linux/init.h>

#include <linux/kernel.h>

#include <linux/reboot.h>

#include <linux/delay.h>

#include <linux/initrd.h>

#include <linux/platform_device.h>

#include <linux/seq_file.h>

#include <linux/ioport.h>

#include <linux/console.h>

#include <linux/utsname.h>

#include <linux/screen_info.h>

#include <linux/root_dev.h>

#include <linux/notifier.h>

#include <linux/cpu.h>

#include <linux/unistd.h>

#include <linux/serial.h>

#include <linux/serial_8250.h>

#include <linux/debugfs.h>

#include <asm/io.h>

#include <asm/prom.h>

#include <asm/processor.h>

#include <asm/vdso_datapage.h>

#include <asm/pgtable.h>

#include <asm/smp.h>

#include <asm/elf.h>

#include <asm/machdep.h>

#include <asm/time.h>

#include <asm/cputable.h>

#include <asm/sections.h>

#include <asm/firmware.h>

#include <asm/btext.h>

#include <asm/nvram.h>

#include <asm/setup.h>

#include <asm/system.h>

#include <asm/rtas.h>

#include <asm/iommu.h>

#include <asm/serial.h>

#include <asm/cache.h>

#include <asm/page.h>

#include <asm/mmu.h>

#include <asm/lmb.h>

#include <asm/xmon.h>

#include "setup.h"

#ifdef DEBUG

#include <asm/udbg.h>

#define DBG(fmt...) udbg_printf(fmt)

#else

#define DBG(fmt...)

#endif

/* The main machine-dep calls structure

 */

struct machdep_calls ppc_md;

EXPORT_SYMBOL(ppc_md);

struct machdep_calls *machine_id;

EXPORT_SYMBOL(machine_id);

unsigned long klimit = (unsigned long) _end;

char cmd_line[COMMAND_LINE_SIZE];

/*

 * This still seems to be needed... -- paulus

 */

struct screen_info screen_info = {

        .orig_x = 0,

        .orig_y = 25,

        .orig_video_cols = 80,

        .orig_video_lines = 25,

        .orig_video_isVGA = 1,

        .orig_video_points = 16

};

#ifdef __DO_IRQ_CANON

/* XXX should go elsewhere eventually */

int ppc_do_canonicalize_irqs;

EXPORT_SYMBOL(ppc_do_canonicalize_irqs);

#endif

/* also used by kexec */

void machine_shutdown(void)

{

        if (ppc_md.machine_shutdown)

                ppc_md.machine_shutdown();

}

void machine_restart(char *cmd)

{

        machine_shutdown();

        if (ppc_md.restart)

                ppc_md.restart(cmd);

#ifdef CONFIG_SMP

        smp_send_stop();

#endif

        printk(KERN_EMERG "System Halted, OK to turn off power\n");

        local_irq_disable();

        while (1) ;

}

void machine_power_off(void)

{

        machine_shutdown();

        if (ppc_md.power_off)

                ppc_md.power_off();

#ifdef CONFIG_SMP

        smp_send_stop();

#endif

        printk(KERN_EMERG "System Halted, OK to turn off power\n");

        local_irq_disable();

        while (1) ;

}

/* Used by the G5 thermal driver */

EXPORT_SYMBOL_GPL(machine_power_off);

void (*pm_power_off)(void) = machine_power_off;

EXPORT_SYMBOL_GPL(pm_power_off);

void machine_halt(void)

{

        machine_shutdown();

        if (ppc_md.halt)

                ppc_md.halt();

#ifdef CONFIG_SMP

        smp_send_stop();

#endif

        printk(KERN_EMERG "System Halted, OK to turn off power\n");

        local_irq_disable();

        while (1) ;

}

#ifdef CONFIG_TAU

extern u32 cpu_temp(unsigned long cpu);

extern u32 cpu_temp_both(unsigned long cpu);

#endif /* CONFIG_TAU */

#ifdef CONFIG_SMP

DEFINE_PER_CPU(unsigned int, pvr);

#endif

static int show_cpuinfo(struct seq_file *m, void *v)

{

        unsigned long cpu_id = (unsigned long)v - 1;

        unsigned int pvr;

        unsigned short maj;

        unsigned short min;

        if (cpu_id == NR_CPUS) {

#if defined(CONFIG_SMP) && defined(CONFIG_PPC32)

                unsigned long bogosum = 0;

                int i;

                for_each_online_cpu(i)

                        bogosum += loops_per_jiffy;

                seq_printf(m, "total bogomips\t: %lu.%02lu\n",

                           bogosum/(500000/HZ), bogosum/(5000/HZ) % 100);

#endif /* CONFIG_SMP && CONFIG_PPC32 */

                seq_printf(m, "timebase\t: %lu\n", ppc_tb_freq);

                if (ppc_md.name)

                        seq_printf(m, "platform\t: %s\n", ppc_md.name);

                if (ppc_md.show_cpuinfo != NULL)

                        ppc_md.show_cpuinfo(m);

                return 0;

        }

        /* We only show online cpus: disable preempt (overzealous, I

         * knew) to prevent cpu going down. */

        preempt_disable();

        if (!cpu_online(cpu_id)) {

                preempt_enable();

                return 0;

        }

#ifdef CONFIG_SMP

        pvr = per_cpu(pvr, cpu_id);

#else

        pvr = mfspr(SPRN_PVR);

#endif

        maj = (pvr >> 8) & 0xFF;

        min = pvr & 0xFF;

        seq_printf(m, "processor\t: %lu\n", cpu_id);

        seq_printf(m, "cpu\t\t: ");

        if (cur_cpu_spec->pvr_mask)

                seq_printf(m, "%s", cur_cpu_spec->cpu_name);

        else

                seq_printf(m, "unknown (%08x)", pvr);

#ifdef CONFIG_ALTIVEC

        if (cpu_has_feature(CPU_FTR_ALTIVEC))

                seq_printf(m, ", altivec supported");

#endif /* CONFIG_ALTIVEC */

        seq_printf(m, "\n");

#ifdef CONFIG_TAU

        if (cur_cpu_spec->cpu_features & CPU_FTR_TAU) {

#ifdef CONFIG_TAU_AVERAGE

                /* more straightforward, but potentially misleading */

                seq_printf(m,  "temperature \t: %u C (uncalibrated)\n",

                           cpu_temp(cpu_id));

#else

                /* show the actual temp sensor range */

                u32 temp;

                temp = cpu_temp_both(cpu_id);

                seq_printf(m, "temperature \t: %u-%u C (uncalibrated)\n",

                           temp & 0xff, temp >> 16);

#endif

        }

#endif /* CONFIG_TAU */

        /*

         * Assume here that all clock rates are the same in a

         * smp system.  -- Cort

         */

        if (ppc_proc_freq)

                seq_printf(m, "clock\t\t: %lu.%06luMHz\n",

                           ppc_proc_freq / 1000000, ppc_proc_freq % 1000000);

        if (ppc_md.show_percpuinfo != NULL)

                ppc_md.show_percpuinfo(m, cpu_id);

        /* If we are a Freescale core do a simple check so

         * we dont have to keep adding cases in the future */

        if (PVR_VER(pvr) & 0x8000) {

                maj = PVR_MAJ(pvr);

                min = PVR_MIN(pvr);

        } else {

                switch (PVR_VER(pvr)) {

                        case 0x0020:    /* 403 family */

                                maj = PVR_MAJ(pvr) + 1;

                                min = PVR_MIN(pvr);

                                break;

                        case 0x1008:    /* 740P/750P ?? */

                                maj = ((pvr >> 8) & 0xFF) - 1;

                                min = pvr & 0xFF;

                                break;

                        default:

                                maj = (pvr >> 8) & 0xFF;

                                min = pvr & 0xFF;

                                break;

                }

        }

        seq_printf(m, "revision\t: %hd.%hd (pvr %04x %04x)\n",

                   maj, min, PVR_VER(pvr), PVR_REV(pvr));

#ifdef CONFIG_PPC32

        seq_printf(m, "bogomips\t: %lu.%02lu\n",

                   loops_per_jiffy / (500000/HZ),

                   (loops_per_jiffy / (5000/HZ)) % 100);

#endif

#ifdef CONFIG_SMP

        seq_printf(m, "\n");

#endif

        preempt_enable();

        return 0;

}

static void *c_start(struct seq_file *m, loff_t *pos)

{

        unsigned long i = *pos;

        return i <= NR_CPUS ? (void *)(i + 1) : NULL;

}

static void *c_next(struct seq_file *m, void *v, loff_t *pos)

{

        ++*pos;

        return c_start(m, pos);

}

static void c_stop(struct seq_file *m, void *v)

{

}

struct seq_operations cpuinfo_op = {

        .start =c_start,

        .next = c_next,

        .stop = c_stop,

        .show = show_cpuinfo,

};

void __init check_for_initrd(void)

{

#ifdef CONFIG_BLK_DEV_INITRD

        DBG(" -> check_for_initrd()  initrd_start=0x%lx  initrd_end=0x%lx\n",

            initrd_start, initrd_end);

        /* If we were passed an initrd, set the ROOT_DEV properly if the values

         * look sensible. If not, clear initrd reference.

         */

        if (is_kernel_addr(initrd_start) && is_kernel_addr(initrd_end) &&

            initrd_end > initrd_start)

                ROOT_DEV = Root_RAM0;

        else

                initrd_start = initrd_end = 0;

        if (initrd_start)

                printk("Found initrd at 0x%lx:0x%lx\n", initrd_start, initrd_end);

        DBG(" <- check_for_initrd()\n");

#endif /* CONFIG_BLK_DEV_INITRD */

}

#ifdef CONFIG_SMP

/**

 * setup_cpu_maps - initialize the following cpu maps:

 *                  cpu_possible_map

 *                  cpu_present_map

 *                  cpu_sibling_map

 *

 * Having the possible map set up early allows us to restrict allocations

 * of things like irqstacks to num_possible_cpus() rather than NR_CPUS.

 *

 * We do not initialize the online map here; cpus set their own bits in

 * cpu_online_map as they come up.

 *

 * This function is valid only for Open Firmware systems.  finish_device_tree

 * must be called before using this.

 *

 * While we're here, we may as well set the "physical" cpu ids in the paca.

 *

 * NOTE: This must match the parsing done in early_init_dt_scan_cpus.

 */

void __init smp_setup_cpu_maps(void)

{

        struct device_node *dn = NULL;

        int cpu = 0;

        while ((dn = of_find_node_by_type(dn, "cpu")) && cpu < NR_CPUS) {

                const int *intserv;

                int j, len = sizeof(u32), nthreads = 1;

                intserv = of_get_property(dn, "ibm,ppc-interrupt-server#s",

                                &len);

                if (intserv)

                        nthreads = len / sizeof(int);

                else {

                        intserv = of_get_property(dn, "reg", NULL);

                        if (!intserv)

                                intserv = &cpu; /* assume logical == phys */

                }

                for (j = 0; j < nthreads && cpu < NR_CPUS; j++) {

                        cpu_set(cpu, cpu_present_map);

                        set_hard_smp_processor_id(cpu, intserv[j]);

                        cpu_set(cpu, cpu_possible_map);

                        cpu++;

                }

        }

#ifdef CONFIG_PPC64

        /*

         * On pSeries LPAR, we need to know how many cpus

         * could possibly be added to this partition.

         */

        if (machine_is(pseries) && firmware_has_feature(FW_FEATURE_LPAR) &&

            (dn = of_find_node_by_path("/rtas"))) {

                int num_addr_cell, num_size_cell, maxcpus;

                const unsigned int *ireg;

                num_addr_cell = of_n_addr_cells(dn);

                num_size_cell = of_n_size_cells(dn);

                ireg = of_get_property(dn, "ibm,lrdr-capacity", NULL);

                if (!ireg)

                        goto out;

                maxcpus = ireg[num_addr_cell + num_size_cell];

                /* Double maxcpus for processors which have SMT capability */

                if (cpu_has_feature(CPU_FTR_SMT))

                        maxcpus *= 2;

                if (maxcpus > NR_CPUS) {

                        printk(KERN_WARNING

                               "Partition configured for %d cpus, "

                               "operating system maximum is %d.\n",

                               maxcpus, NR_CPUS);

                        maxcpus = NR_CPUS;

                } else

                        printk(KERN_INFO "Partition configured for %d cpus.\n",

                               maxcpus);

                for (cpu = 0; cpu < maxcpus; cpu++)

                        cpu_set(cpu, cpu_possible_map);

        out:

                of_node_put(dn);

        }

        vdso_data->processorCount = num_present_cpus();

#endif /* CONFIG_PPC64 */

}

/*

 * Being that cpu_sibling_map is now a per_cpu array, then it cannot

 * be initialized until the per_cpu areas have been created.  This

 * function is now called from setup_per_cpu_areas().

 */

void __init smp_setup_cpu_sibling_map(void)

{

#if defined(CONFIG_PPC64)

        int cpu;

        /*

         * Do the sibling map; assume only two threads per processor.

         */

        for_each_possible_cpu(cpu) {

                cpu_set(cpu, per_cpu(cpu_sibling_map, cpu));

                if (cpu_has_feature(CPU_FTR_SMT))

                        cpu_set(cpu ^ 0x1, per_cpu(cpu_sibling_map, cpu));

        }

#endif /* CONFIG_PPC64 */

}

#endif /* CONFIG_SMP */

static __init int add_pcspkr(void)

{

        struct device_node *np;

        struct platform_device *pd;

        int ret;

        np = of_find_compatible_node(NULL, NULL, "pnpPNP,100");

        of_node_put(np);

        if (!np)

                return -ENODEV;

        pd = platform_device_alloc("pcspkr", -1);

        if (!pd)

                return -ENOMEM;

        ret = platform_device_add(pd);

        if (ret)

                platform_device_put(pd);

        return ret;

}

device_initcall(add_pcspkr);

void probe_machine(void)

{

        extern struct machdep_calls __machine_desc_start;

        extern struct machdep_calls __machine_desc_end;

        /*

         * Iterate all ppc_md structures until we find the proper

         * one for the current machine type

         */

        DBG("Probing machine type ...\n");

        for (machine_id = &__machine_desc_start;

             machine_id < &__machine_desc_end;

             machine_id++) {

                DBG("  %s ...", machine_id->name);

                memcpy(&ppc_md, machine_id, sizeof(struct machdep_calls));

                if (ppc_md.probe()) {

                        DBG(" match !\n");

                        break;

                }

                DBG("\n");

        }

        /* What can we do if we didn't find ? */

        if (machine_id >= &__machine_desc_end) {

                DBG("No suitable machine found !\n");

                for (;;);

        }

        printk(KERN_INFO "Using %s machine description\n", ppc_md.name);

}

/* Match a class of boards, not a specific device configuration. */

int check_legacy_ioport(unsigned long base_port)

{

        struct device_node *parent, *np = NULL;

        int ret = -ENODEV;

        switch(base_port) {

        case I8042_DATA_REG:

                if (!(np = of_find_compatible_node(NULL, NULL, "pnpPNP,303")))

                        np = of_find_compatible_node(NULL, NULL, "pnpPNP,f03");

                if (np) {

                        parent = of_get_parent(np);

                        of_node_put(np);

                        np = parent;

                        break;

                }

                np = of_find_node_by_type(NULL, "8042");

                /* Pegasos has no device_type on its 8042 node, look for the

                 * name instead */

                if (!np)

                        np = of_find_node_by_name(NULL, "8042");

                break;

        case FDC_BASE: /* FDC1 */

                np = of_find_node_by_type(NULL, "fdc");

                break;

#ifdef CONFIG_PPC_PREP

        case _PIDXR:

        case _PNPWRP:

        case PNPBIOS_BASE:

                /* implement me */

#endif

        default:

                /* ipmi is supposed to fail here */

                break;

        }

        if (!np)

                return ret;

        parent = of_get_parent(np);

        if (parent) {

                if (strcmp(parent->type, "isa") == 0)

                        ret = 0;

                of_node_put(parent);

        }

        of_node_put(np);

        return ret;

}

EXPORT_SYMBOL(check_legacy_ioport);

static int ppc_panic_event(struct notifier_block *this,

                             unsigned long event, void *ptr)

{

        ppc_md.panic(ptr);  /* May not return */

        return NOTIFY_DONE;

}

static struct notifier_block ppc_panic_block = {

        .notifier_call = ppc_panic_event,

        .priority = INT_MIN /* may not return; must be done last */

};

void __init setup_panic(void)

{

        atomic_notifier_chain_register(&panic_notifier_list, &ppc_panic_block);

}

#ifdef CONFIG_CHECK_CACHE_COHERENCY

/*

 * For platforms that have configurable cache-coherency.  This function

 * checks that the cache coherency setting of the kernel matches the setting

 * left by the firmware, as indicated in the device tree.  Since a mismatch

 * will eventually result in DMA failures, we print * and error and call

 * BUG() in that case.

 */

#ifdef CONFIG_NOT_COHERENT_CACHE

#define KERNEL_COHERENCY        0

#else

#define KERNEL_COHERENCY        1

#endif

static int __init check_cache_coherency(void)

{

        struct device_node *np;

        const void *prop;

        int devtree_coherency;

        np = of_find_node_by_path("/");

        prop = of_get_property(np, "coherency-off", NULL);

        of_node_put(np);

        devtree_coherency = prop ? 0 : 1;

        if (devtree_coherency != KERNEL_COHERENCY) {

                printk(KERN_ERR

                        "kernel coherency:%s != device tree_coherency:%s\n",

                        KERNEL_COHERENCY ? "on" : "off",

                        devtree_coherency ? "on" : "off");

                BUG();

        }

        return 0;

}

late_initcall(check_cache_coherency);

#endif /* CONFIG_CHECK_CACHE_COHERENCY */

#ifdef CONFIG_DEBUG_FS

struct dentry *powerpc_debugfs_root;

static int powerpc_debugfs_init(void)

{

        powerpc_debugfs_root = debugfs_create_dir("powerpc", NULL);

        return powerpc_debugfs_root == NULL;

}

arch_initcall(powerpc_debugfs_init);

#endif