Linux Audio

Check our new training course

Loading...
v6.8
  1// SPDX-License-Identifier: GPL-2.0
  2/*
  3 * Copyright (C) 2020-2022 Loongson Technology Corporation Limited
  4 *
  5 * Derived from MIPS:
  6 * Copyright (C) 1995 Linus Torvalds
  7 * Copyright (C) 1995 Waldorf Electronics
  8 * Copyright (C) 1994, 95, 96, 97, 98, 99, 2000, 01, 02, 03  Ralf Baechle
  9 * Copyright (C) 1996 Stoned Elipot
 10 * Copyright (C) 1999 Silicon Graphics, Inc.
 11 * Copyright (C) 2000, 2001, 2002, 2007	 Maciej W. Rozycki
 12 */
 13#include <linux/init.h>
 14#include <linux/acpi.h>
 15#include <linux/cpu.h>
 16#include <linux/dmi.h>
 17#include <linux/efi.h>
 18#include <linux/export.h>
 
 19#include <linux/memblock.h>
 20#include <linux/initrd.h>
 21#include <linux/ioport.h>
 22#include <linux/kexec.h>
 23#include <linux/crash_dump.h>
 24#include <linux/root_dev.h>
 25#include <linux/console.h>
 26#include <linux/pfn.h>
 27#include <linux/platform_device.h>
 28#include <linux/sizes.h>
 29#include <linux/device.h>
 30#include <linux/dma-map-ops.h>
 31#include <linux/libfdt.h>
 32#include <linux/of_fdt.h>
 33#include <linux/of_address.h>
 34#include <linux/suspend.h>
 35#include <linux/swiotlb.h>
 36
 37#include <asm/addrspace.h>
 38#include <asm/alternative.h>
 39#include <asm/bootinfo.h>
 
 40#include <asm/cache.h>
 41#include <asm/cpu.h>
 42#include <asm/dma.h>
 43#include <asm/efi.h>
 44#include <asm/loongson.h>
 45#include <asm/numa.h>
 46#include <asm/pgalloc.h>
 47#include <asm/sections.h>
 48#include <asm/setup.h>
 49#include <asm/time.h>
 50
 51#define SMBIOS_BIOSSIZE_OFFSET		0x09
 52#define SMBIOS_BIOSEXTERN_OFFSET	0x13
 53#define SMBIOS_FREQLOW_OFFSET		0x16
 54#define SMBIOS_FREQHIGH_OFFSET		0x17
 55#define SMBIOS_FREQLOW_MASK		0xFF
 56#define SMBIOS_CORE_PACKAGE_OFFSET	0x23
 57#define LOONGSON_EFI_ENABLE		(1 << 3)
 58
 
 
 59unsigned long fw_arg0, fw_arg1, fw_arg2;
 60DEFINE_PER_CPU(unsigned long, kernelsp);
 61struct cpuinfo_loongarch cpu_data[NR_CPUS] __read_mostly;
 62
 63EXPORT_SYMBOL(cpu_data);
 64
 65struct loongson_board_info b_info;
 66static const char dmi_empty_string[] = "        ";
 67
 68/*
 69 * Setup information
 70 *
 71 * These are initialized so they are in the .data section
 72 */
 73char init_command_line[COMMAND_LINE_SIZE] __initdata;
 74
 75static int num_standard_resources;
 76static struct resource *standard_resources;
 77
 78static struct resource code_resource = { .name = "Kernel code", };
 79static struct resource data_resource = { .name = "Kernel data", };
 80static struct resource bss_resource  = { .name = "Kernel bss", };
 81
 82const char *get_system_type(void)
 83{
 84	return "generic-loongson-machine";
 85}
 86
 87void __init arch_cpu_finalize_init(void)
 88{
 89	alternative_instructions();
 90}
 91
 92static const char *dmi_string_parse(const struct dmi_header *dm, u8 s)
 93{
 94	const u8 *bp = ((u8 *) dm) + dm->length;
 95
 96	if (s) {
 97		s--;
 98		while (s > 0 && *bp) {
 99			bp += strlen(bp) + 1;
100			s--;
101		}
102
103		if (*bp != 0) {
104			size_t len = strlen(bp)+1;
105			size_t cmp_len = len > 8 ? 8 : len;
106
107			if (!memcmp(bp, dmi_empty_string, cmp_len))
108				return dmi_empty_string;
109
110			return bp;
111		}
112	}
113
114	return "";
115}
116
117static void __init parse_cpu_table(const struct dmi_header *dm)
118{
119	long freq_temp = 0;
120	char *dmi_data = (char *)dm;
121
122	freq_temp = ((*(dmi_data + SMBIOS_FREQHIGH_OFFSET) << 8) +
123			((*(dmi_data + SMBIOS_FREQLOW_OFFSET)) & SMBIOS_FREQLOW_MASK));
124	cpu_clock_freq = freq_temp * 1000000;
125
126	loongson_sysconf.cpuname = (void *)dmi_string_parse(dm, dmi_data[16]);
127	loongson_sysconf.cores_per_package = *(dmi_data + SMBIOS_CORE_PACKAGE_OFFSET);
128
129	pr_info("CpuClock = %llu\n", cpu_clock_freq);
130}
131
132static void __init parse_bios_table(const struct dmi_header *dm)
133{
134	char *dmi_data = (char *)dm;
135
136	b_info.bios_size = (*(dmi_data + SMBIOS_BIOSSIZE_OFFSET) + 1) << 6;
137}
138
139static void __init find_tokens(const struct dmi_header *dm, void *dummy)
140{
141	switch (dm->type) {
142	case 0x0: /* Extern BIOS */
143		parse_bios_table(dm);
144		break;
145	case 0x4: /* Calling interface */
146		parse_cpu_table(dm);
147		break;
148	}
149}
150static void __init smbios_parse(void)
151{
152	b_info.bios_vendor = (void *)dmi_get_system_info(DMI_BIOS_VENDOR);
153	b_info.bios_version = (void *)dmi_get_system_info(DMI_BIOS_VERSION);
154	b_info.bios_release_date = (void *)dmi_get_system_info(DMI_BIOS_DATE);
155	b_info.board_vendor = (void *)dmi_get_system_info(DMI_BOARD_VENDOR);
156	b_info.board_name = (void *)dmi_get_system_info(DMI_BOARD_NAME);
157	dmi_walk(find_tokens, NULL);
158}
159
160#ifdef CONFIG_ARCH_WRITECOMBINE
161bool wc_enabled = true;
162#else
163bool wc_enabled = false;
164#endif
165
166EXPORT_SYMBOL(wc_enabled);
167
168static int __init setup_writecombine(char *p)
169{
170	if (!strcmp(p, "on"))
171		wc_enabled = true;
172	else if (!strcmp(p, "off"))
173		wc_enabled = false;
174	else
175		pr_warn("Unknown writecombine setting \"%s\".\n", p);
176
177	return 0;
178}
179early_param("writecombine", setup_writecombine);
180
181static int usermem __initdata;
182
183static int __init early_parse_mem(char *p)
184{
185	phys_addr_t start, size;
186
187	if (!p) {
188		pr_err("mem parameter is empty, do nothing\n");
189		return -EINVAL;
190	}
191
192	/*
193	 * If a user specifies memory size, we
194	 * blow away any automatically generated
195	 * size.
196	 */
197	if (usermem == 0) {
198		usermem = 1;
199		memblock_remove(memblock_start_of_DRAM(),
200			memblock_end_of_DRAM() - memblock_start_of_DRAM());
201	}
202	start = 0;
203	size = memparse(p, &p);
204	if (*p == '@')
205		start = memparse(p + 1, &p);
206	else {
207		pr_err("Invalid format!\n");
208		return -EINVAL;
209	}
210
211	if (!IS_ENABLED(CONFIG_NUMA))
212		memblock_add(start, size);
213	else
214		memblock_add_node(start, size, pa_to_nid(start), MEMBLOCK_NONE);
215
216	return 0;
217}
218early_param("mem", early_parse_mem);
219
220static void __init arch_reserve_vmcore(void)
221{
222#ifdef CONFIG_PROC_VMCORE
223	u64 i;
224	phys_addr_t start, end;
225
226	if (!is_kdump_kernel())
227		return;
228
229	if (!elfcorehdr_size) {
230		for_each_mem_range(i, &start, &end) {
231			if (elfcorehdr_addr >= start && elfcorehdr_addr < end) {
232				/*
233				 * Reserve from the elf core header to the end of
234				 * the memory segment, that should all be kdump
235				 * reserved memory.
236				 */
237				elfcorehdr_size = end - elfcorehdr_addr;
238				break;
239			}
240		}
241	}
242
243	if (memblock_is_region_reserved(elfcorehdr_addr, elfcorehdr_size)) {
244		pr_warn("elfcorehdr is overlapped\n");
245		return;
246	}
247
248	memblock_reserve(elfcorehdr_addr, elfcorehdr_size);
249
250	pr_info("Reserving %llu KiB of memory at 0x%llx for elfcorehdr\n",
251		elfcorehdr_size >> 10, elfcorehdr_addr);
252#endif
253}
254
255static void __init arch_reserve_crashkernel(void)
256{
 
257	int ret;
258	unsigned long long low_size = 0;
 
259	unsigned long long crash_base, crash_size;
260	char *cmdline = boot_command_line;
261	bool high = false;
262
263	if (!IS_ENABLED(CONFIG_KEXEC_CORE))
 
 
264		return;
265
266	ret = parse_crashkernel(cmdline, memblock_phys_mem_size(),
267				&crash_size, &crash_base, &low_size, &high);
268	if (ret)
269		return;
 
270
271	reserve_crashkernel_generic(cmdline, crash_size, crash_base, low_size, high);
 
 
272}
273
274static void __init fdt_setup(void)
275{
276#ifdef CONFIG_OF_EARLY_FLATTREE
277	void *fdt_pointer;
278
279	/* ACPI-based systems do not require parsing fdt */
280	if (acpi_os_get_root_pointer())
281		return;
282
283	/* Prefer to use built-in dtb, checking its legality first. */
284	if (!fdt_check_header(__dtb_start))
285		fdt_pointer = __dtb_start;
286	else
287		fdt_pointer = efi_fdt_pointer(); /* Fallback to firmware dtb */
288
289	if (!fdt_pointer || fdt_check_header(fdt_pointer))
290		return;
291
292	early_init_dt_scan(fdt_pointer);
293	early_init_fdt_reserve_self();
294
295	max_low_pfn = PFN_PHYS(memblock_end_of_DRAM());
296#endif
297}
298
299static void __init bootcmdline_init(char **cmdline_p)
300{
301	/*
302	 * If CONFIG_CMDLINE_FORCE is enabled then initializing the command line
303	 * is trivial - we simply use the built-in command line unconditionally &
304	 * unmodified.
305	 */
306	if (IS_ENABLED(CONFIG_CMDLINE_FORCE)) {
307		strscpy(boot_command_line, CONFIG_CMDLINE, COMMAND_LINE_SIZE);
308		goto out;
309	}
310
311#ifdef CONFIG_OF_FLATTREE
312	/*
313	 * If CONFIG_CMDLINE_BOOTLOADER is enabled and we are in FDT-based system,
314	 * the boot_command_line will be overwritten by early_init_dt_scan_chosen().
315	 * So we need to append init_command_line (the original copy of boot_command_line)
316	 * to boot_command_line.
317	 */
318	if (initial_boot_params) {
319		if (boot_command_line[0])
320			strlcat(boot_command_line, " ", COMMAND_LINE_SIZE);
321
322		if (!strstr(boot_command_line, init_command_line))
323			strlcat(boot_command_line, init_command_line, COMMAND_LINE_SIZE);
324
325		goto out;
326	}
327#endif
328
329	/*
330	 * Append built-in command line to the bootloader command line if
331	 * CONFIG_CMDLINE_EXTEND is enabled.
332	 */
333	if (IS_ENABLED(CONFIG_CMDLINE_EXTEND) && CONFIG_CMDLINE[0]) {
334		strlcat(boot_command_line, " ", COMMAND_LINE_SIZE);
335		strlcat(boot_command_line, CONFIG_CMDLINE, COMMAND_LINE_SIZE);
336	}
337
338	/*
339	 * Use built-in command line if the bootloader command line is empty.
340	 */
341	if (IS_ENABLED(CONFIG_CMDLINE_BOOTLOADER) && !boot_command_line[0])
342		strscpy(boot_command_line, CONFIG_CMDLINE, COMMAND_LINE_SIZE);
343
344out:
345	*cmdline_p = boot_command_line;
346}
347
348void __init platform_init(void)
349{
350	arch_reserve_vmcore();
351	arch_reserve_crashkernel();
352
353#ifdef CONFIG_ACPI_TABLE_UPGRADE
354	acpi_table_upgrade();
355#endif
356#ifdef CONFIG_ACPI
357	acpi_gbl_use_default_register_widths = false;
358	acpi_boot_table_init();
359#endif
360
361	early_init_fdt_scan_reserved_mem();
362	unflatten_and_copy_device_tree();
363
364#ifdef CONFIG_NUMA
365	init_numa_memory();
366#endif
367	dmi_setup();
368	smbios_parse();
369	pr_info("The BIOS Version: %s\n", b_info.bios_version);
370
371	efi_runtime_init();
372}
373
374static void __init check_kernel_sections_mem(void)
375{
376	phys_addr_t start = __pa_symbol(&_text);
377	phys_addr_t size = __pa_symbol(&_end) - start;
378
379	if (!memblock_is_region_memory(start, size)) {
380		pr_info("Kernel sections are not in the memory maps\n");
381		memblock_add(start, size);
382	}
383}
384
385/*
386 * arch_mem_init - initialize memory management subsystem
387 */
388static void __init arch_mem_init(char **cmdline_p)
389{
390	if (usermem)
391		pr_info("User-defined physical RAM map overwrite\n");
392
393	check_kernel_sections_mem();
394
 
 
395	/*
396	 * In order to reduce the possibility of kernel panic when failed to
397	 * get IO TLB memory under CONFIG_SWIOTLB, it is better to allocate
398	 * low memory as small as possible before swiotlb_init(), so make
399	 * sparse_init() using top-down allocation.
400	 */
401	memblock_set_bottom_up(false);
402	sparse_init();
403	memblock_set_bottom_up(true);
404
405	swiotlb_init(true, SWIOTLB_VERBOSE);
406
407	dma_contiguous_reserve(PFN_PHYS(max_low_pfn));
408
409	/* Reserve for hibernation. */
410	register_nosave_region(PFN_DOWN(__pa_symbol(&__nosave_begin)),
411				   PFN_UP(__pa_symbol(&__nosave_end)));
412
413	memblock_dump_all();
414
415	early_memtest(PFN_PHYS(ARCH_PFN_OFFSET), PFN_PHYS(max_low_pfn));
416}
417
418static void __init resource_init(void)
419{
420	long i = 0;
421	size_t res_size;
422	struct resource *res;
423	struct memblock_region *region;
424
425	code_resource.start = __pa_symbol(&_text);
426	code_resource.end = __pa_symbol(&_etext) - 1;
427	data_resource.start = __pa_symbol(&_etext);
428	data_resource.end = __pa_symbol(&_edata) - 1;
429	bss_resource.start = __pa_symbol(&__bss_start);
430	bss_resource.end = __pa_symbol(&__bss_stop) - 1;
431
432	num_standard_resources = memblock.memory.cnt;
433	res_size = num_standard_resources * sizeof(*standard_resources);
434	standard_resources = memblock_alloc(res_size, SMP_CACHE_BYTES);
435
436	for_each_mem_region(region) {
437		res = &standard_resources[i++];
438		if (!memblock_is_nomap(region)) {
439			res->name  = "System RAM";
440			res->flags = IORESOURCE_SYSTEM_RAM | IORESOURCE_BUSY;
441			res->start = __pfn_to_phys(memblock_region_memory_base_pfn(region));
442			res->end = __pfn_to_phys(memblock_region_memory_end_pfn(region)) - 1;
443		} else {
444			res->name  = "Reserved";
445			res->flags = IORESOURCE_MEM;
446			res->start = __pfn_to_phys(memblock_region_reserved_base_pfn(region));
447			res->end = __pfn_to_phys(memblock_region_reserved_end_pfn(region)) - 1;
448		}
449
450		request_resource(&iomem_resource, res);
451
452		/*
453		 *  We don't know which RAM region contains kernel data,
454		 *  so we try it repeatedly and let the resource manager
455		 *  test it.
456		 */
457		request_resource(res, &code_resource);
458		request_resource(res, &data_resource);
459		request_resource(res, &bss_resource);
460	}
 
 
 
 
 
 
 
 
 
461}
462
463static int __init add_legacy_isa_io(struct fwnode_handle *fwnode,
464				resource_size_t hw_start, resource_size_t size)
465{
466	int ret = 0;
467	unsigned long vaddr;
468	struct logic_pio_hwaddr *range;
469
470	range = kzalloc(sizeof(*range), GFP_ATOMIC);
471	if (!range)
472		return -ENOMEM;
473
474	range->fwnode = fwnode;
475	range->size = size = round_up(size, PAGE_SIZE);
476	range->hw_start = hw_start;
477	range->flags = LOGIC_PIO_CPU_MMIO;
478
479	ret = logic_pio_register_range(range);
480	if (ret) {
481		kfree(range);
482		return ret;
483	}
484
485	/* Legacy ISA must placed at the start of PCI_IOBASE */
486	if (range->io_start != 0) {
487		logic_pio_unregister_range(range);
488		kfree(range);
489		return -EINVAL;
490	}
491
492	vaddr = (unsigned long)(PCI_IOBASE + range->io_start);
493	ioremap_page_range(vaddr, vaddr + size, hw_start, pgprot_device(PAGE_KERNEL));
494
495	return 0;
496}
497
498static __init int arch_reserve_pio_range(void)
499{
500	struct device_node *np;
501
502	for_each_node_by_name(np, "isa") {
503		struct of_range range;
504		struct of_range_parser parser;
505
506		pr_info("ISA Bridge: %pOF\n", np);
507
508		if (of_range_parser_init(&parser, np)) {
509			pr_info("Failed to parse resources.\n");
510			of_node_put(np);
511			break;
512		}
513
514		for_each_of_range(&parser, &range) {
515			switch (range.flags & IORESOURCE_TYPE_BITS) {
516			case IORESOURCE_IO:
517				pr_info(" IO 0x%016llx..0x%016llx  ->  0x%016llx\n",
518					range.cpu_addr,
519					range.cpu_addr + range.size - 1,
520					range.bus_addr);
521				if (add_legacy_isa_io(&np->fwnode, range.cpu_addr, range.size))
522					pr_warn("Failed to reserve legacy IO in Logic PIO\n");
523				break;
524			case IORESOURCE_MEM:
525				pr_info(" MEM 0x%016llx..0x%016llx  ->  0x%016llx\n",
526					range.cpu_addr,
527					range.cpu_addr + range.size - 1,
528					range.bus_addr);
529				break;
530			}
531		}
532	}
533
534	return 0;
535}
536arch_initcall(arch_reserve_pio_range);
537
538static int __init reserve_memblock_reserved_regions(void)
539{
540	u64 i, j;
541
542	for (i = 0; i < num_standard_resources; ++i) {
543		struct resource *mem = &standard_resources[i];
544		phys_addr_t r_start, r_end, mem_size = resource_size(mem);
545
546		if (!memblock_is_region_reserved(mem->start, mem_size))
547			continue;
548
549		for_each_reserved_mem_range(j, &r_start, &r_end) {
550			resource_size_t start, end;
551
552			start = max(PFN_PHYS(PFN_DOWN(r_start)), mem->start);
553			end = min(PFN_PHYS(PFN_UP(r_end)) - 1, mem->end);
554
555			if (start > mem->end || end < mem->start)
556				continue;
557
558			reserve_region_with_split(mem, start, end, "Reserved");
559		}
560	}
561
562	return 0;
563}
564arch_initcall(reserve_memblock_reserved_regions);
565
566#ifdef CONFIG_SMP
567static void __init prefill_possible_map(void)
568{
569	int i, possible;
570
571	possible = num_processors + disabled_cpus;
572	if (possible > nr_cpu_ids)
573		possible = nr_cpu_ids;
574
575	pr_info("SMP: Allowing %d CPUs, %d hotplug CPUs\n",
576			possible, max((possible - num_processors), 0));
577
578	for (i = 0; i < possible; i++)
579		set_cpu_possible(i, true);
580	for (; i < NR_CPUS; i++)
581		set_cpu_possible(i, false);
582
583	set_nr_cpu_ids(possible);
584}
585#endif
586
587void __init setup_arch(char **cmdline_p)
588{
589	cpu_probe();
590
591	init_environ();
592	efi_init();
593	fdt_setup();
594	memblock_init();
595	pagetable_init();
596	bootcmdline_init(cmdline_p);
597	parse_early_param();
598	reserve_initrd_mem();
599
600	platform_init();
601	arch_mem_init(cmdline_p);
602
603	resource_init();
604#ifdef CONFIG_SMP
605	plat_smp_setup();
606	prefill_possible_map();
607#endif
608
609	paging_init();
610
611#ifdef CONFIG_KASAN
612	kasan_init();
613#endif
614}
v6.2
  1// SPDX-License-Identifier: GPL-2.0
  2/*
  3 * Copyright (C) 2020-2022 Loongson Technology Corporation Limited
  4 *
  5 * Derived from MIPS:
  6 * Copyright (C) 1995 Linus Torvalds
  7 * Copyright (C) 1995 Waldorf Electronics
  8 * Copyright (C) 1994, 95, 96, 97, 98, 99, 2000, 01, 02, 03  Ralf Baechle
  9 * Copyright (C) 1996 Stoned Elipot
 10 * Copyright (C) 1999 Silicon Graphics, Inc.
 11 * Copyright (C) 2000, 2001, 2002, 2007	 Maciej W. Rozycki
 12 */
 13#include <linux/init.h>
 14#include <linux/acpi.h>
 
 15#include <linux/dmi.h>
 16#include <linux/efi.h>
 17#include <linux/export.h>
 18#include <linux/screen_info.h>
 19#include <linux/memblock.h>
 20#include <linux/initrd.h>
 21#include <linux/ioport.h>
 22#include <linux/kexec.h>
 23#include <linux/crash_dump.h>
 24#include <linux/root_dev.h>
 25#include <linux/console.h>
 26#include <linux/pfn.h>
 27#include <linux/platform_device.h>
 28#include <linux/sizes.h>
 29#include <linux/device.h>
 30#include <linux/dma-map-ops.h>
 31#include <linux/libfdt.h>
 32#include <linux/of_fdt.h>
 33#include <linux/of_address.h>
 34#include <linux/suspend.h>
 35#include <linux/swiotlb.h>
 36
 37#include <asm/addrspace.h>
 38#include <asm/alternative.h>
 39#include <asm/bootinfo.h>
 40#include <asm/bugs.h>
 41#include <asm/cache.h>
 42#include <asm/cpu.h>
 43#include <asm/dma.h>
 44#include <asm/efi.h>
 45#include <asm/loongson.h>
 46#include <asm/numa.h>
 47#include <asm/pgalloc.h>
 48#include <asm/sections.h>
 49#include <asm/setup.h>
 50#include <asm/time.h>
 51
 52#define SMBIOS_BIOSSIZE_OFFSET		0x09
 53#define SMBIOS_BIOSEXTERN_OFFSET	0x13
 54#define SMBIOS_FREQLOW_OFFSET		0x16
 55#define SMBIOS_FREQHIGH_OFFSET		0x17
 56#define SMBIOS_FREQLOW_MASK		0xFF
 57#define SMBIOS_CORE_PACKAGE_OFFSET	0x23
 58#define LOONGSON_EFI_ENABLE		(1 << 3)
 59
 60struct screen_info screen_info __section(".data");
 61
 62unsigned long fw_arg0, fw_arg1, fw_arg2;
 63DEFINE_PER_CPU(unsigned long, kernelsp);
 64struct cpuinfo_loongarch cpu_data[NR_CPUS] __read_mostly;
 65
 66EXPORT_SYMBOL(cpu_data);
 67
 68struct loongson_board_info b_info;
 69static const char dmi_empty_string[] = "        ";
 70
 71/*
 72 * Setup information
 73 *
 74 * These are initialized so they are in the .data section
 75 */
 76char init_command_line[COMMAND_LINE_SIZE] __initdata;
 77
 78static int num_standard_resources;
 79static struct resource *standard_resources;
 80
 81static struct resource code_resource = { .name = "Kernel code", };
 82static struct resource data_resource = { .name = "Kernel data", };
 83static struct resource bss_resource  = { .name = "Kernel bss", };
 84
 85const char *get_system_type(void)
 86{
 87	return "generic-loongson-machine";
 88}
 89
 90void __init check_bugs(void)
 91{
 92	alternative_instructions();
 93}
 94
 95static const char *dmi_string_parse(const struct dmi_header *dm, u8 s)
 96{
 97	const u8 *bp = ((u8 *) dm) + dm->length;
 98
 99	if (s) {
100		s--;
101		while (s > 0 && *bp) {
102			bp += strlen(bp) + 1;
103			s--;
104		}
105
106		if (*bp != 0) {
107			size_t len = strlen(bp)+1;
108			size_t cmp_len = len > 8 ? 8 : len;
109
110			if (!memcmp(bp, dmi_empty_string, cmp_len))
111				return dmi_empty_string;
112
113			return bp;
114		}
115	}
116
117	return "";
118}
119
120static void __init parse_cpu_table(const struct dmi_header *dm)
121{
122	long freq_temp = 0;
123	char *dmi_data = (char *)dm;
124
125	freq_temp = ((*(dmi_data + SMBIOS_FREQHIGH_OFFSET) << 8) +
126			((*(dmi_data + SMBIOS_FREQLOW_OFFSET)) & SMBIOS_FREQLOW_MASK));
127	cpu_clock_freq = freq_temp * 1000000;
128
129	loongson_sysconf.cpuname = (void *)dmi_string_parse(dm, dmi_data[16]);
130	loongson_sysconf.cores_per_package = *(dmi_data + SMBIOS_CORE_PACKAGE_OFFSET);
131
132	pr_info("CpuClock = %llu\n", cpu_clock_freq);
133}
134
135static void __init parse_bios_table(const struct dmi_header *dm)
136{
137	char *dmi_data = (char *)dm;
138
139	b_info.bios_size = (*(dmi_data + SMBIOS_BIOSSIZE_OFFSET) + 1) << 6;
140}
141
142static void __init find_tokens(const struct dmi_header *dm, void *dummy)
143{
144	switch (dm->type) {
145	case 0x0: /* Extern BIOS */
146		parse_bios_table(dm);
147		break;
148	case 0x4: /* Calling interface */
149		parse_cpu_table(dm);
150		break;
151	}
152}
153static void __init smbios_parse(void)
154{
155	b_info.bios_vendor = (void *)dmi_get_system_info(DMI_BIOS_VENDOR);
156	b_info.bios_version = (void *)dmi_get_system_info(DMI_BIOS_VERSION);
157	b_info.bios_release_date = (void *)dmi_get_system_info(DMI_BIOS_DATE);
158	b_info.board_vendor = (void *)dmi_get_system_info(DMI_BOARD_VENDOR);
159	b_info.board_name = (void *)dmi_get_system_info(DMI_BOARD_NAME);
160	dmi_walk(find_tokens, NULL);
161}
162
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
163static int usermem __initdata;
164
165static int __init early_parse_mem(char *p)
166{
167	phys_addr_t start, size;
168
169	if (!p) {
170		pr_err("mem parameter is empty, do nothing\n");
171		return -EINVAL;
172	}
173
174	/*
175	 * If a user specifies memory size, we
176	 * blow away any automatically generated
177	 * size.
178	 */
179	if (usermem == 0) {
180		usermem = 1;
181		memblock_remove(memblock_start_of_DRAM(),
182			memblock_end_of_DRAM() - memblock_start_of_DRAM());
183	}
184	start = 0;
185	size = memparse(p, &p);
186	if (*p == '@')
187		start = memparse(p + 1, &p);
188	else {
189		pr_err("Invalid format!\n");
190		return -EINVAL;
191	}
192
193	if (!IS_ENABLED(CONFIG_NUMA))
194		memblock_add(start, size);
195	else
196		memblock_add_node(start, size, pa_to_nid(start), MEMBLOCK_NONE);
197
198	return 0;
199}
200early_param("mem", early_parse_mem);
201
202static void __init arch_reserve_vmcore(void)
203{
204#ifdef CONFIG_PROC_VMCORE
205	u64 i;
206	phys_addr_t start, end;
207
208	if (!is_kdump_kernel())
209		return;
210
211	if (!elfcorehdr_size) {
212		for_each_mem_range(i, &start, &end) {
213			if (elfcorehdr_addr >= start && elfcorehdr_addr < end) {
214				/*
215				 * Reserve from the elf core header to the end of
216				 * the memory segment, that should all be kdump
217				 * reserved memory.
218				 */
219				elfcorehdr_size = end - elfcorehdr_addr;
220				break;
221			}
222		}
223	}
224
225	if (memblock_is_region_reserved(elfcorehdr_addr, elfcorehdr_size)) {
226		pr_warn("elfcorehdr is overlapped\n");
227		return;
228	}
229
230	memblock_reserve(elfcorehdr_addr, elfcorehdr_size);
231
232	pr_info("Reserving %llu KiB of memory at 0x%llx for elfcorehdr\n",
233		elfcorehdr_size >> 10, elfcorehdr_addr);
234#endif
235}
236
237static void __init arch_parse_crashkernel(void)
238{
239#ifdef CONFIG_KEXEC
240	int ret;
241	unsigned long long start;
242	unsigned long long total_mem;
243	unsigned long long crash_base, crash_size;
 
 
244
245	total_mem = memblock_phys_mem_size();
246	ret = parse_crashkernel(boot_command_line, total_mem, &crash_size, &crash_base);
247	if (ret < 0 || crash_size <= 0)
248		return;
249
250	start = memblock_phys_alloc_range(crash_size, 1, crash_base, crash_base + crash_size);
251	if (start != crash_base) {
252		pr_warn("Invalid memory region reserved for crash kernel\n");
253		return;
254	}
255
256	crashk_res.start = crash_base;
257	crashk_res.end	 = crash_base + crash_size - 1;
258#endif
259}
260
261static void __init fdt_setup(void)
262{
263#ifdef CONFIG_OF_EARLY_FLATTREE
264	void *fdt_pointer;
265
266	/* ACPI-based systems do not require parsing fdt */
267	if (acpi_os_get_root_pointer())
268		return;
269
270	/* Look for a device tree configuration table entry */
271	fdt_pointer = efi_fdt_pointer();
 
 
 
 
272	if (!fdt_pointer || fdt_check_header(fdt_pointer))
273		return;
274
275	early_init_dt_scan(fdt_pointer);
276	early_init_fdt_reserve_self();
277
278	max_low_pfn = PFN_PHYS(memblock_end_of_DRAM());
279#endif
280}
281
282static void __init bootcmdline_init(char **cmdline_p)
283{
284	/*
285	 * If CONFIG_CMDLINE_FORCE is enabled then initializing the command line
286	 * is trivial - we simply use the built-in command line unconditionally &
287	 * unmodified.
288	 */
289	if (IS_ENABLED(CONFIG_CMDLINE_FORCE)) {
290		strscpy(boot_command_line, CONFIG_CMDLINE, COMMAND_LINE_SIZE);
291		goto out;
292	}
293
294#ifdef CONFIG_OF_FLATTREE
295	/*
296	 * If CONFIG_CMDLINE_BOOTLOADER is enabled and we are in FDT-based system,
297	 * the boot_command_line will be overwritten by early_init_dt_scan_chosen().
298	 * So we need to append init_command_line (the original copy of boot_command_line)
299	 * to boot_command_line.
300	 */
301	if (initial_boot_params) {
302		if (boot_command_line[0])
303			strlcat(boot_command_line, " ", COMMAND_LINE_SIZE);
304
305		strlcat(boot_command_line, init_command_line, COMMAND_LINE_SIZE);
 
 
 
306	}
307#endif
308
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
309out:
310	*cmdline_p = boot_command_line;
311}
312
313void __init platform_init(void)
314{
315	arch_reserve_vmcore();
316	arch_parse_crashkernel();
317
318#ifdef CONFIG_ACPI_TABLE_UPGRADE
319	acpi_table_upgrade();
320#endif
321#ifdef CONFIG_ACPI
322	acpi_gbl_use_default_register_widths = false;
323	acpi_boot_table_init();
324#endif
 
 
325	unflatten_and_copy_device_tree();
326
327#ifdef CONFIG_NUMA
328	init_numa_memory();
329#endif
330	dmi_setup();
331	smbios_parse();
332	pr_info("The BIOS Version: %s\n", b_info.bios_version);
333
334	efi_runtime_init();
335}
336
337static void __init check_kernel_sections_mem(void)
338{
339	phys_addr_t start = __pa_symbol(&_text);
340	phys_addr_t size = __pa_symbol(&_end) - start;
341
342	if (!memblock_is_region_memory(start, size)) {
343		pr_info("Kernel sections are not in the memory maps\n");
344		memblock_add(start, size);
345	}
346}
347
348/*
349 * arch_mem_init - initialize memory management subsystem
350 */
351static void __init arch_mem_init(char **cmdline_p)
352{
353	if (usermem)
354		pr_info("User-defined physical RAM map overwrite\n");
355
356	check_kernel_sections_mem();
357
358	early_init_fdt_scan_reserved_mem();
359
360	/*
361	 * In order to reduce the possibility of kernel panic when failed to
362	 * get IO TLB memory under CONFIG_SWIOTLB, it is better to allocate
363	 * low memory as small as possible before plat_swiotlb_setup(), so
364	 * make sparse_init() using top-down allocation.
365	 */
366	memblock_set_bottom_up(false);
367	sparse_init();
368	memblock_set_bottom_up(true);
369
370	swiotlb_init(true, SWIOTLB_VERBOSE);
371
372	dma_contiguous_reserve(PFN_PHYS(max_low_pfn));
373
374	/* Reserve for hibernation. */
375	register_nosave_region(PFN_DOWN(__pa_symbol(&__nosave_begin)),
376				   PFN_UP(__pa_symbol(&__nosave_end)));
377
378	memblock_dump_all();
379
380	early_memtest(PFN_PHYS(ARCH_PFN_OFFSET), PFN_PHYS(max_low_pfn));
381}
382
383static void __init resource_init(void)
384{
385	long i = 0;
386	size_t res_size;
387	struct resource *res;
388	struct memblock_region *region;
389
390	code_resource.start = __pa_symbol(&_text);
391	code_resource.end = __pa_symbol(&_etext) - 1;
392	data_resource.start = __pa_symbol(&_etext);
393	data_resource.end = __pa_symbol(&_edata) - 1;
394	bss_resource.start = __pa_symbol(&__bss_start);
395	bss_resource.end = __pa_symbol(&__bss_stop) - 1;
396
397	num_standard_resources = memblock.memory.cnt;
398	res_size = num_standard_resources * sizeof(*standard_resources);
399	standard_resources = memblock_alloc(res_size, SMP_CACHE_BYTES);
400
401	for_each_mem_region(region) {
402		res = &standard_resources[i++];
403		if (!memblock_is_nomap(region)) {
404			res->name  = "System RAM";
405			res->flags = IORESOURCE_SYSTEM_RAM | IORESOURCE_BUSY;
406			res->start = __pfn_to_phys(memblock_region_memory_base_pfn(region));
407			res->end = __pfn_to_phys(memblock_region_memory_end_pfn(region)) - 1;
408		} else {
409			res->name  = "Reserved";
410			res->flags = IORESOURCE_MEM;
411			res->start = __pfn_to_phys(memblock_region_reserved_base_pfn(region));
412			res->end = __pfn_to_phys(memblock_region_reserved_end_pfn(region)) - 1;
413		}
414
415		request_resource(&iomem_resource, res);
416
417		/*
418		 *  We don't know which RAM region contains kernel data,
419		 *  so we try it repeatedly and let the resource manager
420		 *  test it.
421		 */
422		request_resource(res, &code_resource);
423		request_resource(res, &data_resource);
424		request_resource(res, &bss_resource);
425	}
426
427#ifdef CONFIG_KEXEC
428	if (crashk_res.start < crashk_res.end) {
429		insert_resource(&iomem_resource, &crashk_res);
430		pr_info("Reserving %ldMB of memory at %ldMB for crashkernel\n",
431			(unsigned long)((crashk_res.end - crashk_res.start + 1) >> 20),
432			(unsigned long)(crashk_res.start  >> 20));
433	}
434#endif
435}
436
437static int __init add_legacy_isa_io(struct fwnode_handle *fwnode,
438				resource_size_t hw_start, resource_size_t size)
439{
440	int ret = 0;
441	unsigned long vaddr;
442	struct logic_pio_hwaddr *range;
443
444	range = kzalloc(sizeof(*range), GFP_ATOMIC);
445	if (!range)
446		return -ENOMEM;
447
448	range->fwnode = fwnode;
449	range->size = size = round_up(size, PAGE_SIZE);
450	range->hw_start = hw_start;
451	range->flags = LOGIC_PIO_CPU_MMIO;
452
453	ret = logic_pio_register_range(range);
454	if (ret) {
455		kfree(range);
456		return ret;
457	}
458
459	/* Legacy ISA must placed at the start of PCI_IOBASE */
460	if (range->io_start != 0) {
461		logic_pio_unregister_range(range);
462		kfree(range);
463		return -EINVAL;
464	}
465
466	vaddr = (unsigned long)(PCI_IOBASE + range->io_start);
467	ioremap_page_range(vaddr, vaddr + size, hw_start, pgprot_device(PAGE_KERNEL));
468
469	return 0;
470}
471
472static __init int arch_reserve_pio_range(void)
473{
474	struct device_node *np;
475
476	for_each_node_by_name(np, "isa") {
477		struct of_range range;
478		struct of_range_parser parser;
479
480		pr_info("ISA Bridge: %pOF\n", np);
481
482		if (of_range_parser_init(&parser, np)) {
483			pr_info("Failed to parse resources.\n");
484			of_node_put(np);
485			break;
486		}
487
488		for_each_of_range(&parser, &range) {
489			switch (range.flags & IORESOURCE_TYPE_BITS) {
490			case IORESOURCE_IO:
491				pr_info(" IO 0x%016llx..0x%016llx  ->  0x%016llx\n",
492					range.cpu_addr,
493					range.cpu_addr + range.size - 1,
494					range.bus_addr);
495				if (add_legacy_isa_io(&np->fwnode, range.cpu_addr, range.size))
496					pr_warn("Failed to reserve legacy IO in Logic PIO\n");
497				break;
498			case IORESOURCE_MEM:
499				pr_info(" MEM 0x%016llx..0x%016llx  ->  0x%016llx\n",
500					range.cpu_addr,
501					range.cpu_addr + range.size - 1,
502					range.bus_addr);
503				break;
504			}
505		}
506	}
507
508	return 0;
509}
510arch_initcall(arch_reserve_pio_range);
511
512static int __init reserve_memblock_reserved_regions(void)
513{
514	u64 i, j;
515
516	for (i = 0; i < num_standard_resources; ++i) {
517		struct resource *mem = &standard_resources[i];
518		phys_addr_t r_start, r_end, mem_size = resource_size(mem);
519
520		if (!memblock_is_region_reserved(mem->start, mem_size))
521			continue;
522
523		for_each_reserved_mem_range(j, &r_start, &r_end) {
524			resource_size_t start, end;
525
526			start = max(PFN_PHYS(PFN_DOWN(r_start)), mem->start);
527			end = min(PFN_PHYS(PFN_UP(r_end)) - 1, mem->end);
528
529			if (start > mem->end || end < mem->start)
530				continue;
531
532			reserve_region_with_split(mem, start, end, "Reserved");
533		}
534	}
535
536	return 0;
537}
538arch_initcall(reserve_memblock_reserved_regions);
539
540#ifdef CONFIG_SMP
541static void __init prefill_possible_map(void)
542{
543	int i, possible;
544
545	possible = num_processors + disabled_cpus;
546	if (possible > nr_cpu_ids)
547		possible = nr_cpu_ids;
548
549	pr_info("SMP: Allowing %d CPUs, %d hotplug CPUs\n",
550			possible, max((possible - num_processors), 0));
551
552	for (i = 0; i < possible; i++)
553		set_cpu_possible(i, true);
554	for (; i < NR_CPUS; i++)
555		set_cpu_possible(i, false);
556
557	set_nr_cpu_ids(possible);
558}
559#endif
560
561void __init setup_arch(char **cmdline_p)
562{
563	cpu_probe();
564
565	init_environ();
566	efi_init();
567	fdt_setup();
568	memblock_init();
569	pagetable_init();
570	bootcmdline_init(cmdline_p);
571	parse_early_param();
572	reserve_initrd_mem();
573
574	platform_init();
575	arch_mem_init(cmdline_p);
576
577	resource_init();
578#ifdef CONFIG_SMP
579	plat_smp_setup();
580	prefill_possible_map();
581#endif
582
583	paging_init();
 
 
 
 
584}