kernel/arch/arm/kernel/setup.c

   1 /*
   2  *  linux/arch/arm/kernel/setup.c
   3  *
   4  *  Copyright (C) 1995-2001 Russell King
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License version 2 as
   8  * published by the Free Software Foundation.
   9  */
  10 #include <linux/export.h>
  11 #include <linux/kernel.h>
  12 #include <linux/stddef.h>
  13 #include <linux/ioport.h>
  14 #include <linux/delay.h>
  15 #include <linux/utsname.h>
  16 #include <linux/initrd.h>
  17 #include <linux/console.h>
  18 #include <linux/bootmem.h>
  19 #include <linux/seq_file.h>
  20 #include <linux/screen_info.h>
  21 #include <linux/of_iommu.h>
  22 #include <linux/of_platform.h>
  23 #include <linux/init.h>
  24 #include <linux/kexec.h>
  25 #include <linux/of_fdt.h>
  26 #include <linux/cpu.h>
  27 #include <linux/interrupt.h>
  28 #include <linux/smp.h>
  29 #include <linux/proc_fs.h>
  30 #include <linux/memblock.h>
  31 #include <linux/bug.h>
  32 #include <linux/compiler.h>
  33 #include <linux/sort.h>
  34
  35 #include <asm/unified.h>
  36 #include <asm/cp15.h>
  37 #include <asm/cpu.h>
  38 #include <asm/cputype.h>
  39 #include <asm/elf.h>
  40 #include <asm/procinfo.h>
  41 #include <asm/psci.h>
  42 #include <asm/sections.h>
  43 #include <asm/setup.h>
  44 #include <asm/smp_plat.h>
  45 #include <asm/mach-types.h>
  46 #include <asm/cacheflush.h>
  47 #include <asm/cachetype.h>
  48 #include <asm/tlbflush.h>
  49
  50 #include <asm/prom.h>
  51 #include <asm/mach/arch.h>
  52 #include <asm/mach/irq.h>
  53 #include <asm/mach/time.h>
  54 #include <asm/system_info.h>
  55 #include <asm/system_misc.h>
  56 #include <asm/traps.h>
  57 #include <asm/unwind.h>
  58 #include <asm/memblock.h>
  59 #include <asm/virt.h>
  60
  61 #include "atags.h"
  62
  63
  64 #if defined(CONFIG_FPE_NWFPE) || defined(CONFIG_FPE_FASTFPE)
  65 char fpe_type[8];
  66
  67 static int __init fpe_setup(char *line)
  68 {
  69         memcpy(fpe_type, line, 8);
  70         return 1;
  71 }
  72
  73 __setup("fpe=", fpe_setup);
  74 #endif
  75
  76 extern void init_default_cache_policy(unsigned long);
  77 extern void paging_init(const struct machine_desc *desc);
  78 extern void early_paging_init(const struct machine_desc *,
  79                               struct proc_info_list *);
  80 extern void sanity_check_meminfo(void);
  81 extern enum reboot_mode reboot_mode;
  82 extern void setup_dma_zone(const struct machine_desc *desc);
  83
  84 unsigned int processor_id;
  85 EXPORT_SYMBOL(processor_id);
  86 unsigned int __machine_arch_type __read_mostly;
  87 EXPORT_SYMBOL(__machine_arch_type);
  88 unsigned int cacheid __read_mostly;
  89 EXPORT_SYMBOL(cacheid);
  90
  91 unsigned int __atags_pointer __initdata;
  92
  93 unsigned int system_rev;
  94 EXPORT_SYMBOL(system_rev);
  95
  96 unsigned int system_serial_low;
  97 EXPORT_SYMBOL(system_serial_low);
  98
  99 unsigned int system_serial_high;
 100 EXPORT_SYMBOL(system_serial_high);
 101
 102 unsigned int elf_hwcap __read_mostly;
 103 EXPORT_SYMBOL(elf_hwcap);
 104
 105 unsigned int elf_hwcap2 __read_mostly;
 106 EXPORT_SYMBOL(elf_hwcap2);
 107
 108
 109 #ifdef MULTI_CPU
 110 struct processor processor __read_mostly;
 111 #endif
 112 #ifdef MULTI_TLB
 113 struct cpu_tlb_fns cpu_tlb __read_mostly;
 114 #endif
 115 #ifdef MULTI_USER
 116 struct cpu_user_fns cpu_user __read_mostly;
 117 #endif
 118 #ifdef MULTI_CACHE
 119 struct cpu_cache_fns cpu_cache __read_mostly;
 120 #endif
 121 #ifdef CONFIG_OUTER_CACHE
 122 struct outer_cache_fns outer_cache __read_mostly;
 123 EXPORT_SYMBOL(outer_cache);
 124 #endif
 125
 126 /*
 127  * Cached cpu_architecture() result for use by assembler code.
 128  * C code should use the cpu_architecture() function instead of accessing this
 129  * variable directly.
 130  */
 131 int __cpu_architecture __read_mostly = CPU_ARCH_UNKNOWN;
 132
 133 struct stack {
 134         u32 irq[3];
 135         u32 abt[3];
 136         u32 und[3];
 137         u32 fiq[3];
 138 } ____cacheline_aligned;
 139
 140 #ifndef CONFIG_CPU_V7M
 141 static struct stack stacks[NR_CPUS];
 142 #endif
 143
 144 char elf_platform[ELF_PLATFORM_SIZE];
 145 EXPORT_SYMBOL(elf_platform);
 146
 147 static const char *cpu_name;
 148 static const char *machine_name;
 149 static char __initdata cmd_line[COMMAND_LINE_SIZE];
 150 const struct machine_desc *machine_desc __initdata;
 151
 152 static union { char c[4]; unsigned long l; } endian_test __initdata = { { 'l', '?', '?', 'b' } };
 153 #define ENDIANNESS ((char)endian_test.l)
 154
 155 DEFINE_PER_CPU(struct cpuinfo_arm, cpu_data);
 156
 157 /*
 158  * Standard memory resources
 159  */
 160 static struct resource mem_res[] = {
 161         {
 162                 .name = "Video RAM",
 163                 .start = 0,
 164                 .end = 0,
 165                 .flags = IORESOURCE_MEM
 166         },
 167         {
 168                 .name = "Kernel code",
 169                 .start = 0,
 170                 .end = 0,
 171                 .flags = IORESOURCE_MEM
 172         },
 173         {
 174                 .name = "Kernel data",
 175                 .start = 0,
 176                 .end = 0,
 177                 .flags = IORESOURCE_MEM
 178         }
 179 };
 180
 181 #define video_ram   mem_res[0]
 182 #define kernel_code mem_res[1]
 183 #define kernel_data mem_res[2]
 184
 185 static struct resource io_res[] = {
 186         {
 187                 .name = "reserved",
 188                 .start = 0x3bc,
 189                 .end = 0x3be,
 190                 .flags = IORESOURCE_IO | IORESOURCE_BUSY
 191         },
 192         {
 193                 .name = "reserved",
 194                 .start = 0x378,
 195                 .end = 0x37f,
 196                 .flags = IORESOURCE_IO | IORESOURCE_BUSY
 197         },
 198         {
 199                 .name = "reserved",
 200                 .start = 0x278,
 201                 .end = 0x27f,
 202                 .flags = IORESOURCE_IO | IORESOURCE_BUSY
 203         }
 204 };
 205
 206 #define lp0 io_res[0]
 207 #define lp1 io_res[1]
 208 #define lp2 io_res[2]
 209
 210 static const char *proc_arch[] = {
 211         "undefined/unknown",
 212         "3",
 213         "4",
 214         "4T",
 215         "5",
 216         "5T",
 217         "5TE",
 218         "5TEJ",
 219         "6TEJ",
 220         "7",
 221         "7M",
 222         "?(12)",
 223         "?(13)",
 224         "?(14)",
 225         "?(15)",
 226         "?(16)",
 227         "?(17)",
 228 };
 229
 230 #ifdef CONFIG_CPU_V7M
 231 static int __get_cpu_architecture(void)
 232 {
 233         return CPU_ARCH_ARMv7M;
 234 }
 235 #else
 236 static int __get_cpu_architecture(void)
 237 {
 238         int cpu_arch;
 239
 240         if ((read_cpuid_id() & 0x0008f000) == 0) {
 241                 cpu_arch = CPU_ARCH_UNKNOWN;
 242         } else if ((read_cpuid_id() & 0x0008f000) == 0x00007000) {
 243                 cpu_arch = (read_cpuid_id() & (1 << 23)) ? CPU_ARCH_ARMv4T : CPU_ARCH_ARMv3;
 244         } else if ((read_cpuid_id() & 0x00080000) == 0x00000000) {
 245                 cpu_arch = (read_cpuid_id() >> 16) & 7;
 246                 if (cpu_arch)
 247                         cpu_arch += CPU_ARCH_ARMv3;
 248         } else if ((read_cpuid_id() & 0x000f0000) == 0x000f0000) {
 249                 /* Revised CPUID format. Read the Memory Model Feature
 250                  * Register 0 and check for VMSAv7 or PMSAv7 */
 251                 unsigned int mmfr0 = read_cpuid_ext(CPUID_EXT_MMFR0);
 252                 if ((mmfr0 & 0x0000000f) >= 0x00000003 ||
 253                     (mmfr0 & 0x000000f0) >= 0x00000030)
 254                         cpu_arch = CPU_ARCH_ARMv7;
 255                 else if ((mmfr0 & 0x0000000f) == 0x00000002 ||
 256                          (mmfr0 & 0x000000f0) == 0x00000020)
 257                         cpu_arch = CPU_ARCH_ARMv6;
 258                 else
 259                         cpu_arch = CPU_ARCH_UNKNOWN;
 260         } else
 261                 cpu_arch = CPU_ARCH_UNKNOWN;
 262
 263         return cpu_arch;
 264 }
 265 #endif
 266
 267 int __pure cpu_architecture(void)
 268 {
 269         BUG_ON(__cpu_architecture == CPU_ARCH_UNKNOWN);
 270
 271         return __cpu_architecture;
 272 }
 273
 274 static int cpu_has_aliasing_icache(unsigned int arch)
 275 {
 276         int aliasing_icache;
 277         unsigned int id_reg, num_sets, line_size;
 278
 279         /* PIPT caches never alias. */
 280         if (icache_is_pipt())
 281                 return 0;
 282
 283         /* arch specifies the register format */
 284         switch (arch) {
 285         case CPU_ARCH_ARMv7:
 286                 asm("mcr        p15, 2, %0, c0, c0, 0 @ set CSSELR"
 287                     : /* No output operands */
 288                     : "r" (1));
 289                 isb();
 290                 asm("mrc        p15, 1, %0, c0, c0, 0 @ read CCSIDR"
 291                     : "=r" (id_reg));
 292                 line_size = 4 << ((id_reg & 0x7) + 2);
 293                 num_sets = ((id_reg >> 13) & 0x7fff) + 1;
 294                 aliasing_icache = (line_size * num_sets) > PAGE_SIZE;
 295                 break;
 296         case CPU_ARCH_ARMv6:
 297                 aliasing_icache = read_cpuid_cachetype() & (1 << 11);
 298                 break;
 299         default:
 300                 /* I-cache aliases will be handled by D-cache aliasing code */
 301                 aliasing_icache = 0;
 302         }
 303
 304         return aliasing_icache;
 305 }
 306
 307 static void __init cacheid_init(void)
 308 {
 309         unsigned int arch = cpu_architecture();
 310
 311         if (arch == CPU_ARCH_ARMv7M) {
 312                 cacheid = 0;
 313         } else if (arch >= CPU_ARCH_ARMv6) {
 314                 unsigned int cachetype = read_cpuid_cachetype();
 315                 if ((cachetype & (7 << 29)) == 4 << 29) {
 316                         /* ARMv7 register format */
 317                         arch = CPU_ARCH_ARMv7;
 318                         cacheid = CACHEID_VIPT_NONALIASING;
 319                         switch (cachetype & (3 << 14)) {
 320                         case (1 << 14):
 321                                 cacheid |= CACHEID_ASID_TAGGED;
 322                                 break;
 323                         case (3 << 14):
 324                                 cacheid |= CACHEID_PIPT;
 325                                 break;
 326                         }
 327                 } else {
 328                         arch = CPU_ARCH_ARMv6;
 329                         if (cachetype & (1 << 23))
 330                                 cacheid = CACHEID_VIPT_ALIASING;
 331                         else
 332                                 cacheid = CACHEID_VIPT_NONALIASING;
 333                 }
 334                 if (cpu_has_aliasing_icache(arch))
 335                         cacheid |= CACHEID_VIPT_I_ALIASING;
 336         } else {
 337                 cacheid = CACHEID_VIVT;
 338         }
 339
 340         pr_info("CPU: %s data cache, %s instruction cache\n",
 341                 cache_is_vivt() ? "VIVT" :
 342                 cache_is_vipt_aliasing() ? "VIPT aliasing" :
 343                 cache_is_vipt_nonaliasing() ? "PIPT / VIPT nonaliasing" : "unknown",
 344                 cache_is_vivt() ? "VIVT" :
 345                 icache_is_vivt_asid_tagged() ? "VIVT ASID tagged" :
 346                 icache_is_vipt_aliasing() ? "VIPT aliasing" :
 347                 icache_is_pipt() ? "PIPT" :
 348                 cache_is_vipt_nonaliasing() ? "VIPT nonaliasing" : "unknown");
 349 }
 350
 351 /*
 352  * These functions re-use the assembly code in head.S, which
 353  * already provide the required functionality.
 354  */
 355 extern struct proc_info_list *lookup_processor_type(unsigned int);
 356
 357 void __init early_print(const char *str, ...)
 358 {
 359         extern void printascii(const char *);
 360         char buf[256];
 361         va_list ap;
 362
 363         va_start(ap, str);
 364         vsnprintf(buf, sizeof(buf), str, ap);
 365         va_end(ap);
 366
 367 #ifdef CONFIG_DEBUG_LL
 368         printascii(buf);
 369 #endif
 370         printk("%s", buf);
 371 }
 372
 373 static void __init cpuid_init_hwcaps(void)
 374 {
 375         int block;
 376         u32 isar5;
 377
 378         if (cpu_architecture() < CPU_ARCH_ARMv7)
 379                 return;
 380
 381         block = cpuid_feature_extract(CPUID_EXT_ISAR0, 24);
 382         if (block >= 2)
 383                 elf_hwcap |= HWCAP_IDIVA;
 384         if (block >= 1)
 385                 elf_hwcap |= HWCAP_IDIVT;
 386
 387         /* LPAE implies atomic ldrd/strd instructions */
 388         block = cpuid_feature_extract(CPUID_EXT_MMFR0, 0);
 389         if (block >= 5)
 390                 elf_hwcap |= HWCAP_LPAE;
 391
 392         /* check for supported v8 Crypto instructions */
 393         isar5 = read_cpuid_ext(CPUID_EXT_ISAR5);
 394
 395         block = cpuid_feature_extract_field(isar5, 4);
 396         if (block >= 2)
 397                 elf_hwcap2 |= HWCAP2_PMULL;
 398         if (block >= 1)
 399                 elf_hwcap2 |= HWCAP2_AES;
 400
 401         block = cpuid_feature_extract_field(isar5, 8);
 402         if (block >= 1)
 403                 elf_hwcap2 |= HWCAP2_SHA1;
 404
 405         block = cpuid_feature_extract_field(isar5, 12);
 406         if (block >= 1)
 407                 elf_hwcap2 |= HWCAP2_SHA2;
 408
 409         block = cpuid_feature_extract_field(isar5, 16);
 410         if (block >= 1)
 411                 elf_hwcap2 |= HWCAP2_CRC32;
 412 }
 413
 414 static void __init elf_hwcap_fixup(void)
 415 {
 416         unsigned id = read_cpuid_id();
 417
 418         /*
 419          * HWCAP_TLS is available only on 1136 r1p0 and later,
 420          * see also kuser_get_tls_init.
 421          */
 422         if (read_cpuid_part() == ARM_CPU_PART_ARM1136 &&
 423             ((id >> 20) & 3) == 0) {
 424                 elf_hwcap &= ~HWCAP_TLS;
 425                 return;
 426         }
 427
 428         /* Verify if CPUID scheme is implemented */
 429         if ((id & 0x000f0000) != 0x000f0000)
 430                 return;
 431
 432         /*
 433          * If the CPU supports LDREX/STREX and LDREXB/STREXB,
 434          * avoid advertising SWP; it may not be atomic with
 435          * multiprocessing cores.
 436          */
 437         if (cpuid_feature_extract(CPUID_EXT_ISAR3, 12) > 1 ||
 438             (cpuid_feature_extract(CPUID_EXT_ISAR3, 12) == 1 &&
 439              cpuid_feature_extract(CPUID_EXT_ISAR3, 20) >= 3))
 440                 elf_hwcap &= ~HWCAP_SWP;
 441 }
 442
 443 /*
 444  * cpu_init - initialise one CPU.
 445  *
 446  * cpu_init sets up the per-CPU stacks.
 447  */
 448 void notrace cpu_init(void)
 449 {
 450 #ifndef CONFIG_CPU_V7M
 451         unsigned int cpu = smp_processor_id();
 452         struct stack *stk = &stacks[cpu];
 453
 454         if (cpu >= NR_CPUS) {
 455                 pr_crit("CPU%u: bad primary CPU number\n", cpu);
 456                 BUG();
 457         }
 458
 459         /*
 460          * This only works on resume and secondary cores. For booting on the
 461          * boot cpu, smp_prepare_boot_cpu is called after percpu area setup.
 462          */
 463         set_my_cpu_offset(per_cpu_offset(cpu));
 464
 465         cpu_proc_init();
 466
 467         /*
 468          * Define the placement constraint for the inline asm directive below.
 469          * In Thumb-2, msr with an immediate value is not allowed.
 470          */
 471 #ifdef CONFIG_THUMB2_KERNEL
 472 #define PLC     "r"
 473 #else
 474 #define PLC     "I"
 475 #endif
 476
 477         /*
 478          * setup stacks for re-entrant exception handlers
 479          */
 480         __asm__ (
 481         "msr    cpsr_c, %1\n\t"
 482         "add    r14, %0, %2\n\t"
 483         "mov    sp, r14\n\t"
 484         "msr    cpsr_c, %3\n\t"
 485         "add    r14, %0, %4\n\t"
 486         "mov    sp, r14\n\t"
 487         "msr    cpsr_c, %5\n\t"
 488         "add    r14, %0, %6\n\t"
 489         "mov    sp, r14\n\t"
 490         "msr    cpsr_c, %7\n\t"
 491         "add    r14, %0, %8\n\t"
 492         "mov    sp, r14\n\t"
 493         "msr    cpsr_c, %9"
 494             :
 495             : "r" (stk),
 496               PLC (PSR_F_BIT | PSR_I_BIT | IRQ_MODE),
 497               "I" (offsetof(struct stack, irq[0])),
 498               PLC (PSR_F_BIT | PSR_I_BIT | ABT_MODE),
 499               "I" (offsetof(struct stack, abt[0])),
 500               PLC (PSR_F_BIT | PSR_I_BIT | UND_MODE),
 501               "I" (offsetof(struct stack, und[0])),
 502               PLC (PSR_F_BIT | PSR_I_BIT | FIQ_MODE),
 503               "I" (offsetof(struct stack, fiq[0])),
 504               PLC (PSR_F_BIT | PSR_I_BIT | SVC_MODE)
 505             : "r14");
 506 #endif
 507 }
 508
 509 u32 __cpu_logical_map[NR_CPUS] = { [0 ... NR_CPUS-1] = MPIDR_INVALID };
 510
 511 void __init smp_setup_processor_id(void)
 512 {
 513         int i;
 514         u32 mpidr = is_smp() ? read_cpuid_mpidr() & MPIDR_HWID_BITMASK : 0;
 515         u32 cpu = MPIDR_AFFINITY_LEVEL(mpidr, 0);
 516
 517         cpu_logical_map(0) = cpu;
 518         for (i = 1; i < nr_cpu_ids; ++i)
 519                 cpu_logical_map(i) = i == cpu ? 0 : i;
 520
 521         /*
 522          * clear __my_cpu_offset on boot CPU to avoid hang caused by
 523          * using percpu variable early, for example, lockdep will
 524          * access percpu variable inside lock_release
 525          */
 526         set_my_cpu_offset(0);
 527
 528         pr_info("Booting Linux on physical CPU 0x%x\n", mpidr);
 529 }
 530
 531 struct mpidr_hash mpidr_hash;
 532 #ifdef CONFIG_SMP
 533 /**
 534  * smp_build_mpidr_hash - Pre-compute shifts required at each affinity
 535  *                        level in order to build a linear index from an
 536  *                        MPIDR value. Resulting algorithm is a collision
 537  *                        free hash carried out through shifting and ORing
 538  */
 539 static void __init smp_build_mpidr_hash(void)
 540 {
 541         u32 i, affinity;
 542         u32 fs[3], bits[3], ls, mask = 0;
 543         /*
 544          * Pre-scan the list of MPIDRS and filter out bits that do
 545          * not contribute to affinity levels, ie they never toggle.
 546          */
 547         for_each_possible_cpu(i)
 548                 mask |= (cpu_logical_map(i) ^ cpu_logical_map(0));
 549         pr_debug("mask of set bits 0x%x\n", mask);
 550         /*
 551          * Find and stash the last and first bit set at all affinity levels to
 552          * check how many bits are required to represent them.
 553          */
 554         for (i = 0; i < 3; i++) {
 555                 affinity = MPIDR_AFFINITY_LEVEL(mask, i);
 556                 /*
 557                  * Find the MSB bit and LSB bits position
 558                  * to determine how many bits are required
 559                  * to express the affinity level.
 560                  */
 561                 ls = fls(affinity);
 562                 fs[i] = affinity ? ffs(affinity) - 1 : 0;
 563                 bits[i] = ls - fs[i];
 564         }
 565         /*
 566          * An index can be created from the MPIDR by isolating the
 567          * significant bits at each affinity level and by shifting
 568          * them in order to compress the 24 bits values space to a
 569          * compressed set of values. This is equivalent to hashing
 570          * the MPIDR through shifting and ORing. It is a collision free
 571          * hash though not minimal since some levels might contain a number
 572          * of CPUs that is not an exact power of 2 and their bit
 573          * representation might contain holes, eg MPIDR[7:0] = {0x2, 0x80}.
 574          */
 575         mpidr_hash.shift_aff[0] = fs[0];
 576         mpidr_hash.shift_aff[1] = MPIDR_LEVEL_BITS + fs[1] - bits[0];
 577         mpidr_hash.shift_aff[2] = 2*MPIDR_LEVEL_BITS + fs[2] -
 578                                                 (bits[1] + bits[0]);
 579         mpidr_hash.mask = mask;
 580         mpidr_hash.bits = bits[2] + bits[1] + bits[0];
 581         pr_debug("MPIDR hash: aff0[%u] aff1[%u] aff2[%u] mask[0x%x] bits[%u]\n",
 582                                 mpidr_hash.shift_aff[0],
 583                                 mpidr_hash.shift_aff[1],
 584                                 mpidr_hash.shift_aff[2],
 585                                 mpidr_hash.mask,
 586                                 mpidr_hash.bits);
 587         /*
 588          * 4x is an arbitrary value used to warn on a hash table much bigger
 589          * than expected on most systems.
 590          */
 591         if (mpidr_hash_size() > 4 * num_possible_cpus())
 592                 pr_warn("Large number of MPIDR hash buckets detected\n");
 593         sync_cache_w(&mpidr_hash);
 594 }
 595 #endif
 596
 597 static void __init setup_processor(void)
 598 {
 599         struct proc_info_list *list;
 600
 601         /*
 602          * locate processor in the list of supported processor
 603          * types.  The linker builds this table for us from the
 604          * entries in arch/arm/mm/proc-*.S
 605          */
 606         list = lookup_processor_type(read_cpuid_id());
 607         if (!list) {
 608                 pr_err("CPU configuration botched (ID %08x), unable to continue.\n",
 609                        read_cpuid_id());
 610                 while (1);
 611         }
 612
 613         cpu_name = list->cpu_name;
 614         __cpu_architecture = __get_cpu_architecture();
 615
 616 #ifdef MULTI_CPU
 617         processor = *list->proc;
 618 #endif
 619 #ifdef MULTI_TLB
 620         cpu_tlb = *list->tlb;
 621 #endif
 622 #ifdef MULTI_USER
 623         cpu_user = *list->user;
 624 #endif
 625 #ifdef MULTI_CACHE
 626         cpu_cache = *list->cache;
 627 #endif
 628
 629         pr_info("CPU: %s [%08x] revision %d (ARMv%s), cr=%08lx\n",
 630                 cpu_name, read_cpuid_id(), read_cpuid_id() & 15,
 631                 proc_arch[cpu_architecture()], get_cr());
 632
 633         snprintf(init_utsname()->machine, __NEW_UTS_LEN + 1, "%s%c",
 634                  list->arch_name, ENDIANNESS);
 635         snprintf(elf_platform, ELF_PLATFORM_SIZE, "%s%c",
 636                  list->elf_name, ENDIANNESS);
 637         elf_hwcap = list->elf_hwcap;
 638
 639         cpuid_init_hwcaps();
 640
 641 #ifndef CONFIG_ARM_THUMB
 642         elf_hwcap &= ~(HWCAP_THUMB | HWCAP_IDIVT);
 643 #endif
 644 #ifdef CONFIG_MMU
 645         init_default_cache_policy(list->__cpu_mm_mmu_flags);
 646 #endif
 647         erratum_a15_798181_init();
 648
 649         elf_hwcap_fixup();
 650
 651         cacheid_init();
 652         cpu_init();
 653 }
 654
 655 void __init dump_machine_table(void)
 656 {
 657         const struct machine_desc *p;
 658
 659         early_print("Available machine support:\n\nID (hex)\tNAME\n");
 660         for_each_machine_desc(p)
 661                 early_print("%08x\t%s\n", p->nr, p->name);
 662
 663         early_print("\nPlease check your kernel config and/or bootloader.\n");
 664
 665         while (true)
 666                 /* can't use cpu_relax() here as it may require MMU setup */;
 667 }
 668
 669 int __init arm_add_memory(u64 start, u64 size)
 670 {
 671         u64 aligned_start;
 672
 673         /*
 674          * Ensure that start/size are aligned to a page boundary.
 675          * Size is rounded down, start is rounded up.
 676          */
 677         aligned_start = PAGE_ALIGN(start);
 678         if (aligned_start > start + size)
 679                 size = 0;
 680         else
 681                 size -= aligned_start - start;
 682
 683 #ifndef CONFIG_ARCH_PHYS_ADDR_T_64BIT
 684         if (aligned_start > ULONG_MAX) {
 685                 pr_crit("Ignoring memory at 0x%08llx outside 32-bit physical address space\n",
 686                         (long long)start);
 687                 return -EINVAL;
 688         }
 689
 690         if (aligned_start + size > ULONG_MAX) {
 691                 pr_crit("Truncating memory at 0x%08llx to fit in 32-bit physical address space\n",
 692                         (long long)start);
 693                 /*
 694                  * To ensure bank->start + bank->size is representable in
 695                  * 32 bits, we use ULONG_MAX as the upper limit rather than 4GB.
 696                  * This means we lose a page after masking.
 697                  */
 698                 size = ULONG_MAX - aligned_start;
 699         }
 700 #endif
 701
 702         if (aligned_start < PHYS_OFFSET) {
 703                 if (aligned_start + size <= PHYS_OFFSET) {
 704                         pr_info("Ignoring memory below PHYS_OFFSET: 0x%08llx-0x%08llx\n",
 705                                 aligned_start, aligned_start + size);
 706                         return -EINVAL;
 707                 }
 708
 709                 pr_info("Ignoring memory below PHYS_OFFSET: 0x%08llx-0x%08llx\n",
 710                         aligned_start, (u64)PHYS_OFFSET);
 711
 712                 size -= PHYS_OFFSET - aligned_start;
 713                 aligned_start = PHYS_OFFSET;
 714         }
 715
 716         start = aligned_start;
 717         size = size & ~(phys_addr_t)(PAGE_SIZE - 1);
 718
 719         /*
 720          * Check whether this memory region has non-zero size or
 721          * invalid node number.
 722          */
 723         if (size == 0)
 724                 return -EINVAL;
 725
 726         memblock_add(start, size);
 727         return 0;
 728 }
 729
 730 /*
 731  * Pick out the memory size.  We look for mem=size@start,
 732  * where start and size are "size[KkMm]"
 733  */
 734
 735 static int __init early_mem(char *p)
 736 {
 737         static int usermem __initdata = 0;
 738         u64 size;
 739         u64 start;
 740         char *endp;
 741
 742         /*
 743          * If the user specifies memory size, we
 744          * blow away any automatically generated
 745          * size.
 746          */
 747         if (usermem == 0) {
 748                 usermem = 1;
 749                 memblock_remove(memblock_start_of_DRAM(),
 750                         memblock_end_of_DRAM() - memblock_start_of_DRAM());
 751         }
 752
 753         start = PHYS_OFFSET;
 754         size  = memparse(p, &endp);
 755         if (*endp == '@')
 756                 start = memparse(endp + 1, NULL);
 757
 758         arm_add_memory(start, size);
 759
 760         return 0;
 761 }
 762 early_param("mem", early_mem);
 763
 764 static void __init request_standard_resources(const struct machine_desc *mdesc)
 765 {
 766         struct memblock_region *region;
 767         struct resource *res;
 768
 769         kernel_code.start   = virt_to_phys(_text);
 770         kernel_code.end     = virt_to_phys(_etext - 1);
 771         kernel_data.start   = virt_to_phys(_sdata);
 772         kernel_data.end     = virt_to_phys(_end - 1);
 773
 774         for_each_memblock(memory, region) {
 775                 res = memblock_virt_alloc(sizeof(*res), 0);
 776                 res->name  = "System RAM";
 777                 res->start = __pfn_to_phys(memblock_region_memory_base_pfn(region));
 778                 res->end = __pfn_to_phys(memblock_region_memory_end_pfn(region)) - 1;
 779                 res->flags = IORESOURCE_MEM | IORESOURCE_BUSY;
 780
 781                 request_resource(&iomem_resource, res);
 782
 783                 if (kernel_code.start >= res->start &&
 784                     kernel_code.end <= res->end)
 785                         request_resource(res, &kernel_code);
 786                 if (kernel_data.start >= res->start &&
 787                     kernel_data.end <= res->end)
 788                         request_resource(res, &kernel_data);
 789         }
 790
 791         if (mdesc->video_start) {
 792                 video_ram.start = mdesc->video_start;
 793                 video_ram.end   = mdesc->video_end;
 794                 request_resource(&iomem_resource, &video_ram);
 795         }
 796
 797         /*
 798          * Some machines don't have the possibility of ever
 799          * possessing lp0, lp1 or lp2
 800          */
 801         if (mdesc->reserve_lp0)
 802                 request_resource(&ioport_resource, &lp0);
 803         if (mdesc->reserve_lp1)
 804                 request_resource(&ioport_resource, &lp1);
 805         if (mdesc->reserve_lp2)
 806                 request_resource(&ioport_resource, &lp2);
 807 }
 808
 809 #if defined(CONFIG_VGA_CONSOLE) || defined(CONFIG_DUMMY_CONSOLE)
 810 struct screen_info screen_info = {
 811  .orig_video_lines      = 30,
 812  .orig_video_cols       = 80,
 813  .orig_video_mode       = 0,
 814  .orig_video_ega_bx     = 0,
 815  .orig_video_isVGA      = 1,
 816  .orig_video_points     = 8
 817 };
 818 #endif
 819
 820 static int __init customize_machine(void)
 821 {
 822         /*
 823          * customizes platform devices, or adds new ones
 824          * On DT based machines, we fall back to populating the
 825          * machine from the device tree, if no callback is provided,
 826          * otherwise we would always need an init_machine callback.
 827          */
 828         of_iommu_init();
 829         if (machine_desc->init_machine)
 830                 machine_desc->init_machine();
 831 #ifdef CONFIG_OF
 832         else
 833                 of_platform_populate(NULL, of_default_bus_match_table,
 834                                         NULL, NULL);
 835 #endif
 836         return 0;
 837 }
 838 arch_initcall(customize_machine);
 839
 840 static int __init init_machine_late(void)
 841 {
 842         if (machine_desc->init_late)
 843                 machine_desc->init_late();
 844         return 0;
 845 }
 846 late_initcall(init_machine_late);
 847
 848 #ifdef CONFIG_KEXEC
 849 static inline unsigned long long get_total_mem(void)
 850 {
 851         unsigned long total;
 852
 853         total = max_low_pfn - min_low_pfn;
 854         return total << PAGE_SHIFT;
 855 }
 856
 857 /**
 858  * reserve_crashkernel() - reserves memory are for crash kernel
 859  *
 860  * This function reserves memory area given in "crashkernel=" kernel command
 861  * line parameter. The memory reserved is used by a dump capture kernel when
 862  * primary kernel is crashing.
 863  */
 864 static void __init reserve_crashkernel(void)
 865 {
 866         unsigned long long crash_size, crash_base;
 867         unsigned long long total_mem;
 868         int ret;
 869
 870         total_mem = get_total_mem();
 871         ret = parse_crashkernel(boot_command_line, total_mem,
 872                                 &crash_size, &crash_base);
 873         if (ret)
 874                 return;
 875
 876         ret = memblock_reserve(crash_base, crash_size);
 877         if (ret < 0) {
 878                 pr_warn("crashkernel reservation failed - memory is in use (0x%lx)\n",
 879                         (unsigned long)crash_base);
 880                 return;
 881         }
 882
 883         pr_info("Reserving %ldMB of memory at %ldMB for crashkernel (System RAM: %ldMB)\n",
 884                 (unsigned long)(crash_size >> 20),
 885                 (unsigned long)(crash_base >> 20),
 886                 (unsigned long)(total_mem >> 20));
 887
 888         crashk_res.start = crash_base;
 889         crashk_res.end = crash_base + crash_size - 1;
 890         insert_resource(&iomem_resource, &crashk_res);
 891 }
 892 #else
 893 static inline void reserve_crashkernel(void) {}
 894 #endif /* CONFIG_KEXEC */
 895
 896 void __init hyp_mode_check(void)
 897 {
 898 #ifdef CONFIG_ARM_VIRT_EXT
 899         sync_boot_mode();
 900
 901         if (is_hyp_mode_available()) {
 902                 pr_info("CPU: All CPU(s) started in HYP mode.\n");
 903                 pr_info("CPU: Virtualization extensions available.\n");
 904         } else if (is_hyp_mode_mismatched()) {
 905                 pr_warn("CPU: WARNING: CPU(s) started in wrong/inconsistent modes (primary CPU mode 0x%x)\n",
 906                         __boot_cpu_mode & MODE_MASK);
 907                 pr_warn("CPU: This may indicate a broken bootloader or firmware.\n");
 908         } else
 909                 pr_info("CPU: All CPU(s) started in SVC mode.\n");
 910 #endif
 911 }
 912
 913 void __init setup_arch(char **cmdline_p)
 914 {
 915         const struct machine_desc *mdesc;
 916
 917         setup_processor();
 918         mdesc = setup_machine_fdt(__atags_pointer);
 919         if (!mdesc)
 920                 mdesc = setup_machine_tags(__atags_pointer, __machine_arch_type);
 921         machine_desc = mdesc;
 922         machine_name = mdesc->name;
 923         dump_stack_set_arch_desc("%s", mdesc->name);
 924
 925         if (mdesc->reboot_mode != REBOOT_HARD)
 926                 reboot_mode = mdesc->reboot_mode;
 927
 928         init_mm.start_code = (unsigned long) _text;
 929         init_mm.end_code   = (unsigned long) _etext;
 930         init_mm.end_data   = (unsigned long) _edata;
 931         init_mm.brk        = (unsigned long) _end;
 932
 933         /* populate cmd_line too for later use, preserving boot_command_line */
 934         strlcpy(cmd_line, boot_command_line, COMMAND_LINE_SIZE);
 935         *cmdline_p = cmd_line;
 936
 937         parse_early_param();
 938
 939         early_paging_init(mdesc, lookup_processor_type(read_cpuid_id()));
 940         setup_dma_zone(mdesc);
 941         sanity_check_meminfo();
 942         arm_memblock_init(mdesc);
 943
 944         paging_init(mdesc);
 945         request_standard_resources(mdesc);
 946
 947         if (mdesc->restart)
 948                 arm_pm_restart = mdesc->restart;
 949
 950         unflatten_device_tree();
 951
 952         arm_dt_init_cpu_maps();
 953         psci_init();
 954 #ifdef CONFIG_SMP
 955         if (is_smp()) {
 956                 if (!mdesc->smp_init || !mdesc->smp_init()) {
 957                         if (psci_smp_available())
 958                                 smp_set_ops(&psci_smp_ops);
 959                         else if (mdesc->smp)
 960                                 smp_set_ops(mdesc->smp);
 961                 }
 962                 smp_init_cpus();
 963                 smp_build_mpidr_hash();
 964         }
 965 #endif
 966
 967         if (!is_smp())
 968                 hyp_mode_check();
 969
 970         reserve_crashkernel();
 971
 972 #ifdef CONFIG_MULTI_IRQ_HANDLER
 973         handle_arch_irq = mdesc->handle_irq;
 974 #endif
 975
 976 #ifdef CONFIG_VT
 977 #if defined(CONFIG_VGA_CONSOLE)
 978         conswitchp = &vga_con;
 979 #elif defined(CONFIG_DUMMY_CONSOLE)
 980         conswitchp = &dummy_con;
 981 #endif
 982 #endif
 983
 984         if (mdesc->init_early)
 985                 mdesc->init_early();
 986 }
 987
 988
 989 static int __init topology_init(void)
 990 {
 991         int cpu;
 992
 993         for_each_possible_cpu(cpu) {
 994                 struct cpuinfo_arm *cpuinfo = &per_cpu(cpu_data, cpu);
 995                 cpuinfo->cpu.hotpluggable = 1;
 996                 register_cpu(&cpuinfo->cpu, cpu);
 997         }
 998
 999         return 0;
1000 }
1001 subsys_initcall(topology_init);
1002
1003 #ifdef CONFIG_HAVE_PROC_CPU
1004 static int __init proc_cpu_init(void)
1005 {
1006         struct proc_dir_entry *res;
1007
1008         res = proc_mkdir("cpu", NULL);
1009         if (!res)
1010                 return -ENOMEM;
1011         return 0;
1012 }
1013 fs_initcall(proc_cpu_init);
1014 #endif
1015
1016 static const char *hwcap_str[] = {
1017         "swp",
1018         "half",
1019         "thumb",
1020         "26bit",
1021         "fastmult",
1022         "fpa",
1023         "vfp",
1024         "edsp",
1025         "java",
1026         "iwmmxt",
1027         "crunch",
1028         "thumbee",
1029         "neon",
1030         "vfpv3",
1031         "vfpv3d16",
1032         "tls",
1033         "vfpv4",
1034         "idiva",
1035         "idivt",
1036         "vfpd32",
1037         "lpae",
1038         "evtstrm",
1039         NULL
1040 };
1041
1042 static const char *hwcap2_str[] = {
1043         "aes",
1044         "pmull",
1045         "sha1",
1046         "sha2",
1047         "crc32",
1048         NULL
1049 };
1050
1051 static int c_show(struct seq_file *m, void *v)
1052 {
1053         int i, j;
1054         u32 cpuid;
1055
1056         for_each_online_cpu(i) {
1057                 /*
1058                  * glibc reads /proc/cpuinfo to determine the number of
1059                  * online processors, looking for lines beginning with
1060                  * "processor".  Give glibc what it expects.
1061                  */
1062                 seq_printf(m, "processor\t: %d\n", i);
1063                 cpuid = is_smp() ? per_cpu(cpu_data, i).cpuid : read_cpuid_id();
1064                 seq_printf(m, "model name\t: %s rev %d (%s)\n",
1065                            cpu_name, cpuid & 15, elf_platform);
1066
1067 #if defined(CONFIG_SMP)
1068                 seq_printf(m, "BogoMIPS\t: %lu.%02lu\n",
1069                            per_cpu(cpu_data, i).loops_per_jiffy / (500000UL/HZ),
1070                            (per_cpu(cpu_data, i).loops_per_jiffy / (5000UL/HZ)) % 100);
1071 #else
1072                 seq_printf(m, "BogoMIPS\t: %lu.%02lu\n",
1073                            loops_per_jiffy / (500000/HZ),
1074                            (loops_per_jiffy / (5000/HZ)) % 100);
1075 #endif
1076                 /* dump out the processor features */
1077                 seq_puts(m, "Features\t: ");
1078
1079                 for (j = 0; hwcap_str[j]; j++)
1080                         if (elf_hwcap & (1 << j))
1081                                 seq_printf(m, "%s ", hwcap_str[j]);
1082
1083                 for (j = 0; hwcap2_str[j]; j++)
1084                         if (elf_hwcap2 & (1 << j))
1085                                 seq_printf(m, "%s ", hwcap2_str[j]);
1086
1087                 seq_printf(m, "\nCPU implementer\t: 0x%02x\n", cpuid >> 24);
1088                 seq_printf(m, "CPU architecture: %s\n",
1089                            proc_arch[cpu_architecture()]);
1090
1091                 if ((cpuid & 0x0008f000) == 0x00000000) {
1092                         /* pre-ARM7 */
1093                         seq_printf(m, "CPU part\t: %07x\n", cpuid >> 4);
1094                 } else {
1095                         if ((cpuid & 0x0008f000) == 0x00007000) {
1096                                 /* ARM7 */
1097                                 seq_printf(m, "CPU variant\t: 0x%02x\n",
1098                                            (cpuid >> 16) & 127);
1099                         } else {
1100                                 /* post-ARM7 */
1101                                 seq_printf(m, "CPU variant\t: 0x%x\n",
1102                                            (cpuid >> 20) & 15);
1103                         }
1104                         seq_printf(m, "CPU part\t: 0x%03x\n",
1105                                    (cpuid >> 4) & 0xfff);
1106                 }
1107                 seq_printf(m, "CPU revision\t: %d\n\n", cpuid & 15);
1108         }
1109
1110         seq_printf(m, "Hardware\t: %s\n", machine_name);
1111         seq_printf(m, "Revision\t: %04x\n", system_rev);
1112         seq_printf(m, "Serial\t\t: %08x%08x\n",
1113                    system_serial_high, system_serial_low);
1114
1115         return 0;
1116 }
1117
1118 static void *c_start(struct seq_file *m, loff_t *pos)
1119 {
1120         return *pos < 1 ? (void *)1 : NULL;
1121 }
1122
1123 static void *c_next(struct seq_file *m, void *v, loff_t *pos)
1124 {
1125         ++*pos;
1126         return NULL;
1127 }
1128
1129 static void c_stop(struct seq_file *m, void *v)
1130 {
1131 }
1132
1133 const struct seq_operations cpuinfo_op = {
1134         .start  = c_start,
1135         .next   = c_next,
1136         .stop   = c_stop,
1137         .show   = c_show
1138 };