Manual merge of rsync://rsync.kernel.org/pub/scm/linux/kernel/git/jgarzik/netdev...

[GitHub/mt8127/android_kernel_alcatel_ttab.git] / arch / ia64 / sn / kernel / setup.c

/*
 * 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) 1999,2001-2005 Silicon Graphics, Inc. All rights reserved.
 */

#include <linux/config.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <linux/kernel.h>
#include <linux/kdev_t.h>
#include <linux/string.h>
#include <linux/tty.h>
#include <linux/console.h>
#include <linux/timex.h>
#include <linux/sched.h>
#include <linux/ioport.h>
#include <linux/mm.h>
#include <linux/serial.h>
#include <linux/irq.h>
#include <linux/bootmem.h>
#include <linux/mmzone.h>
#include <linux/interrupt.h>
#include <linux/acpi.h>
#include <linux/compiler.h>
#include <linux/sched.h>
#include <linux/root_dev.h>
#include <linux/nodemask.h>
#include <linux/pm.h>

#include <asm/io.h>
#include <asm/sal.h>
#include <asm/machvec.h>
#include <asm/system.h>
#include <asm/processor.h>
#include <asm/sn/arch.h>
#include <asm/sn/addrs.h>
#include <asm/sn/pda.h>
#include <asm/sn/nodepda.h>
#include <asm/sn/sn_cpuid.h>
#include <asm/sn/simulator.h>
#include <asm/sn/leds.h>
#include <asm/sn/bte.h>
#include <asm/sn/shub_mmr.h>
#include <asm/sn/clksupport.h>
#include <asm/sn/sn_sal.h>
#include <asm/sn/geo.h>
#include "xtalk/xwidgetdev.h"
#include "xtalk/hubdev.h"
#include <asm/sn/klconfig.h>


DEFINE_PER_CPU(struct pda_s, pda_percpu);

#define MAX_PHYS_MEMORY         (1UL << 49)     /* 1 TB */

lboard_t *root_lboard[MAX_COMPACT_NODES];

extern void bte_init_node(nodepda_t *, cnodeid_t);

extern void sn_timer_init(void);
extern unsigned long last_time_offset;
extern void (*ia64_mark_idle) (int);
extern void snidle(int);
extern unsigned char acpi_kbd_controller_present;

unsigned long sn_rtc_cycles_per_second;
EXPORT_SYMBOL(sn_rtc_cycles_per_second);

DEFINE_PER_CPU(struct sn_hub_info_s, __sn_hub_info);
EXPORT_PER_CPU_SYMBOL(__sn_hub_info);

DEFINE_PER_CPU(short, __sn_cnodeid_to_nasid[MAX_NUMNODES]);
EXPORT_PER_CPU_SYMBOL(__sn_cnodeid_to_nasid);

DEFINE_PER_CPU(struct nodepda_s *, __sn_nodepda);
EXPORT_PER_CPU_SYMBOL(__sn_nodepda);

partid_t sn_partid = -1;
EXPORT_SYMBOL(sn_partid);
char sn_system_serial_number_string[128];
EXPORT_SYMBOL(sn_system_serial_number_string);
u64 sn_partition_serial_number;
EXPORT_SYMBOL(sn_partition_serial_number);
u8 sn_partition_id;
EXPORT_SYMBOL(sn_partition_id);
u8 sn_system_size;
EXPORT_SYMBOL(sn_system_size);
u8 sn_sharing_domain_size;
EXPORT_SYMBOL(sn_sharing_domain_size);
u8 sn_coherency_id;
EXPORT_SYMBOL(sn_coherency_id);
u8 sn_region_size;
EXPORT_SYMBOL(sn_region_size);

short physical_node_map[MAX_PHYSNODE_ID];

EXPORT_SYMBOL(physical_node_map);

int numionodes;

static void sn_init_pdas(char **);
static void scan_for_ionodes(void);

static nodepda_t *nodepdaindr[MAX_COMPACT_NODES];

/*
 * The format of "screen_info" is strange, and due to early i386-setup
 * code. This is just enough to make the console code think we're on a
 * VGA color display.
 */
struct screen_info sn_screen_info = {
        .orig_x = 0,
        .orig_y = 0,
        .orig_video_mode = 3,
        .orig_video_cols = 80,
        .orig_video_ega_bx = 3,
        .orig_video_lines = 25,
        .orig_video_isVGA = 1,
        .orig_video_points = 16
};

