setup.c 4.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173
  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. #include <linux/kernel.h>
  35. #include <linux/of_fdt.h>
  36. #include <asm/idle.h>
  37. #include <asm/reboot.h>
  38. #include <asm/time.h>
  39. #include <asm/bootinfo.h>
  40. #include <asm/netlogic/haldefs.h>
  41. #include <asm/netlogic/common.h>
  42. #include <asm/netlogic/xlp-hal/iomap.h>
  43. #include <asm/netlogic/xlp-hal/xlp.h>
  44. #include <asm/netlogic/xlp-hal/sys.h>
  45. uint64_t nlm_io_base;
  46. struct nlm_soc_info nlm_nodes[NLM_NR_NODES];
  47. cpumask_t nlm_cpumask = CPU_MASK_CPU0;
  48. unsigned int nlm_threads_per_core;
  49. static void nlm_linux_exit(void)
  50. {
  51. uint64_t sysbase = nlm_get_node(0)->sysbase;
  52. nlm_write_sys_reg(sysbase, SYS_CHIP_RESET, 1);
  53. for ( ; ; )
  54. cpu_wait();
  55. }
  56. static void nlm_fixup_mem(void)
  57. {
  58. const int pref_backup = 512;
  59. int i;
  60. for (i = 0; i < boot_mem_map.nr_map; i++) {
  61. if (boot_mem_map.map[i].type != BOOT_MEM_RAM)
  62. continue;
  63. boot_mem_map.map[i].size -= pref_backup;
  64. }
  65. }
  66. static void __init xlp_init_mem_from_bars(void)
  67. {
  68. uint64_t map[16];
  69. int i, n;
  70. n = xlp_get_dram_map(-1, map); /* -1: info for all nodes */
  71. for (i = 0; i < n; i += 2) {
  72. /* exclude 0x1000_0000-0x2000_0000, u-boot device */
  73. if (map[i] <= 0x10000000 && map[i+1] > 0x10000000)
  74. map[i+1] = 0x10000000;
  75. if (map[i] > 0x10000000 && map[i] < 0x20000000)
  76. map[i] = 0x20000000;
  77. add_memory_region(map[i], map[i+1] - map[i], BOOT_MEM_RAM);
  78. }
  79. }
  80. void __init plat_mem_setup(void)
  81. {
  82. panic_timeout = 5;
  83. _machine_restart = (void (*)(char *))nlm_linux_exit;
  84. _machine_halt = nlm_linux_exit;
  85. pm_power_off = nlm_linux_exit;
  86. /* memory and bootargs from DT */
  87. early_init_devtree(initial_boot_params);
  88. if (boot_mem_map.nr_map == 0) {
  89. pr_info("Using DRAM BARs for memory map.\n");
  90. xlp_init_mem_from_bars();
  91. }
  92. /* Calculate and setup wired entries for mapped kernel */
  93. nlm_fixup_mem();
  94. }
  95. const char *get_system_type(void)
  96. {
  97. switch (read_c0_prid() & 0xff00) {
  98. case PRID_IMP_NETLOGIC_XLP2XX:
  99. return "Broadcom XLPII Series";
  100. default:
  101. return "Netlogic XLP Series";
  102. }
  103. }
  104. void __init prom_free_prom_memory(void)
  105. {
  106. /* Nothing yet */
  107. }
  108. void xlp_mmu_init(void)
  109. {
  110. u32 conf4;
  111. if (cpu_is_xlpii()) {
  112. /* XLPII series has extended pagesize in config 4 */
  113. conf4 = read_c0_config4() & ~0x1f00u;
  114. write_c0_config4(conf4 | ((PAGE_SHIFT - 10) / 2 << 8));
  115. } else {
  116. /* enable extended TLB and Large Fixed TLB */
  117. write_c0_config6(read_c0_config6() | 0x24);
  118. /* set page mask of extended Fixed TLB in config7 */
  119. write_c0_config7(PM_DEFAULT_MASK >>
  120. (13 + (ffz(PM_DEFAULT_MASK >> 13) / 2)));
  121. }
  122. }
  123. void nlm_percpu_init(int hwcpuid)
  124. {
  125. }
  126. void __init prom_init(void)
  127. {
  128. void *reset_vec;
  129. nlm_io_base = CKSEG1ADDR(XLP_DEFAULT_IO_BASE);
  130. nlm_init_boot_cpu();
  131. xlp_mmu_init();
  132. nlm_node_init(0);
  133. xlp_dt_init((void *)(long)fw_arg0);
  134. /* Update reset entry point with CPU init code */
  135. reset_vec = (void *)CKSEG1ADDR(RESET_VEC_PHYS);
  136. memset(reset_vec, 0, RESET_VEC_SIZE);
  137. memcpy(reset_vec, (void *)nlm_reset_entry,
  138. (nlm_reset_entry_end - nlm_reset_entry));
  139. #ifdef CONFIG_SMP
  140. cpumask_setall(&nlm_cpumask);
  141. nlm_wakeup_secondary_cpus();
  142. /* update TLB size after waking up threads */
  143. current_cpu_data.tlbsize = ((read_c0_config6() >> 16) & 0xffff) + 1;
  144. register_smp_ops(&nlm_smp_ops);
  145. #endif
  146. }