Pileus Git - ~andy/linux/blob - arch/mips/netlogic/xlp/setup.c

   1 /*
   2  * Copyright 2003-2011 NetLogic Microsystems, Inc. (NetLogic). All rights
   3  * reserved.
   4  *
   5  * This software is available to you under a choice of one of two
   6  * licenses.  You may choose to be licensed under the terms of the GNU
   7  * General Public License (GPL) Version 2, available from the file
   8  * COPYING in the main directory of this source tree, or the NetLogic
   9  * license below:
  10  *
  11  * Redistribution and use in source and binary forms, with or without
  12  * modification, are permitted provided that the following conditions
  13  * are met:
  14  *
  15  * 1. Redistributions of source code must retain the above copyright
  16  *    notice, this list of conditions and the following disclaimer.
  17  * 2. Redistributions in binary form must reproduce the above copyright
  18  *    notice, this list of conditions and the following disclaimer in
  19  *    the documentation and/or other materials provided with the
  20  *    distribution.
  21  *
  22  * THIS SOFTWARE IS PROVIDED BY NETLOGIC ``AS IS'' AND ANY EXPRESS OR
  23  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
  24  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  25  * ARE DISCLAIMED. IN NO EVENT SHALL NETLOGIC OR CONTRIBUTORS BE LIABLE
  26  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  27  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  28  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
  29  * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
  30  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
  31  * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
  32  * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  33  */
  34
  35 #include <linux/kernel.h>
  36 #include <linux/of_fdt.h>
  37
  38 #include <asm/idle.h>
  39 #include <asm/reboot.h>
  40 #include <asm/time.h>
  41 #include <asm/bootinfo.h>
  42
  43 #include <asm/netlogic/haldefs.h>
  44 #include <asm/netlogic/common.h>
  45
  46 #include <asm/netlogic/xlp-hal/iomap.h>
  47 #include <asm/netlogic/xlp-hal/xlp.h>
  48 #include <asm/netlogic/xlp-hal/sys.h>
  49
  50 uint64_t nlm_io_base;
  51 struct nlm_soc_info nlm_nodes[NLM_NR_NODES];
  52 cpumask_t nlm_cpumask = CPU_MASK_CPU0;
  53 unsigned int nlm_threads_per_core;
  54
  55 static void nlm_linux_exit(void)
  56 {
  57         uint64_t sysbase = nlm_get_node(0)->sysbase;
  58
  59         nlm_write_sys_reg(sysbase, SYS_CHIP_RESET, 1);
  60         for ( ; ; )
  61                 cpu_wait();
  62 }
  63
  64 static void nlm_fixup_mem(void)
  65 {
  66         const int pref_backup = 512;
  67         int i;
  68
  69         for (i = 0; i < boot_mem_map.nr_map; i++) {
  70                 if (boot_mem_map.map[i].type != BOOT_MEM_RAM)
  71                         continue;
  72                 boot_mem_map.map[i].size -= pref_backup;
  73         }
  74 }
  75
  76 void __init plat_mem_setup(void)
  77 {
  78         panic_timeout   = 5;
  79         _machine_restart = (void (*)(char *))nlm_linux_exit;
  80         _machine_halt   = nlm_linux_exit;
  81         pm_power_off    = nlm_linux_exit;
  82
  83         /* memory and bootargs from DT */
  84         early_init_devtree(initial_boot_params);
  85         nlm_fixup_mem();
  86 }
  87
  88 const char *get_system_type(void)
  89 {
  90         return "Netlogic XLP Series";
  91 }
  92
  93 void __init prom_free_prom_memory(void)
  94 {
  95         /* Nothing yet */
  96 }
  97
  98 void xlp_mmu_init(void)
  99 {
 100         /* enable extended TLB and Large Fixed TLB */
 101         write_c0_config6(read_c0_config6() | 0x24);
 102
 103         /* set page mask of Fixed TLB in config7 */
 104         write_c0_config7(PM_DEFAULT_MASK >>
 105                 (13 + (ffz(PM_DEFAULT_MASK >> 13) / 2)));
 106 }
 107
 108 void nlm_percpu_init(int hwcpuid)
 109 {
 110 }
 111
 112 void __init prom_init(void)
 113 {
 114         void *reset_vec;
 115
 116         nlm_io_base = CKSEG1ADDR(XLP_DEFAULT_IO_BASE);
 117         nlm_init_boot_cpu();
 118         xlp_mmu_init();
 119         nlm_node_init(0);
 120         xlp_dt_init((void *)(long)fw_arg0);
 121
 122         /* Update reset entry point with CPU init code */
 123         reset_vec = (void *)CKSEG1ADDR(RESET_VEC_PHYS);
 124         memset(reset_vec, 0, RESET_VEC_SIZE);
 125         memcpy(reset_vec, (void *)nlm_reset_entry,
 126                         (nlm_reset_entry_end - nlm_reset_entry));
 127
 128 #ifdef CONFIG_SMP
 129         cpumask_setall(&nlm_cpumask);
 130         nlm_wakeup_secondary_cpus();
 131
 132         /* update TLB size after waking up threads */
 133         current_cpu_data.tlbsize = ((read_c0_config6() >> 16) & 0xffff) + 1;
 134
 135         register_smp_ops(&nlm_smp_ops);
 136 #endif
 137 }