/*
 * This is here so we can use the CMOS detection in ide-probe.c to
 * determine what drives are present.  In theory, we don't need this
 * as the auto-detection could be done via ide-probe.c:do_probe() but
 * in practice that would be much slower, which is painful when
 * running in the simulator.  Note that passing zeroes in DRIVE_INFO
 * is sufficient (the IDE driver will autodetect the drive geometry).
 */
#ifdef CONFIG_IA64_GENERIC
extern char drive_info[4 * 16];
#else
char drive_info[4 * 16];
#endif

/*
 * Get nasid of current cpu early in boot before nodepda is initialized
 */
static int
boot_get_nasid(void)
{
        int nasid;

        if (ia64_sn_get_sapic_info(get_sapicid(), &nasid, NULL, NULL))
                BUG();
        return nasid;
}

/*
 * This routine can only be used during init, since
 * smp_boot_data is an init data structure.
 * We have to use smp_boot_data.cpu_phys_id to find
 * the physical id of the processor because the normal
 * cpu_physical_id() relies on data structures that
 * may not be initialized yet.
 */

static int __init pxm_to_nasid(int pxm)
{
        int i;
        int nid;

        nid = pxm_to_nid_map[pxm];
        for (i = 0; i < num_node_memblks; i++) {
                if (node_memblk[i].nid == nid) {
                        return NASID_GET(node_memblk[i].start_paddr);
                }
        }
        return -1;
}

/**
 * early_sn_setup - early setup routine for SN platforms
 *
 * Sets up an initial console to aid debugging.  Intended primarily
 * for bringup.  See start_kernel() in init/main.c.
 */

void __init early_sn_setup(void)
{
        efi_system_table_t *efi_systab;
        efi_config_table_t *config_tables;
        struct ia64_sal_systab *sal_systab;
        struct ia64_sal_desc_entry_point *ep;
        char *p;
        int i, j;

        /*
         * Parse enough of the SAL tables to locate the SAL entry point. Since, console
         * IO on SN2 is done via SAL calls, early_printk won't work without this.
         *
         * This code duplicates some of the ACPI table parsing that is in efi.c & sal.c.
         * Any changes to those file may have to be made hereas well.
         */
        efi_systab = (efi_system_table_t *) __va(ia64_boot_param->efi_systab);
        config_tables = __va(efi_systab->tables);
        for (i = 0; i < efi_systab->nr_tables; i++) {
                if (efi_guidcmp(config_tables[i].guid, SAL_SYSTEM_TABLE_GUID) ==
                    0) {
                        sal_systab = __va(config_tables[i].table);
                        p = (char *)(sal_systab + 1);
                        for (j = 0; j < sal_systab->entry_count; j++) {
                                if (*p == SAL_DESC_ENTRY_POINT) {
                                        ep = (struct ia64_sal_desc_entry_point
                                              *)p;
                                        ia64_sal_handler_init(__va
                                                              (ep->sal_proc),
                                                              __va(ep->gp));
                                        return;
                                }
                                p += SAL_DESC_SIZE(*p);
                        }
                }
        }
        /* Uh-oh, SAL not available?? */
        printk(KERN_ERR "failed to find SAL entry point\n");
}

extern int platform_intr_list[];
extern nasid_t master_nasid;
static int __initdata shub_1_1_found = 0;

/*
 * sn_check_for_wars
 *
 * Set flag for enabling shub specific wars
 */

static inline int __init is_shub_1_1(int nasid)
{
        unsigned long id;
        int rev;

        if (is_shub2())
                return 0;
        id = REMOTE_HUB_L(nasid, SH1_SHUB_ID);
        rev = (id & SH1_SHUB_ID_REVISION_MASK) >> SH1_SHUB_ID_REVISION_SHFT;
        return rev <= 2;
}

static void __init sn_check_for_wars(void)
{
        int cnode;

        if (is_shub2()) {
                /* none yet */
        } else {
                for_each_online_node(cnode) {
                        if (is_shub_1_1(cnodeid_to_nasid(cnode)))
                                shub_1_1_found = 1;
                }
        }
}

/**
 * sn_setup - SN platform setup routine
 * @cmdline_p: kernel command line
 *
 * Handles platform setup for SN machines.  This includes determining
 * the RTC frequency (via a SAL call), initializing secondary CPUs, and
 * setting up per-node data areas.  The console is also initialized here.
 */
