linux/arch/unicore32/kernel/setup.c
<<
>>
Prefs
   1// SPDX-License-Identifier: GPL-2.0-only
   2/*
   3 * linux/arch/unicore32/kernel/setup.c
   4 *
   5 * Code specific to PKUnity SoC and UniCore ISA
   6 *
   7 * Copyright (C) 2001-2010 GUAN Xue-tao
   8 */
   9#include <linux/module.h>
  10#include <linux/kernel.h>
  11#include <linux/stddef.h>
  12#include <linux/ioport.h>
  13#include <linux/delay.h>
  14#include <linux/utsname.h>
  15#include <linux/initrd.h>
  16#include <linux/console.h>
  17#include <linux/memblock.h>
  18#include <linux/seq_file.h>
  19#include <linux/screen_info.h>
  20#include <linux/init.h>
  21#include <linux/root_dev.h>
  22#include <linux/cpu.h>
  23#include <linux/interrupt.h>
  24#include <linux/smp.h>
  25#include <linux/fs.h>
  26#include <linux/proc_fs.h>
  27#include <linux/elf.h>
  28#include <linux/io.h>
  29
  30#include <asm/cputype.h>
  31#include <asm/sections.h>
  32#include <asm/setup.h>
  33#include <asm/cacheflush.h>
  34#include <asm/tlbflush.h>
  35#include <asm/traps.h>
  36#include <asm/memblock.h>
  37
  38#include "setup.h"
  39
  40#ifndef MEM_SIZE
  41#define MEM_SIZE        (16*1024*1024)
  42#endif
  43
  44struct stack {
  45        u32 irq[3];
  46        u32 abt[3];
  47        u32 und[3];
  48} ____cacheline_aligned;
  49
  50static struct stack stacks[NR_CPUS];
  51
  52#ifdef CONFIG_VGA_CONSOLE
  53struct screen_info screen_info;
  54#endif
  55
  56char elf_platform[ELF_PLATFORM_SIZE];
  57EXPORT_SYMBOL(elf_platform);
  58
  59static char __initdata cmd_line[COMMAND_LINE_SIZE];
  60
  61static char default_command_line[COMMAND_LINE_SIZE] __initdata = CONFIG_CMDLINE;
  62
  63/*
  64 * Standard memory resources
  65 */
  66static struct resource mem_res[] = {
  67        {
  68                .name = "Kernel code",
  69                .start = 0,
  70                .end = 0,
  71                .flags = IORESOURCE_SYSTEM_RAM
  72        },
  73        {
  74                .name = "Kernel data",
  75                .start = 0,
  76                .end = 0,
  77                .flags = IORESOURCE_SYSTEM_RAM
  78        }
  79};
  80
  81#define kernel_code mem_res[0]
  82#define kernel_data mem_res[1]
  83
  84/*
  85 * These functions re-use the assembly code in head.S, which
  86 * already provide the required functionality.
  87 */
  88static void __init setup_processor(void)
  89{
  90        printk(KERN_DEFAULT "CPU: UniCore-II [%08x] revision %d, cr=%08lx\n",
  91               uc32_cpuid, (int)(uc32_cpuid >> 16) & 15, cr_alignment);
  92
  93        sprintf(init_utsname()->machine, "puv3");
  94        sprintf(elf_platform, "ucv2");
  95}
  96
  97/*
  98 * cpu_init - initialise one CPU.
  99 *
 100 * cpu_init sets up the per-CPU stacks.
 101 */
 102void cpu_init(void)
 103{
 104        unsigned int cpu = smp_processor_id();
 105        struct stack *stk = &stacks[cpu];
 106
 107        /*
 108         * setup stacks for re-entrant exception handlers
 109         */
 110        __asm__ (
 111        "mov.a  asr, %1\n\t"
 112        "add    sp, %0, %2\n\t"
 113        "mov.a  asr, %3\n\t"
 114        "add    sp, %0, %4\n\t"
 115        "mov.a  asr, %5\n\t"
 116        "add    sp, %0, %6\n\t"
 117        "mov.a  asr, %7"
 118            :
 119            : "r" (stk),
 120              "r" (PSR_R_BIT | PSR_I_BIT | INTR_MODE),
 121              "I" (offsetof(struct stack, irq[0])),
 122              "r" (PSR_R_BIT | PSR_I_BIT | ABRT_MODE),
 123              "I" (offsetof(struct stack, abt[0])),
 124              "r" (PSR_R_BIT | PSR_I_BIT | EXTN_MODE),
 125              "I" (offsetof(struct stack, und[0])),
 126              "r" (PSR_R_BIT | PSR_I_BIT | PRIV_MODE)
 127        : "r30", "cc");
 128}
 129
 130static int __init uc32_add_memory(unsigned long start, unsigned long size)
 131{
 132        struct membank *bank = &meminfo.bank[meminfo.nr_banks];
 133
 134        if (meminfo.nr_banks >= NR_BANKS) {
 135                printk(KERN_CRIT "NR_BANKS too low, "
 136                        "ignoring memory at %#lx\n", start);
 137                return -EINVAL;
 138        }
 139
 140        /*
 141         * Ensure that start/size are aligned to a page boundary.
 142         * Size is appropriately rounded down, start is rounded up.
 143         */
 144        size -= start & ~PAGE_MASK;
 145
 146        bank->start = PAGE_ALIGN(start);
 147        bank->size  = size & PAGE_MASK;
 148
 149        /*
 150         * Check whether this memory region has non-zero size or
 151         * invalid node number.
 152         */
 153        if (bank->size == 0)
 154                return -EINVAL;
 155
 156        meminfo.nr_banks++;
 157        return 0;
 158}
 159
 160/*
 161 * Pick out the memory size.  We look for mem=size@start,
 162 * where start and size are "size[KkMm]"
 163 */
 164static int __init early_mem(char *p)
 165{
 166        static int usermem __initdata = 1;
 167        unsigned long size, start;
 168        char *endp;
 169
 170        /*
 171         * If the user specifies memory size, we
 172         * blow away any automatically generated
 173         * size.
 174         */
 175        if (usermem) {
 176                usermem = 0;
 177                meminfo.nr_banks = 0;
 178        }
 179
 180        start = PHYS_OFFSET;
 181        size  = memparse(p, &endp);
 182        if (*endp == '@')
 183                start = memparse(endp + 1, NULL);
 184
 185        uc32_add_memory(start, size);
 186
 187        return 0;
 188}
 189early_param("mem", early_mem);
 190
 191static void __init
 192request_standard_resources(struct meminfo *mi)
 193{
 194        struct resource *res;
 195        int i;
 196
 197        kernel_code.start   = virt_to_phys(_stext);
 198        kernel_code.end     = virt_to_phys(_etext - 1);
 199        kernel_data.start   = virt_to_phys(_sdata);
 200        kernel_data.end     = virt_to_phys(_end - 1);
 201
 202        for (i = 0; i < mi->nr_banks; i++) {
 203                if (mi->bank[i].size == 0)
 204                        continue;
 205
 206                res = memblock_alloc_low(sizeof(*res), SMP_CACHE_BYTES);
 207                if (!res)
 208                        panic("%s: Failed to allocate %zu bytes align=%x\n",
 209                              __func__, sizeof(*res), SMP_CACHE_BYTES);
 210
 211                res->name  = "System RAM";
 212                res->start = mi->bank[i].start;
 213                res->end   = mi->bank[i].start + mi->bank[i].size - 1;
 214                res->flags = IORESOURCE_SYSTEM_RAM | IORESOURCE_BUSY;
 215
 216                request_resource(&iomem_resource, res);
 217
 218                if (kernel_code.start >= res->start &&
 219                    kernel_code.end <= res->end)
 220                        request_resource(res, &kernel_code);
 221                if (kernel_data.start >= res->start &&
 222                    kernel_data.end <= res->end)
 223                        request_resource(res, &kernel_data);
 224        }
 225}
 226
 227static void (*init_machine)(void) __initdata;
 228
 229static int __init customize_machine(void)
 230{
 231        /* customizes platform devices, or adds new ones */
 232        if (init_machine)
 233                init_machine();
 234        return 0;
 235}
 236arch_initcall(customize_machine);
 237
 238void __init setup_arch(char **cmdline_p)
 239{
 240        char *from = default_command_line;
 241
 242        setup_processor();
 243
 244        init_mm.start_code = (unsigned long) _stext;
 245        init_mm.end_code   = (unsigned long) _etext;
 246        init_mm.end_data   = (unsigned long) _edata;
 247        init_mm.brk        = (unsigned long) _end;
 248
 249        /* parse_early_param needs a boot_command_line */
 250        strlcpy(boot_command_line, from, COMMAND_LINE_SIZE);
 251
 252        /* populate cmd_line too for later use, preserving boot_command_line */
 253        strlcpy(cmd_line, boot_command_line, COMMAND_LINE_SIZE);
 254        *cmdline_p = cmd_line;
 255
 256        parse_early_param();
 257
 258        uc32_memblock_init(&meminfo);
 259
 260        paging_init();
 261        request_standard_resources(&meminfo);
 262
 263        cpu_init();
 264
 265        /*
 266         * Set up various architecture-specific pointers
 267         */
 268        init_machine = puv3_core_init;
 269
 270#ifdef CONFIG_VT
 271#if defined(CONFIG_VGA_CONSOLE)
 272        conswitchp = &vga_con;
 273#elif defined(CONFIG_DUMMY_CONSOLE)
 274        conswitchp = &dummy_con;
 275#endif
 276#endif
 277        early_trap_init();
 278}
 279
 280static struct cpu cpuinfo_unicore;
 281
 282static int __init topology_init(void)
 283{
 284        int i;
 285
 286        for_each_possible_cpu(i)
 287                register_cpu(&cpuinfo_unicore, i);
 288
 289        return 0;
 290}
 291subsys_initcall(topology_init);
 292
 293#ifdef CONFIG_HAVE_PROC_CPU
 294static int __init proc_cpu_init(void)
 295{
 296        struct proc_dir_entry *res;
 297
 298        res = proc_mkdir("cpu", NULL);
 299        if (!res)
 300                return -ENOMEM;
 301        return 0;
 302}
 303fs_initcall(proc_cpu_init);
 304#endif
 305
 306static int c_show(struct seq_file *m, void *v)
 307{
 308        seq_printf(m, "Processor\t: UniCore-II rev %d (%s)\n",
 309                   (int)(uc32_cpuid >> 16) & 15, elf_platform);
 310
 311        seq_printf(m, "BogoMIPS\t: %lu.%02lu\n",
 312                   loops_per_jiffy / (500000/HZ),
 313                   (loops_per_jiffy / (5000/HZ)) % 100);
 314
 315        /* dump out the processor features */
 316        seq_puts(m, "Features\t: CMOV UC-F64");
 317
 318        seq_printf(m, "\nCPU implementer\t: 0x%02x\n", uc32_cpuid >> 24);
 319        seq_printf(m, "CPU architecture: 2\n");
 320        seq_printf(m, "CPU revision\t: %d\n", (uc32_cpuid >> 16) & 15);
 321
 322        seq_printf(m, "Cache type\t: write-back\n"
 323                        "Cache clean\t: cp0 c5 ops\n"
 324                        "Cache lockdown\t: not support\n"
 325                        "Cache format\t: Harvard\n");
 326
 327        seq_puts(m, "\n");
 328
 329        seq_printf(m, "Hardware\t: PKUnity v3\n");
 330
 331        return 0;
 332}
 333
 334static void *c_start(struct seq_file *m, loff_t *pos)
 335{
 336        return *pos < 1 ? (void *)1 : NULL;
 337}
 338
 339static void *c_next(struct seq_file *m, void *v, loff_t *pos)
 340{
 341        ++*pos;
 342        return NULL;
 343}
 344
 345static void c_stop(struct seq_file *m, void *v)
 346{
 347}
 348
 349const struct seq_operations cpuinfo_op = {
 350        .start  = c_start,
 351        .next   = c_next,
 352        .stop   = c_stop,
 353        .show   = c_show
 354};
 355