void __init sn_setup(char **cmdline_p)
{
        long status, ticks_per_sec, drift;
        int pxm;
        int major = sn_sal_rev_major(), minor = sn_sal_rev_minor();
        extern void sn_cpu_init(void);

        ia64_sn_plat_set_error_handling_features();

        /*
         * If the generic code has enabled vga console support - lets
         * get rid of it again. This is a kludge for the fact that ACPI
         * currtently has no way of informing us if legacy VGA is available
         * or not.
         */
#if defined(CONFIG_VT) && defined(CONFIG_VGA_CONSOLE)
        if (conswitchp == &vga_con) {
                printk(KERN_DEBUG "SGI: Disabling VGA console\n");
#ifdef CONFIG_DUMMY_CONSOLE
                conswitchp = &dummy_con;
#else
                conswitchp = NULL;
#endif                          /* CONFIG_DUMMY_CONSOLE */
        }
#endif                          /* def(CONFIG_VT) && def(CONFIG_VGA_CONSOLE) */

        MAX_DMA_ADDRESS = PAGE_OFFSET + MAX_PHYS_MEMORY;

        memset(physical_node_map, -1, sizeof(physical_node_map));
        for (pxm = 0; pxm < MAX_PXM_DOMAINS; pxm++)
                if (pxm_to_nid_map[pxm] != -1)
                        physical_node_map[pxm_to_nasid(pxm)] =
                            pxm_to_nid_map[pxm];

        /*
         * Old PROMs do not provide an ACPI FADT. Disable legacy keyboard
         * support here so we don't have to listen to failed keyboard probe
         * messages.
         */
        if ((major < 2 || (major == 2 && minor <= 9)) &&
            acpi_kbd_controller_present) {
                printk(KERN_INFO "Disabling legacy keyboard support as prom "
                       "is too old and doesn't provide FADT\n");
                acpi_kbd_controller_present = 0;
        }

        printk("SGI SAL version %x.%02x\n", major, minor);

        /*
         * Confirm the SAL we're running on is recent enough...
         */
        if ((major < SN_SAL_MIN_MAJOR) || (major == SN_SAL_MIN_MAJOR &&
                                           minor < SN_SAL_MIN_MINOR)) {
                printk(KERN_ERR "This kernel needs SGI SAL version >= "
                       "%x.%02x\n", SN_SAL_MIN_MAJOR, SN_SAL_MIN_MINOR);
                panic("PROM version too old\n");
        }

        master_nasid = boot_get_nasid();

        status =
            ia64_sal_freq_base(SAL_FREQ_BASE_REALTIME_CLOCK, &ticks_per_sec,
                               &drift);
        if (status != 0 || ticks_per_sec < 100000) {
                printk(KERN_WARNING
                       "unable to determine platform RTC clock frequency, guessing.\n");
                /* PROM gives wrong value for clock freq. so guess */
                sn_rtc_cycles_per_second = 1000000000000UL / 30000UL;
        } else
                sn_rtc_cycles_per_second = ticks_per_sec;

        platform_intr_list[ACPI_INTERRUPT_CPEI] = IA64_CPE_VECTOR;

        /*
         * we set the default root device to /dev/hda
         * to make simulation easy
         */
        ROOT_DEV = Root_HDA1;

        /*
         * Create the PDAs and NODEPDAs for all the cpus.
         */
        sn_init_pdas(cmdline_p);

        ia64_mark_idle = &snidle;

        /* 
         * For the bootcpu, we do this here. All other cpus will make the
         * call as part of cpu_init in slave cpu initialization.
         */
        sn_cpu_init();

#ifdef CONFIG_SMP
        init_smp_config();
#endif
        screen_info = sn_screen_info;

        sn_timer_init();

        /*
         * set pm_power_off to a SAL call to allow
         * sn machines to power off. The SAL call can be replaced
         * by an ACPI interface call when ACPI is fully implemented
         * for sn.
         */
        pm_power_off = ia64_sn_power_down;
}

/**
 * sn_init_pdas - setup node data areas
 *
 * One time setup for Node Data Area.  Called by sn_setup().
 */
static void __init sn_init_pdas(char **cmdline_p)
{
        cnodeid_t cnode;

        memset(sn_cnodeid_to_nasid, -1,
                        sizeof(__ia64_per_cpu_var(__sn_cnodeid_to_nasid)));
        for_each_online_node(cnode)
                sn_cnodeid_to_nasid[cnode] =
                                pxm_to_nasid(nid_to_pxm_map[cnode]);

        numionodes = num_online_nodes();
        scan_for_ionodes();

        /*
         * Allocate & initalize the nodepda for each node.
         */
        for_each_online_node(cnode) {
                nodepdaindr[cnode] =
                    alloc_bootmem_node(NODE_DATA(cnode), sizeof(nodepda_t));
                memset(nodepdaindr[cnode], 0, sizeof(nodepda_t));
                memset(nodepdaindr[cnode]->phys_cpuid, -1, 
                    sizeof(nodepdaindr[cnode]->phys_cpuid));
        }

        /*
         * Allocate & initialize nodepda for TIOs.  For now, put them on node 0.
         */
        for (cnode = num_online_nodes(); cnode < numionodes; cnode++) {
                nodepdaindr[cnode] =
                    alloc_bootmem_node(NODE_DATA(0), sizeof(nodepda_t));
                memset(nodepdaindr[cnode], 0, sizeof(nodepda_t));
        }

        /*
         * Now copy the array of nodepda pointers to each nodepda.
         */
        for (cnode = 0; cnode < numionodes; cnode++)
                memcpy(nodepdaindr[cnode]->pernode_pdaindr, nodepdaindr,
                       sizeof(nodepdaindr));

        /*
         * Set up IO related platform-dependent nodepda fields.
         * The following routine actually sets up the hubinfo struct
         * in nodepda.
         */
        for_each_online_node(cnode) {
                bte_init_node(nodepdaindr[cnode], cnode);
        }

        /*
         * Initialize the per node hubdev.  This includes IO Nodes and 
         * headless/memless nodes.
         */
        for (cnode = 0; cnode < numionodes; cnode++) {
                hubdev_init_node(nodepdaindr[cnode], cnode);
        }
}

/**
 * sn_cpu_init - initialize per-cpu data areas
 * @cpuid: cpuid of the caller
 *
 * Called during cpu initialization on each cpu as it starts.
 * Currently, initializes the per-cpu data area for SNIA.
 * Also sets up a few fields in the nodepda.  Also known as
 * platform_cpu_init() by the ia64 machvec code.
 */
void __init sn_cpu_init(void)
{
        int cpuid;
        int cpuphyid;
        int nasid;
        int subnode;
        int slice;
        int cnode;
        int i;
        static int wars_have_been_checked;

        memset(pda, 0, sizeof(pda));
        if (ia64_sn_get_sn_info(0, &sn_hub_info->shub2, &sn_hub_info->nasid_bitmask, &sn_hub_info->nasid_shift,
                                &sn_system_size, &sn_sharing_domain_size, &sn_partition_id,
                                &sn_coherency_id, &sn_region_size))
                BUG();
        sn_hub_info->as_shift = sn_hub_info->nasid_shift - 2;

        /*
         * The boot cpu makes this call again after platform initialization is
         * complete.
         */
        if (nodepdaindr[0] == NULL)
                return;

        cpuid = smp_processor_id();
        cpuphyid = get_sapicid();

        if (ia64_sn_get_sapic_info(cpuphyid, &nasid, &subnode, &slice))
                BUG();

        for (i=0; i < MAX_NUMNODES; i++) {
                if (nodepdaindr[i]) {
                        nodepdaindr[i]->phys_cpuid[cpuid].nasid = nasid;
                        nodepdaindr[i]->phys_cpuid[cpuid].slice = slice;
                        nodepdaindr[i]->phys_cpuid[cpuid].subnode = subnode;
                }
        }

        cnode = nasid_to_cnodeid(nasid);

        sn_nodepda = nodepdaindr[cnode];

        pda->led_address =
            (typeof(pda->led_address)) (LED0 + (slice << LED_CPU_SHIFT));
        pda->led_state = LED_ALWAYS_SET;
        pda->hb_count = HZ / 2;
        pda->hb_state = 0;
        pda->idle_flag = 0;

        if (cpuid != 0) {
                /* copy cpu 0's sn_cnodeid_to_nasid table to this cpu's */
                memcpy(sn_cnodeid_to_nasid,
                       (&per_cpu(__sn_cnodeid_to_nasid, 0)),
                       sizeof(__ia64_per_cpu_var(__sn_cnodeid_to_nasid)));
        }

        /*
         * Check for WARs.
         * Only needs to be done once, on BSP.
         * Has to be done after loop above, because it uses this cpu's
         * sn_cnodeid_to_nasid table which was just initialized if this
         * isn't cpu 0.
         * Has to be done before assignment below.
         */
        if (!wars_have_been_checked) {
                sn_check_for_wars();
                wars_have_been_checked = 1;
        }
        sn_hub_info->shub_1_1_found = shub_1_1_found;

        /*
         * Set up addresses of PIO/MEM write status registers.
         */
        {
                u64 pio1[] = {SH1_PIO_WRITE_STATUS_0, 0, SH1_PIO_WRITE_STATUS_1, 0};
                u64 pio2[] = {SH2_PIO_WRITE_STATUS_0, SH2_PIO_WRITE_STATUS_1, 
                        SH2_PIO_WRITE_STATUS_2, SH2_PIO_WRITE_STATUS_3};
                u64 *pio;
                pio = is_shub1() ? pio1 : pio2;
                pda->pio_write_status_addr = (volatile unsigned long *) LOCAL_MMR_ADDR(pio[slice]);
                pda->pio_write_status_val = is_shub1() ? SH_PIO_WRITE_STATUS_PENDING_WRITE_COUNT_MASK : 0;
        }

        /*
         * WAR addresses for SHUB 1.x.
         */
        if (local_node_data->active_cpu_count++ == 0 && is_shub1()) {
                int buddy_nasid;
                buddy_nasid =
                    cnodeid_to_nasid(numa_node_id() ==
                                     num_online_nodes() - 1 ? 0 : numa_node_id() + 1);
                pda->pio_shub_war_cam_addr =
                    (volatile unsigned long *)GLOBAL_MMR_ADDR(nasid,
                                                              SH1_PI_CAM_CONTROL);
        }
}

/*
 * Scan klconfig for ionodes.  Add the nasids to the
 * physical_node_map and the pda and increment numionodes.
 */

static void __init scan_for_ionodes(void)
{
        int nasid = 0;
        lboard_t *brd;

        /* Setup ionodes with memory */
        for (nasid = 0; nasid < MAX_PHYSNODE_ID; nasid += 2) {
                char *klgraph_header;
                cnodeid_t cnodeid;

                if (physical_node_map[nasid] == -1)
                        continue;

                cnodeid = -1;
                klgraph_header = __va(ia64_sn_get_klconfig_addr(nasid));
                if (!klgraph_header) {
                        if (IS_RUNNING_ON_SIMULATOR())
                                continue;
                        BUG();  /* All nodes must have klconfig tables! */
                }
                cnodeid = nasid_to_cnodeid(nasid);
                root_lboard[cnodeid] = (lboard_t *)
                    NODE_OFFSET_TO_LBOARD((nasid),
                                          ((kl_config_hdr_t
                                            *) (klgraph_header))->
                                          ch_board_info);
        }

        /* Scan headless/memless IO Nodes. */
        for (nasid = 0; nasid < MAX_PHYSNODE_ID; nasid += 2) {
                /* if there's no nasid, don't try to read the klconfig on the node */
                if (physical_node_map[nasid] == -1)
                        continue;
                brd = find_lboard_any((lboard_t *)
                                      root_lboard[nasid_to_cnodeid(nasid)],
                                      KLTYPE_SNIA);
                if (brd) {
                        brd = KLCF_NEXT_ANY(brd);       /* Skip this node's lboard */
                        if (!brd)
                                continue;
                }

                brd = find_lboard_any(brd, KLTYPE_SNIA);

                while (brd) {
                        sn_cnodeid_to_nasid[numionodes] = brd->brd_nasid;
                        physical_node_map[brd->brd_nasid] = numionodes;
                        root_lboard[numionodes] = brd;
                        numionodes++;
                        brd = KLCF_NEXT_ANY(brd);
                        if (!brd)
                                break;

                        brd = find_lboard_any(brd, KLTYPE_SNIA);
                }
        }

        /* Scan for TIO nodes. */
        for (nasid = 0; nasid < MAX_PHYSNODE_ID; nasid += 2) {
                /* if there's no nasid, don't try to read the klconfig on the node */
                if (physical_node_map[nasid] == -1)
                        continue;
                brd = find_lboard_any((lboard_t *)
                                      root_lboard[nasid_to_cnodeid(nasid)],
                                      KLTYPE_TIO);
                while (brd) {
                        sn_cnodeid_to_nasid[numionodes] = brd->brd_nasid;
                        physical_node_map[brd->brd_nasid] = numionodes;
                        root_lboard[numionodes] = brd;
                        numionodes++;
                        brd = KLCF_NEXT_ANY(brd);
                        if (!brd)
                                break;

                        brd = find_lboard_any(brd, KLTYPE_TIO);
                }
        }
}

int
nasid_slice_to_cpuid(int nasid, int slice)
{
        long cpu;
        
        for (cpu=0; cpu < NR_CPUS; cpu++) 
                if (cpuid_to_nasid(cpu) == nasid &&
                                        cpuid_to_slice(cpu) == slice)
                        return cpu;

        return -1;
}