xref: /openbmc/linux/arch/powerpc/kernel/fadump.c (revision c9118e6c37bff9ade90b638207a6e0db676ee6a9)
11a59d1b8SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
2eb39c880SMahesh Salgaonkar /*
3eb39c880SMahesh Salgaonkar  * Firmware Assisted dump: A robust mechanism to get reliable kernel crash
4eb39c880SMahesh Salgaonkar  * dump with assistance from firmware. This approach does not use kexec,
5eb39c880SMahesh Salgaonkar  * instead firmware assists in booting the kdump kernel while preserving
6eb39c880SMahesh Salgaonkar  * memory contents. The most of the code implementation has been adapted
7eb39c880SMahesh Salgaonkar  * from phyp assisted dump implementation written by Linas Vepstas and
8eb39c880SMahesh Salgaonkar  * Manish Ahuja
9eb39c880SMahesh Salgaonkar  *
10eb39c880SMahesh Salgaonkar  * Copyright 2011 IBM Corporation
11eb39c880SMahesh Salgaonkar  * Author: Mahesh Salgaonkar <mahesh@linux.vnet.ibm.com>
12eb39c880SMahesh Salgaonkar  */
13eb39c880SMahesh Salgaonkar 
14eb39c880SMahesh Salgaonkar #undef DEBUG
15eb39c880SMahesh Salgaonkar #define pr_fmt(fmt) "fadump: " fmt
16eb39c880SMahesh Salgaonkar 
17eb39c880SMahesh Salgaonkar #include <linux/string.h>
18eb39c880SMahesh Salgaonkar #include <linux/memblock.h>
193ccc00a7SMahesh Salgaonkar #include <linux/delay.h>
203ccc00a7SMahesh Salgaonkar #include <linux/seq_file.h>
212df173d9SMahesh Salgaonkar #include <linux/crash_dump.h>
22b500afffSMahesh Salgaonkar #include <linux/kobject.h>
23b500afffSMahesh Salgaonkar #include <linux/sysfs.h>
24a5818313SHari Bathini #include <linux/slab.h>
25a4e92ce8SMahesh Salgaonkar #include <linux/cma.h>
2645d0ba52SChristophe Leroy #include <linux/hugetlb.h>
27eb39c880SMahesh Salgaonkar 
287644d581SMichael Ellerman #include <asm/debugfs.h>
29eb39c880SMahesh Salgaonkar #include <asm/page.h>
30eb39c880SMahesh Salgaonkar #include <asm/prom.h>
31eb39c880SMahesh Salgaonkar #include <asm/fadump.h>
32ca986d7fSHari Bathini #include <asm/fadump-internal.h>
33cad3c834SStephen Rothwell #include <asm/setup.h>
34eb39c880SMahesh Salgaonkar 
35ba608c4fSSourabh Jain /*
36ba608c4fSSourabh Jain  * The CPU who acquired the lock to trigger the fadump crash should
37ba608c4fSSourabh Jain  * wait for other CPUs to enter.
38ba608c4fSSourabh Jain  *
39ba608c4fSSourabh Jain  * The timeout is in milliseconds.
40ba608c4fSSourabh Jain  */
41ba608c4fSSourabh Jain #define CRASH_TIMEOUT		500
42ba608c4fSSourabh Jain 
43eb39c880SMahesh Salgaonkar static struct fw_dump fw_dump;
443ccc00a7SMahesh Salgaonkar 
45b2a815a5SHari Bathini static void __init fadump_reserve_crash_area(u64 base);
46b2a815a5SHari Bathini 
47d418b19fSSourabh Jain struct kobject *fadump_kobj;
48d418b19fSSourabh Jain 
49bec53196SHari Bathini #ifndef CONFIG_PRESERVE_FA_DUMP
505f987caeSMichael Ellerman 
515f987caeSMichael Ellerman static atomic_t cpus_in_fadump;
523ccc00a7SMahesh Salgaonkar static DEFINE_MUTEX(fadump_mutex);
535f987caeSMichael Ellerman 
5402c04e37SHari Bathini struct fadump_mrange_info crash_mrange_info = { "crash", NULL, 0, 0, 0, false };
5502c04e37SHari Bathini 
5602c04e37SHari Bathini #define RESERVED_RNGS_SZ	16384 /* 16K - 128 entries */
5702c04e37SHari Bathini #define RESERVED_RNGS_CNT	(RESERVED_RNGS_SZ / \
5802c04e37SHari Bathini 				 sizeof(struct fadump_memory_range))
5902c04e37SHari Bathini static struct fadump_memory_range rngs[RESERVED_RNGS_CNT];
6002c04e37SHari Bathini struct fadump_mrange_info reserved_mrange_info = { "reserved", rngs,
6102c04e37SHari Bathini 						   RESERVED_RNGS_SZ, 0,
6202c04e37SHari Bathini 						   RESERVED_RNGS_CNT, true };
6302c04e37SHari Bathini 
6402c04e37SHari Bathini static void __init early_init_dt_scan_reserved_ranges(unsigned long node);
65eb39c880SMahesh Salgaonkar 
66a4e92ce8SMahesh Salgaonkar #ifdef CONFIG_CMA
670226e552SHari Bathini static struct cma *fadump_cma;
680226e552SHari Bathini 
69a4e92ce8SMahesh Salgaonkar /*
70a4e92ce8SMahesh Salgaonkar  * fadump_cma_init() - Initialize CMA area from a fadump reserved memory
71a4e92ce8SMahesh Salgaonkar  *
72a4e92ce8SMahesh Salgaonkar  * This function initializes CMA area from fadump reserved memory.
73a4e92ce8SMahesh Salgaonkar  * The total size of fadump reserved memory covers for boot memory size
74a4e92ce8SMahesh Salgaonkar  * + cpu data size + hpte size and metadata.
75a4e92ce8SMahesh Salgaonkar  * Initialize only the area equivalent to boot memory size for CMA use.
76a4e92ce8SMahesh Salgaonkar  * The reamining portion of fadump reserved memory will be not given
77a4e92ce8SMahesh Salgaonkar  * to CMA and pages for thoes will stay reserved. boot memory size is
78a4e92ce8SMahesh Salgaonkar  * aligned per CMA requirement to satisy cma_init_reserved_mem() call.
79a4e92ce8SMahesh Salgaonkar  * But for some reason even if it fails we still have the memory reservation
80a4e92ce8SMahesh Salgaonkar  * with us and we can still continue doing fadump.
81a4e92ce8SMahesh Salgaonkar  */
82a4e92ce8SMahesh Salgaonkar int __init fadump_cma_init(void)
83a4e92ce8SMahesh Salgaonkar {
84a4e92ce8SMahesh Salgaonkar 	unsigned long long base, size;
85a4e92ce8SMahesh Salgaonkar 	int rc;
86a4e92ce8SMahesh Salgaonkar 
87a4e92ce8SMahesh Salgaonkar 	if (!fw_dump.fadump_enabled)
88a4e92ce8SMahesh Salgaonkar 		return 0;
89a4e92ce8SMahesh Salgaonkar 
90a4e92ce8SMahesh Salgaonkar 	/*
91a4e92ce8SMahesh Salgaonkar 	 * Do not use CMA if user has provided fadump=nocma kernel parameter.
92a4e92ce8SMahesh Salgaonkar 	 * Return 1 to continue with fadump old behaviour.
93a4e92ce8SMahesh Salgaonkar 	 */
94a4e92ce8SMahesh Salgaonkar 	if (fw_dump.nocma)
95a4e92ce8SMahesh Salgaonkar 		return 1;
96a4e92ce8SMahesh Salgaonkar 
97a4e92ce8SMahesh Salgaonkar 	base = fw_dump.reserve_dump_area_start;
98a4e92ce8SMahesh Salgaonkar 	size = fw_dump.boot_memory_size;
99a4e92ce8SMahesh Salgaonkar 
100a4e92ce8SMahesh Salgaonkar 	if (!size)
101a4e92ce8SMahesh Salgaonkar 		return 0;
102a4e92ce8SMahesh Salgaonkar 
103a4e92ce8SMahesh Salgaonkar 	rc = cma_init_reserved_mem(base, size, 0, "fadump_cma", &fadump_cma);
104a4e92ce8SMahesh Salgaonkar 	if (rc) {
105a4e92ce8SMahesh Salgaonkar 		pr_err("Failed to init cma area for firmware-assisted dump,%d\n", rc);
106a4e92ce8SMahesh Salgaonkar 		/*
107a4e92ce8SMahesh Salgaonkar 		 * Though the CMA init has failed we still have memory
108a4e92ce8SMahesh Salgaonkar 		 * reservation with us. The reserved memory will be
109a4e92ce8SMahesh Salgaonkar 		 * blocked from production system usage.  Hence return 1,
110a4e92ce8SMahesh Salgaonkar 		 * so that we can continue with fadump.
111a4e92ce8SMahesh Salgaonkar 		 */
112a4e92ce8SMahesh Salgaonkar 		return 1;
113a4e92ce8SMahesh Salgaonkar 	}
114a4e92ce8SMahesh Salgaonkar 
115a4e92ce8SMahesh Salgaonkar 	/*
116a4e92ce8SMahesh Salgaonkar 	 * So we now have successfully initialized cma area for fadump.
117a4e92ce8SMahesh Salgaonkar 	 */
118a4e92ce8SMahesh Salgaonkar 	pr_info("Initialized 0x%lx bytes cma area at %ldMB from 0x%lx "
119a4e92ce8SMahesh Salgaonkar 		"bytes of memory reserved for firmware-assisted dump\n",
120a4e92ce8SMahesh Salgaonkar 		cma_get_size(fadump_cma),
121a4e92ce8SMahesh Salgaonkar 		(unsigned long)cma_get_base(fadump_cma) >> 20,
122a4e92ce8SMahesh Salgaonkar 		fw_dump.reserve_dump_area_size);
123a4e92ce8SMahesh Salgaonkar 	return 1;
124a4e92ce8SMahesh Salgaonkar }
125a4e92ce8SMahesh Salgaonkar #else
126a4e92ce8SMahesh Salgaonkar static int __init fadump_cma_init(void) { return 1; }
127a4e92ce8SMahesh Salgaonkar #endif /* CONFIG_CMA */
128a4e92ce8SMahesh Salgaonkar 
129eb39c880SMahesh Salgaonkar /* Scan the Firmware Assisted dump configuration details. */
130f3512011SHari Bathini int __init early_init_dt_scan_fw_dump(unsigned long node, const char *uname,
131f3512011SHari Bathini 				      int depth, void *data)
132eb39c880SMahesh Salgaonkar {
13302c04e37SHari Bathini 	if (depth == 0) {
13402c04e37SHari Bathini 		early_init_dt_scan_reserved_ranges(node);
13502c04e37SHari Bathini 		return 0;
13602c04e37SHari Bathini 	}
13702c04e37SHari Bathini 
13841df5928SHari Bathini 	if (depth != 1)
139eb39c880SMahesh Salgaonkar 		return 0;
140eb39c880SMahesh Salgaonkar 
14141df5928SHari Bathini 	if (strcmp(uname, "rtas") == 0) {
142d3833a70SHari Bathini 		rtas_fadump_dt_scan(&fw_dump, node);
143eb39c880SMahesh Salgaonkar 		return 1;
144eb39c880SMahesh Salgaonkar 	}
145eb39c880SMahesh Salgaonkar 
14641df5928SHari Bathini 	if (strcmp(uname, "ibm,opal") == 0) {
14741df5928SHari Bathini 		opal_fadump_dt_scan(&fw_dump, node);
14841df5928SHari Bathini 		return 1;
14941df5928SHari Bathini 	}
15041df5928SHari Bathini 
15141df5928SHari Bathini 	return 0;
15241df5928SHari Bathini }
15341df5928SHari Bathini 
154eae0dfccSHari Bathini /*
155eae0dfccSHari Bathini  * If fadump is registered, check if the memory provided
1560db6896fSMahesh Salgaonkar  * falls within boot memory area and reserved memory area.
157eae0dfccSHari Bathini  */
158becd91d9SHari Bathini int is_fadump_memory_area(u64 addr, unsigned long size)
159eae0dfccSHari Bathini {
160becd91d9SHari Bathini 	u64 d_start, d_end;
1610db6896fSMahesh Salgaonkar 
162eae0dfccSHari Bathini 	if (!fw_dump.dump_registered)
163eae0dfccSHari Bathini 		return 0;
164eae0dfccSHari Bathini 
165becd91d9SHari Bathini 	if (!size)
166becd91d9SHari Bathini 		return 0;
167becd91d9SHari Bathini 
168becd91d9SHari Bathini 	d_start = fw_dump.reserve_dump_area_start;
169becd91d9SHari Bathini 	d_end = d_start + fw_dump.reserve_dump_area_size;
1700db6896fSMahesh Salgaonkar 	if (((addr + size) > d_start) && (addr <= d_end))
1710db6896fSMahesh Salgaonkar 		return 1;
1720db6896fSMahesh Salgaonkar 
1737dee93a9SHari Bathini 	return (addr <= fw_dump.boot_mem_top);
174eae0dfccSHari Bathini }
175eae0dfccSHari Bathini 
1766fcd6baaSNicholas Piggin int should_fadump_crash(void)
1776fcd6baaSNicholas Piggin {
1786fcd6baaSNicholas Piggin 	if (!fw_dump.dump_registered || !fw_dump.fadumphdr_addr)
1796fcd6baaSNicholas Piggin 		return 0;
1806fcd6baaSNicholas Piggin 	return 1;
1816fcd6baaSNicholas Piggin }
1826fcd6baaSNicholas Piggin 
1833ccc00a7SMahesh Salgaonkar int is_fadump_active(void)
1843ccc00a7SMahesh Salgaonkar {
1853ccc00a7SMahesh Salgaonkar 	return fw_dump.dump_active;
1863ccc00a7SMahesh Salgaonkar }
1873ccc00a7SMahesh Salgaonkar 
188a5a05b91SHari Bathini /*
189961cf26aSHari Bathini  * Returns true, if there are no holes in memory area between d_start to d_end,
190961cf26aSHari Bathini  * false otherwise.
191a5a05b91SHari Bathini  */
192961cf26aSHari Bathini static bool is_fadump_mem_area_contiguous(u64 d_start, u64 d_end)
193a5a05b91SHari Bathini {
194a5a05b91SHari Bathini 	struct memblock_region *reg;
195961cf26aSHari Bathini 	bool ret = false;
196961cf26aSHari Bathini 	u64 start, end;
197a5a05b91SHari Bathini 
198a5a05b91SHari Bathini 	for_each_memblock(memory, reg) {
199961cf26aSHari Bathini 		start = max_t(u64, d_start, reg->base);
200961cf26aSHari Bathini 		end = min_t(u64, d_end, (reg->base + reg->size));
201961cf26aSHari Bathini 		if (d_start < end) {
202961cf26aSHari Bathini 			/* Memory hole from d_start to start */
203961cf26aSHari Bathini 			if (start > d_start)
204a5a05b91SHari Bathini 				break;
205a5a05b91SHari Bathini 
206961cf26aSHari Bathini 			if (end == d_end) {
207961cf26aSHari Bathini 				ret = true;
208a5a05b91SHari Bathini 				break;
209a5a05b91SHari Bathini 			}
210a5a05b91SHari Bathini 
211961cf26aSHari Bathini 			d_start = end + 1;
212a5a05b91SHari Bathini 		}
213a5a05b91SHari Bathini 	}
214a5a05b91SHari Bathini 
215a5a05b91SHari Bathini 	return ret;
216a5a05b91SHari Bathini }
217a5a05b91SHari Bathini 
218f86593beSMahesh Salgaonkar /*
219961cf26aSHari Bathini  * Returns true, if there are no holes in boot memory area,
220961cf26aSHari Bathini  * false otherwise.
221961cf26aSHari Bathini  */
2227f0ad11dSHari Bathini bool is_fadump_boot_mem_contiguous(void)
223961cf26aSHari Bathini {
2247dee93a9SHari Bathini 	unsigned long d_start, d_end;
2257dee93a9SHari Bathini 	bool ret = false;
2267dee93a9SHari Bathini 	int i;
2277dee93a9SHari Bathini 
2287dee93a9SHari Bathini 	for (i = 0; i < fw_dump.boot_mem_regs_cnt; i++) {
2297dee93a9SHari Bathini 		d_start = fw_dump.boot_mem_addr[i];
2307dee93a9SHari Bathini 		d_end   = d_start + fw_dump.boot_mem_sz[i];
2317dee93a9SHari Bathini 
2327dee93a9SHari Bathini 		ret = is_fadump_mem_area_contiguous(d_start, d_end);
2337dee93a9SHari Bathini 		if (!ret)
2347dee93a9SHari Bathini 			break;
2357dee93a9SHari Bathini 	}
2367dee93a9SHari Bathini 
2377dee93a9SHari Bathini 	return ret;
238961cf26aSHari Bathini }
239961cf26aSHari Bathini 
240961cf26aSHari Bathini /*
241f86593beSMahesh Salgaonkar  * Returns true, if there are no holes in reserved memory area,
242f86593beSMahesh Salgaonkar  * false otherwise.
243f86593beSMahesh Salgaonkar  */
2447f0ad11dSHari Bathini bool is_fadump_reserved_mem_contiguous(void)
245f86593beSMahesh Salgaonkar {
246961cf26aSHari Bathini 	u64 d_start, d_end;
247f86593beSMahesh Salgaonkar 
248961cf26aSHari Bathini 	d_start	= fw_dump.reserve_dump_area_start;
249961cf26aSHari Bathini 	d_end	= d_start + fw_dump.reserve_dump_area_size;
250961cf26aSHari Bathini 	return is_fadump_mem_area_contiguous(d_start, d_end);
251f86593beSMahesh Salgaonkar }
252f86593beSMahesh Salgaonkar 
2533ccc00a7SMahesh Salgaonkar /* Print firmware assisted dump configurations for debugging purpose. */
2543ccc00a7SMahesh Salgaonkar static void fadump_show_config(void)
2553ccc00a7SMahesh Salgaonkar {
2567dee93a9SHari Bathini 	int i;
2577dee93a9SHari Bathini 
2583ccc00a7SMahesh Salgaonkar 	pr_debug("Support for firmware-assisted dump (fadump): %s\n",
2593ccc00a7SMahesh Salgaonkar 			(fw_dump.fadump_supported ? "present" : "no support"));
2603ccc00a7SMahesh Salgaonkar 
2613ccc00a7SMahesh Salgaonkar 	if (!fw_dump.fadump_supported)
2623ccc00a7SMahesh Salgaonkar 		return;
2633ccc00a7SMahesh Salgaonkar 
2643ccc00a7SMahesh Salgaonkar 	pr_debug("Fadump enabled    : %s\n",
2653ccc00a7SMahesh Salgaonkar 				(fw_dump.fadump_enabled ? "yes" : "no"));
2663ccc00a7SMahesh Salgaonkar 	pr_debug("Dump Active       : %s\n",
2673ccc00a7SMahesh Salgaonkar 				(fw_dump.dump_active ? "yes" : "no"));
2683ccc00a7SMahesh Salgaonkar 	pr_debug("Dump section sizes:\n");
2693ccc00a7SMahesh Salgaonkar 	pr_debug("    CPU state data size: %lx\n", fw_dump.cpu_state_data_size);
2703ccc00a7SMahesh Salgaonkar 	pr_debug("    HPTE region size   : %lx\n", fw_dump.hpte_region_size);
2713ccc00a7SMahesh Salgaonkar 	pr_debug("    Boot memory size   : %lx\n", fw_dump.boot_memory_size);
2727dee93a9SHari Bathini 	pr_debug("    Boot memory top    : %llx\n", fw_dump.boot_mem_top);
2737dee93a9SHari Bathini 	pr_debug("Boot memory regions cnt: %llx\n", fw_dump.boot_mem_regs_cnt);
2747dee93a9SHari Bathini 	for (i = 0; i < fw_dump.boot_mem_regs_cnt; i++) {
2757dee93a9SHari Bathini 		pr_debug("[%03d] base = %llx, size = %llx\n", i,
2767dee93a9SHari Bathini 			 fw_dump.boot_mem_addr[i], fw_dump.boot_mem_sz[i]);
2777dee93a9SHari Bathini 	}
2783ccc00a7SMahesh Salgaonkar }
2793ccc00a7SMahesh Salgaonkar 
280eb39c880SMahesh Salgaonkar /**
281eb39c880SMahesh Salgaonkar  * fadump_calculate_reserve_size(): reserve variable boot area 5% of System RAM
282eb39c880SMahesh Salgaonkar  *
283eb39c880SMahesh Salgaonkar  * Function to find the largest memory size we need to reserve during early
284eb39c880SMahesh Salgaonkar  * boot process. This will be the size of the memory that is required for a
285eb39c880SMahesh Salgaonkar  * kernel to boot successfully.
286eb39c880SMahesh Salgaonkar  *
287eb39c880SMahesh Salgaonkar  * This function has been taken from phyp-assisted dump feature implementation.
288eb39c880SMahesh Salgaonkar  *
289eb39c880SMahesh Salgaonkar  * returns larger of 256MB or 5% rounded down to multiples of 256MB.
290eb39c880SMahesh Salgaonkar  *
291eb39c880SMahesh Salgaonkar  * TODO: Come up with better approach to find out more accurate memory size
292eb39c880SMahesh Salgaonkar  * that is required for a kernel to boot successfully.
293eb39c880SMahesh Salgaonkar  *
294eb39c880SMahesh Salgaonkar  */
2957b1b3b48SHari Bathini static inline u64 fadump_calculate_reserve_size(void)
296eb39c880SMahesh Salgaonkar {
2977b1b3b48SHari Bathini 	u64 base, size, bootmem_min;
29811550dc0SHari Bathini 	int ret;
299eb39c880SMahesh Salgaonkar 
30081d9eca5SHari Bathini 	if (fw_dump.reserve_bootvar)
30181d9eca5SHari Bathini 		pr_warn("'fadump_reserve_mem=' parameter is deprecated in favor of 'crashkernel=' parameter.\n");
30281d9eca5SHari Bathini 
303eb39c880SMahesh Salgaonkar 	/*
30411550dc0SHari Bathini 	 * Check if the size is specified through crashkernel= cmdline
305e7467dc6SHari Bathini 	 * option. If yes, then use that but ignore base as fadump reserves
306e7467dc6SHari Bathini 	 * memory at a predefined offset.
307eb39c880SMahesh Salgaonkar 	 */
30811550dc0SHari Bathini 	ret = parse_crashkernel(boot_command_line, memblock_phys_mem_size(),
30911550dc0SHari Bathini 				&size, &base);
31011550dc0SHari Bathini 	if (ret == 0 && size > 0) {
31148a316e3SHari Bathini 		unsigned long max_size;
31248a316e3SHari Bathini 
31381d9eca5SHari Bathini 		if (fw_dump.reserve_bootvar)
31481d9eca5SHari Bathini 			pr_info("Using 'crashkernel=' parameter for memory reservation.\n");
31581d9eca5SHari Bathini 
31611550dc0SHari Bathini 		fw_dump.reserve_bootvar = (unsigned long)size;
31748a316e3SHari Bathini 
31848a316e3SHari Bathini 		/*
31948a316e3SHari Bathini 		 * Adjust if the boot memory size specified is above
32048a316e3SHari Bathini 		 * the upper limit.
32148a316e3SHari Bathini 		 */
32248a316e3SHari Bathini 		max_size = memblock_phys_mem_size() / MAX_BOOT_MEM_RATIO;
32348a316e3SHari Bathini 		if (fw_dump.reserve_bootvar > max_size) {
32448a316e3SHari Bathini 			fw_dump.reserve_bootvar = max_size;
32548a316e3SHari Bathini 			pr_info("Adjusted boot memory size to %luMB\n",
32648a316e3SHari Bathini 				(fw_dump.reserve_bootvar >> 20));
32748a316e3SHari Bathini 		}
32848a316e3SHari Bathini 
329eb39c880SMahesh Salgaonkar 		return fw_dump.reserve_bootvar;
33081d9eca5SHari Bathini 	} else if (fw_dump.reserve_bootvar) {
33181d9eca5SHari Bathini 		/*
33281d9eca5SHari Bathini 		 * 'fadump_reserve_mem=' is being used to reserve memory
33381d9eca5SHari Bathini 		 * for firmware-assisted dump.
33481d9eca5SHari Bathini 		 */
33581d9eca5SHari Bathini 		return fw_dump.reserve_bootvar;
33611550dc0SHari Bathini 	}
337eb39c880SMahesh Salgaonkar 
338eb39c880SMahesh Salgaonkar 	/* divide by 20 to get 5% of value */
33948a316e3SHari Bathini 	size = memblock_phys_mem_size() / 20;
340eb39c880SMahesh Salgaonkar 
341eb39c880SMahesh Salgaonkar 	/* round it down in multiples of 256 */
342eb39c880SMahesh Salgaonkar 	size = size & ~0x0FFFFFFFUL;
343eb39c880SMahesh Salgaonkar 
344eb39c880SMahesh Salgaonkar 	/* Truncate to memory_limit. We don't want to over reserve the memory.*/
345eb39c880SMahesh Salgaonkar 	if (memory_limit && size > memory_limit)
346eb39c880SMahesh Salgaonkar 		size = memory_limit;
347eb39c880SMahesh Salgaonkar 
3487b1b3b48SHari Bathini 	bootmem_min = fw_dump.ops->fadump_get_bootmem_min();
3497b1b3b48SHari Bathini 	return (size > bootmem_min ? size : bootmem_min);
350eb39c880SMahesh Salgaonkar }
351eb39c880SMahesh Salgaonkar 
352eb39c880SMahesh Salgaonkar /*
353eb39c880SMahesh Salgaonkar  * Calculate the total memory size required to be reserved for
354eb39c880SMahesh Salgaonkar  * firmware-assisted dump registration.
355eb39c880SMahesh Salgaonkar  */
356eb39c880SMahesh Salgaonkar static unsigned long get_fadump_area_size(void)
357eb39c880SMahesh Salgaonkar {
358eb39c880SMahesh Salgaonkar 	unsigned long size = 0;
359eb39c880SMahesh Salgaonkar 
360eb39c880SMahesh Salgaonkar 	size += fw_dump.cpu_state_data_size;
361eb39c880SMahesh Salgaonkar 	size += fw_dump.hpte_region_size;
362eb39c880SMahesh Salgaonkar 	size += fw_dump.boot_memory_size;
3632df173d9SMahesh Salgaonkar 	size += sizeof(struct fadump_crash_info_header);
3642df173d9SMahesh Salgaonkar 	size += sizeof(struct elfhdr); /* ELF core header.*/
365ebaeb5aeSMahesh Salgaonkar 	size += sizeof(struct elf_phdr); /* place holder for cpu notes */
3662df173d9SMahesh Salgaonkar 	/* Program headers for crash memory regions. */
3672df173d9SMahesh Salgaonkar 	size += sizeof(struct elf_phdr) * (memblock_num_regions(memory) + 2);
368eb39c880SMahesh Salgaonkar 
369eb39c880SMahesh Salgaonkar 	size = PAGE_ALIGN(size);
370742a265aSHari Bathini 
371742a265aSHari Bathini 	/* This is to hold kernel metadata on platforms that support it */
372742a265aSHari Bathini 	size += (fw_dump.ops->fadump_get_metadata_size ?
373742a265aSHari Bathini 		 fw_dump.ops->fadump_get_metadata_size() : 0);
374eb39c880SMahesh Salgaonkar 	return size;
375eb39c880SMahesh Salgaonkar }
376eb39c880SMahesh Salgaonkar 
3777dee93a9SHari Bathini static int __init add_boot_mem_region(unsigned long rstart,
3787dee93a9SHari Bathini 				      unsigned long rsize)
3797dee93a9SHari Bathini {
3807dee93a9SHari Bathini 	int i = fw_dump.boot_mem_regs_cnt++;
3817dee93a9SHari Bathini 
3827dee93a9SHari Bathini 	if (fw_dump.boot_mem_regs_cnt > FADUMP_MAX_MEM_REGS) {
3837dee93a9SHari Bathini 		fw_dump.boot_mem_regs_cnt = FADUMP_MAX_MEM_REGS;
3847dee93a9SHari Bathini 		return 0;
3857dee93a9SHari Bathini 	}
3867dee93a9SHari Bathini 
3877dee93a9SHari Bathini 	pr_debug("Added boot memory range[%d] [%#016lx-%#016lx)\n",
3887dee93a9SHari Bathini 		 i, rstart, (rstart + rsize));
3897dee93a9SHari Bathini 	fw_dump.boot_mem_addr[i] = rstart;
3907dee93a9SHari Bathini 	fw_dump.boot_mem_sz[i] = rsize;
3917dee93a9SHari Bathini 	return 1;
3927dee93a9SHari Bathini }
3937dee93a9SHari Bathini 
3947dee93a9SHari Bathini /*
3957dee93a9SHari Bathini  * Firmware usually has a hard limit on the data it can copy per region.
3967dee93a9SHari Bathini  * Honour that by splitting a memory range into multiple regions.
3977dee93a9SHari Bathini  */
3987dee93a9SHari Bathini static int __init add_boot_mem_regions(unsigned long mstart,
3997dee93a9SHari Bathini 				       unsigned long msize)
4007dee93a9SHari Bathini {
4017dee93a9SHari Bathini 	unsigned long rstart, rsize, max_size;
4027dee93a9SHari Bathini 	int ret = 1;
4037dee93a9SHari Bathini 
4047dee93a9SHari Bathini 	rstart = mstart;
4057dee93a9SHari Bathini 	max_size = fw_dump.max_copy_size ? fw_dump.max_copy_size : msize;
4067dee93a9SHari Bathini 	while (msize) {
4077dee93a9SHari Bathini 		if (msize > max_size)
4087dee93a9SHari Bathini 			rsize = max_size;
4097dee93a9SHari Bathini 		else
4107dee93a9SHari Bathini 			rsize = msize;
4117dee93a9SHari Bathini 
4127dee93a9SHari Bathini 		ret = add_boot_mem_region(rstart, rsize);
4137dee93a9SHari Bathini 		if (!ret)
4147dee93a9SHari Bathini 			break;
4157dee93a9SHari Bathini 
4167dee93a9SHari Bathini 		msize -= rsize;
4177dee93a9SHari Bathini 		rstart += rsize;
4187dee93a9SHari Bathini 	}
4197dee93a9SHari Bathini 
4207dee93a9SHari Bathini 	return ret;
4217dee93a9SHari Bathini }
4227dee93a9SHari Bathini 
4237dee93a9SHari Bathini static int __init fadump_get_boot_mem_regions(void)
4247dee93a9SHari Bathini {
4257dee93a9SHari Bathini 	unsigned long base, size, cur_size, hole_size, last_end;
4267dee93a9SHari Bathini 	unsigned long mem_size = fw_dump.boot_memory_size;
4277dee93a9SHari Bathini 	struct memblock_region *reg;
4287dee93a9SHari Bathini 	int ret = 1;
4297dee93a9SHari Bathini 
4307dee93a9SHari Bathini 	fw_dump.boot_mem_regs_cnt = 0;
4317dee93a9SHari Bathini 
4327dee93a9SHari Bathini 	last_end = 0;
4337dee93a9SHari Bathini 	hole_size = 0;
4347dee93a9SHari Bathini 	cur_size = 0;
4357dee93a9SHari Bathini 	for_each_memblock(memory, reg) {
4367dee93a9SHari Bathini 		base = reg->base;
4377dee93a9SHari Bathini 		size = reg->size;
4387dee93a9SHari Bathini 		hole_size += (base - last_end);
4397dee93a9SHari Bathini 
4407dee93a9SHari Bathini 		if ((cur_size + size) >= mem_size) {
4417dee93a9SHari Bathini 			size = (mem_size - cur_size);
4427dee93a9SHari Bathini 			ret = add_boot_mem_regions(base, size);
4437dee93a9SHari Bathini 			break;
4447dee93a9SHari Bathini 		}
4457dee93a9SHari Bathini 
4467dee93a9SHari Bathini 		mem_size -= size;
4477dee93a9SHari Bathini 		cur_size += size;
4487dee93a9SHari Bathini 		ret = add_boot_mem_regions(base, size);
4497dee93a9SHari Bathini 		if (!ret)
4507dee93a9SHari Bathini 			break;
4517dee93a9SHari Bathini 
4527dee93a9SHari Bathini 		last_end = base + size;
4537dee93a9SHari Bathini 	}
4547dee93a9SHari Bathini 	fw_dump.boot_mem_top = PAGE_ALIGN(fw_dump.boot_memory_size + hole_size);
4557dee93a9SHari Bathini 
4567dee93a9SHari Bathini 	return ret;
4577dee93a9SHari Bathini }
4587dee93a9SHari Bathini 
459140777a3SHari Bathini /*
460140777a3SHari Bathini  * Returns true, if the given range overlaps with reserved memory ranges
461140777a3SHari Bathini  * starting at idx. Also, updates idx to index of overlapping memory range
462140777a3SHari Bathini  * with the given memory range.
463140777a3SHari Bathini  * False, otherwise.
464140777a3SHari Bathini  */
465140777a3SHari Bathini static bool overlaps_reserved_ranges(u64 base, u64 end, int *idx)
466140777a3SHari Bathini {
467140777a3SHari Bathini 	bool ret = false;
468140777a3SHari Bathini 	int i;
469140777a3SHari Bathini 
470140777a3SHari Bathini 	for (i = *idx; i < reserved_mrange_info.mem_range_cnt; i++) {
471140777a3SHari Bathini 		u64 rbase = reserved_mrange_info.mem_ranges[i].base;
472140777a3SHari Bathini 		u64 rend = rbase + reserved_mrange_info.mem_ranges[i].size;
473140777a3SHari Bathini 
474140777a3SHari Bathini 		if (end <= rbase)
475140777a3SHari Bathini 			break;
476140777a3SHari Bathini 
477140777a3SHari Bathini 		if ((end > rbase) &&  (base < rend)) {
478140777a3SHari Bathini 			*idx = i;
479140777a3SHari Bathini 			ret = true;
480140777a3SHari Bathini 			break;
481140777a3SHari Bathini 		}
482140777a3SHari Bathini 	}
483140777a3SHari Bathini 
484140777a3SHari Bathini 	return ret;
485140777a3SHari Bathini }
486140777a3SHari Bathini 
487140777a3SHari Bathini /*
488140777a3SHari Bathini  * Locate a suitable memory area to reserve memory for FADump. While at it,
489140777a3SHari Bathini  * lookup reserved-ranges & avoid overlap with them, as they are used by F/W.
490140777a3SHari Bathini  */
491140777a3SHari Bathini static u64 __init fadump_locate_reserve_mem(u64 base, u64 size)
492140777a3SHari Bathini {
493140777a3SHari Bathini 	struct fadump_memory_range *mrngs;
494140777a3SHari Bathini 	phys_addr_t mstart, mend;
495140777a3SHari Bathini 	int idx = 0;
496140777a3SHari Bathini 	u64 i, ret = 0;
497140777a3SHari Bathini 
498140777a3SHari Bathini 	mrngs = reserved_mrange_info.mem_ranges;
499140777a3SHari Bathini 	for_each_free_mem_range(i, NUMA_NO_NODE, MEMBLOCK_NONE,
500140777a3SHari Bathini 				&mstart, &mend, NULL) {
501140777a3SHari Bathini 		pr_debug("%llu) mstart: %llx, mend: %llx, base: %llx\n",
502140777a3SHari Bathini 			 i, mstart, mend, base);
503140777a3SHari Bathini 
504140777a3SHari Bathini 		if (mstart > base)
505140777a3SHari Bathini 			base = PAGE_ALIGN(mstart);
506140777a3SHari Bathini 
507140777a3SHari Bathini 		while ((mend > base) && ((mend - base) >= size)) {
508140777a3SHari Bathini 			if (!overlaps_reserved_ranges(base, base+size, &idx)) {
509140777a3SHari Bathini 				ret = base;
510140777a3SHari Bathini 				goto out;
511140777a3SHari Bathini 			}
512140777a3SHari Bathini 
513140777a3SHari Bathini 			base = mrngs[idx].base + mrngs[idx].size;
514140777a3SHari Bathini 			base = PAGE_ALIGN(base);
515140777a3SHari Bathini 		}
516140777a3SHari Bathini 	}
517140777a3SHari Bathini 
518140777a3SHari Bathini out:
519140777a3SHari Bathini 	return ret;
520140777a3SHari Bathini }
521140777a3SHari Bathini 
522eb39c880SMahesh Salgaonkar int __init fadump_reserve_mem(void)
523eb39c880SMahesh Salgaonkar {
524140777a3SHari Bathini 	u64 base, size, mem_boundary, bootmem_min;
5256abec12cSHari Bathini 	int ret = 1;
526eb39c880SMahesh Salgaonkar 
527eb39c880SMahesh Salgaonkar 	if (!fw_dump.fadump_enabled)
528eb39c880SMahesh Salgaonkar 		return 0;
529eb39c880SMahesh Salgaonkar 
530eb39c880SMahesh Salgaonkar 	if (!fw_dump.fadump_supported) {
5316abec12cSHari Bathini 		pr_info("Firmware-Assisted Dump is not supported on this hardware\n");
5326abec12cSHari Bathini 		goto error_out;
533eb39c880SMahesh Salgaonkar 	}
534742a265aSHari Bathini 
5353ccc00a7SMahesh Salgaonkar 	/*
5363ccc00a7SMahesh Salgaonkar 	 * Initialize boot memory size
5373ccc00a7SMahesh Salgaonkar 	 * If dump is active then we have already calculated the size during
5383ccc00a7SMahesh Salgaonkar 	 * first kernel.
5393ccc00a7SMahesh Salgaonkar 	 */
540f3512011SHari Bathini 	if (!fw_dump.dump_active) {
5416abec12cSHari Bathini 		fw_dump.boot_memory_size =
5426abec12cSHari Bathini 			PAGE_ALIGN(fadump_calculate_reserve_size());
543a4e92ce8SMahesh Salgaonkar #ifdef CONFIG_CMA
544579ca1a2SHari Bathini 		if (!fw_dump.nocma) {
545a4e92ce8SMahesh Salgaonkar 			fw_dump.boot_memory_size =
546140777a3SHari Bathini 				ALIGN(fw_dump.boot_memory_size,
547140777a3SHari Bathini 				      FADUMP_CMA_ALIGNMENT);
548579ca1a2SHari Bathini 		}
549a4e92ce8SMahesh Salgaonkar #endif
5507b1b3b48SHari Bathini 
5517b1b3b48SHari Bathini 		bootmem_min = fw_dump.ops->fadump_get_bootmem_min();
5527b1b3b48SHari Bathini 		if (fw_dump.boot_memory_size < bootmem_min) {
5537b1b3b48SHari Bathini 			pr_err("Can't enable fadump with boot memory size (0x%lx) less than 0x%llx\n",
5547b1b3b48SHari Bathini 			       fw_dump.boot_memory_size, bootmem_min);
5557b1b3b48SHari Bathini 			goto error_out;
5567b1b3b48SHari Bathini 		}
5577dee93a9SHari Bathini 
5587dee93a9SHari Bathini 		if (!fadump_get_boot_mem_regions()) {
5597dee93a9SHari Bathini 			pr_err("Too many holes in boot memory area to enable fadump\n");
5607dee93a9SHari Bathini 			goto error_out;
5617dee93a9SHari Bathini 		}
562a4e92ce8SMahesh Salgaonkar 	}
563eb39c880SMahesh Salgaonkar 
564eb39c880SMahesh Salgaonkar 	/*
565eb39c880SMahesh Salgaonkar 	 * Calculate the memory boundary.
566eb39c880SMahesh Salgaonkar 	 * If memory_limit is less than actual memory boundary then reserve
567eb39c880SMahesh Salgaonkar 	 * the memory for fadump beyond the memory_limit and adjust the
568eb39c880SMahesh Salgaonkar 	 * memory_limit accordingly, so that the running kernel can run with
569eb39c880SMahesh Salgaonkar 	 * specified memory_limit.
570eb39c880SMahesh Salgaonkar 	 */
571eb39c880SMahesh Salgaonkar 	if (memory_limit && memory_limit < memblock_end_of_DRAM()) {
572eb39c880SMahesh Salgaonkar 		size = get_fadump_area_size();
573eb39c880SMahesh Salgaonkar 		if ((memory_limit + size) < memblock_end_of_DRAM())
574eb39c880SMahesh Salgaonkar 			memory_limit += size;
575eb39c880SMahesh Salgaonkar 		else
576eb39c880SMahesh Salgaonkar 			memory_limit = memblock_end_of_DRAM();
577eb39c880SMahesh Salgaonkar 		printk(KERN_INFO "Adjusted memory_limit for firmware-assisted"
578a84fcd46SSuzuki Poulose 				" dump, now %#016llx\n", memory_limit);
579eb39c880SMahesh Salgaonkar 	}
580eb39c880SMahesh Salgaonkar 	if (memory_limit)
5816abec12cSHari Bathini 		mem_boundary = memory_limit;
582eb39c880SMahesh Salgaonkar 	else
5836abec12cSHari Bathini 		mem_boundary = memblock_end_of_DRAM();
584eb39c880SMahesh Salgaonkar 
5857dee93a9SHari Bathini 	base = fw_dump.boot_mem_top;
5868255da95SHari Bathini 	size = get_fadump_area_size();
5878255da95SHari Bathini 	fw_dump.reserve_dump_area_size = size;
588eb39c880SMahesh Salgaonkar 	if (fw_dump.dump_active) {
589b71a693dSMahesh Salgaonkar 		pr_info("Firmware-assisted dump is active.\n");
590b71a693dSMahesh Salgaonkar 
59185975387SHari Bathini #ifdef CONFIG_HUGETLB_PAGE
59285975387SHari Bathini 		/*
59385975387SHari Bathini 		 * FADump capture kernel doesn't care much about hugepages.
59485975387SHari Bathini 		 * In fact, handling hugepages in capture kernel is asking for
59585975387SHari Bathini 		 * trouble. So, disable HugeTLB support when fadump is active.
59685975387SHari Bathini 		 */
59785975387SHari Bathini 		hugetlb_disabled = true;
59885975387SHari Bathini #endif
599eb39c880SMahesh Salgaonkar 		/*
600eb39c880SMahesh Salgaonkar 		 * If last boot has crashed then reserve all the memory
601b2a815a5SHari Bathini 		 * above boot memory size so that we don't touch it until
602eb39c880SMahesh Salgaonkar 		 * dump is written to disk by userspace tool. This memory
603b2a815a5SHari Bathini 		 * can be released for general use by invalidating fadump.
604eb39c880SMahesh Salgaonkar 		 */
605b2a815a5SHari Bathini 		fadump_reserve_crash_area(base);
6062df173d9SMahesh Salgaonkar 
607f3512011SHari Bathini 		pr_debug("fadumphdr_addr = %#016lx\n", fw_dump.fadumphdr_addr);
608f3512011SHari Bathini 		pr_debug("Reserve dump area start address: 0x%lx\n",
609f3512011SHari Bathini 			 fw_dump.reserve_dump_area_start);
6108255da95SHari Bathini 	} else {
6118255da95SHari Bathini 		/*
612f6e6bedbSHari Bathini 		 * Reserve memory at an offset closer to bottom of the RAM to
613579ca1a2SHari Bathini 		 * minimize the impact of memory hot-remove operation.
614f6e6bedbSHari Bathini 		 */
615140777a3SHari Bathini 		base = fadump_locate_reserve_mem(base, size);
616f6e6bedbSHari Bathini 
6179a2921e5SHari Bathini 		if (!base || (base + size > mem_boundary)) {
618742a265aSHari Bathini 			pr_err("Failed to find memory chunk for reservation!\n");
619742a265aSHari Bathini 			goto error_out;
620742a265aSHari Bathini 		}
621742a265aSHari Bathini 		fw_dump.reserve_dump_area_start = base;
622742a265aSHari Bathini 
623742a265aSHari Bathini 		/*
624742a265aSHari Bathini 		 * Calculate the kernel metadata address and register it with
625742a265aSHari Bathini 		 * f/w if the platform supports.
626742a265aSHari Bathini 		 */
627742a265aSHari Bathini 		if (fw_dump.ops->fadump_setup_metadata &&
628742a265aSHari Bathini 		    (fw_dump.ops->fadump_setup_metadata(&fw_dump) < 0))
629742a265aSHari Bathini 			goto error_out;
630742a265aSHari Bathini 
631742a265aSHari Bathini 		if (memblock_reserve(base, size)) {
6326abec12cSHari Bathini 			pr_err("Failed to reserve memory!\n");
6336abec12cSHari Bathini 			goto error_out;
6346abec12cSHari Bathini 		}
6356abec12cSHari Bathini 
6366abec12cSHari Bathini 		pr_info("Reserved %lldMB of memory at %#016llx (System RAM: %lldMB)\n",
6376abec12cSHari Bathini 			(size >> 20), base, (memblock_phys_mem_size() >> 20));
638f6e6bedbSHari Bathini 
6396abec12cSHari Bathini 		ret = fadump_cma_init();
640a4e92ce8SMahesh Salgaonkar 	}
6416abec12cSHari Bathini 
6426abec12cSHari Bathini 	return ret;
6436abec12cSHari Bathini error_out:
6446abec12cSHari Bathini 	fw_dump.fadump_enabled = 0;
6456abec12cSHari Bathini 	return 0;
646eb39c880SMahesh Salgaonkar }
647eb39c880SMahesh Salgaonkar 
648eb39c880SMahesh Salgaonkar /* Look for fadump= cmdline option. */
649eb39c880SMahesh Salgaonkar static int __init early_fadump_param(char *p)
650eb39c880SMahesh Salgaonkar {
651eb39c880SMahesh Salgaonkar 	if (!p)
652eb39c880SMahesh Salgaonkar 		return 1;
653eb39c880SMahesh Salgaonkar 
654eb39c880SMahesh Salgaonkar 	if (strncmp(p, "on", 2) == 0)
655eb39c880SMahesh Salgaonkar 		fw_dump.fadump_enabled = 1;
656eb39c880SMahesh Salgaonkar 	else if (strncmp(p, "off", 3) == 0)
657eb39c880SMahesh Salgaonkar 		fw_dump.fadump_enabled = 0;
658a4e92ce8SMahesh Salgaonkar 	else if (strncmp(p, "nocma", 5) == 0) {
659a4e92ce8SMahesh Salgaonkar 		fw_dump.fadump_enabled = 1;
660a4e92ce8SMahesh Salgaonkar 		fw_dump.nocma = 1;
661a4e92ce8SMahesh Salgaonkar 	}
662eb39c880SMahesh Salgaonkar 
663eb39c880SMahesh Salgaonkar 	return 0;
664eb39c880SMahesh Salgaonkar }
665eb39c880SMahesh Salgaonkar early_param("fadump", early_fadump_param);
666eb39c880SMahesh Salgaonkar 
66781d9eca5SHari Bathini /*
66881d9eca5SHari Bathini  * Look for fadump_reserve_mem= cmdline option
66981d9eca5SHari Bathini  * TODO: Remove references to 'fadump_reserve_mem=' parameter,
67081d9eca5SHari Bathini  *       the sooner 'crashkernel=' parameter is accustomed to.
67181d9eca5SHari Bathini  */
67281d9eca5SHari Bathini static int __init early_fadump_reserve_mem(char *p)
67381d9eca5SHari Bathini {
67481d9eca5SHari Bathini 	if (p)
67581d9eca5SHari Bathini 		fw_dump.reserve_bootvar = memparse(p, &p);
67681d9eca5SHari Bathini 	return 0;
67781d9eca5SHari Bathini }
67881d9eca5SHari Bathini early_param("fadump_reserve_mem", early_fadump_reserve_mem);
67981d9eca5SHari Bathini 
680ebaeb5aeSMahesh Salgaonkar void crash_fadump(struct pt_regs *regs, const char *str)
681ebaeb5aeSMahesh Salgaonkar {
682ba608c4fSSourabh Jain 	unsigned int msecs;
683ebaeb5aeSMahesh Salgaonkar 	struct fadump_crash_info_header *fdh = NULL;
684f2a5e8f0SMahesh Salgaonkar 	int old_cpu, this_cpu;
685ba608c4fSSourabh Jain 	/* Do not include first CPU */
686ba608c4fSSourabh Jain 	unsigned int ncpus = num_online_cpus() - 1;
687ebaeb5aeSMahesh Salgaonkar 
6886fcd6baaSNicholas Piggin 	if (!should_fadump_crash())
689ebaeb5aeSMahesh Salgaonkar 		return;
690ebaeb5aeSMahesh Salgaonkar 
691f2a5e8f0SMahesh Salgaonkar 	/*
692f2a5e8f0SMahesh Salgaonkar 	 * old_cpu == -1 means this is the first CPU which has come here,
693f2a5e8f0SMahesh Salgaonkar 	 * go ahead and trigger fadump.
694f2a5e8f0SMahesh Salgaonkar 	 *
695f2a5e8f0SMahesh Salgaonkar 	 * old_cpu != -1 means some other CPU has already on it's way
696f2a5e8f0SMahesh Salgaonkar 	 * to trigger fadump, just keep looping here.
697f2a5e8f0SMahesh Salgaonkar 	 */
698f2a5e8f0SMahesh Salgaonkar 	this_cpu = smp_processor_id();
699f2a5e8f0SMahesh Salgaonkar 	old_cpu = cmpxchg(&crashing_cpu, -1, this_cpu);
700f2a5e8f0SMahesh Salgaonkar 
701f2a5e8f0SMahesh Salgaonkar 	if (old_cpu != -1) {
702ba608c4fSSourabh Jain 		atomic_inc(&cpus_in_fadump);
703ba608c4fSSourabh Jain 
704f2a5e8f0SMahesh Salgaonkar 		/*
705f2a5e8f0SMahesh Salgaonkar 		 * We can't loop here indefinitely. Wait as long as fadump
706f2a5e8f0SMahesh Salgaonkar 		 * is in force. If we race with fadump un-registration this
707f2a5e8f0SMahesh Salgaonkar 		 * loop will break and then we go down to normal panic path
708f2a5e8f0SMahesh Salgaonkar 		 * and reboot. If fadump is in force the first crashing
709f2a5e8f0SMahesh Salgaonkar 		 * cpu will definitely trigger fadump.
710f2a5e8f0SMahesh Salgaonkar 		 */
711f2a5e8f0SMahesh Salgaonkar 		while (fw_dump.dump_registered)
712f2a5e8f0SMahesh Salgaonkar 			cpu_relax();
713f2a5e8f0SMahesh Salgaonkar 		return;
714f2a5e8f0SMahesh Salgaonkar 	}
715f2a5e8f0SMahesh Salgaonkar 
716ebaeb5aeSMahesh Salgaonkar 	fdh = __va(fw_dump.fadumphdr_addr);
717ebaeb5aeSMahesh Salgaonkar 	fdh->crashing_cpu = crashing_cpu;
718ebaeb5aeSMahesh Salgaonkar 	crash_save_vmcoreinfo();
719ebaeb5aeSMahesh Salgaonkar 
720ebaeb5aeSMahesh Salgaonkar 	if (regs)
721ebaeb5aeSMahesh Salgaonkar 		fdh->regs = *regs;
722ebaeb5aeSMahesh Salgaonkar 	else
723ebaeb5aeSMahesh Salgaonkar 		ppc_save_regs(&fdh->regs);
724ebaeb5aeSMahesh Salgaonkar 
725a0512164SRasmus Villemoes 	fdh->online_mask = *cpu_online_mask;
726ebaeb5aeSMahesh Salgaonkar 
727ba608c4fSSourabh Jain 	/*
728ba608c4fSSourabh Jain 	 * If we came in via system reset, wait a while for the secondary
729ba608c4fSSourabh Jain 	 * CPUs to enter.
730ba608c4fSSourabh Jain 	 */
731ba608c4fSSourabh Jain 	if (TRAP(&(fdh->regs)) == 0x100) {
732ba608c4fSSourabh Jain 		msecs = CRASH_TIMEOUT;
733ba608c4fSSourabh Jain 		while ((atomic_read(&cpus_in_fadump) < ncpus) && (--msecs > 0))
734ba608c4fSSourabh Jain 			mdelay(1);
735ba608c4fSSourabh Jain 	}
736ba608c4fSSourabh Jain 
73741a65d16SHari Bathini 	fw_dump.ops->fadump_trigger(fdh, str);
738ebaeb5aeSMahesh Salgaonkar }
739ebaeb5aeSMahesh Salgaonkar 
7407f0ad11dSHari Bathini u32 *fadump_regs_to_elf_notes(u32 *buf, struct pt_regs *regs)
741ebaeb5aeSMahesh Salgaonkar {
742ebaeb5aeSMahesh Salgaonkar 	struct elf_prstatus prstatus;
743ebaeb5aeSMahesh Salgaonkar 
744ebaeb5aeSMahesh Salgaonkar 	memset(&prstatus, 0, sizeof(prstatus));
745ebaeb5aeSMahesh Salgaonkar 	/*
746ebaeb5aeSMahesh Salgaonkar 	 * FIXME: How do i get PID? Do I really need it?
747ebaeb5aeSMahesh Salgaonkar 	 * prstatus.pr_pid = ????
748ebaeb5aeSMahesh Salgaonkar 	 */
749ebaeb5aeSMahesh Salgaonkar 	elf_core_copy_kernel_regs(&prstatus.pr_reg, regs);
75022bd0177SHari Bathini 	buf = append_elf_note(buf, CRASH_CORE_NOTE_NAME, NT_PRSTATUS,
751ebaeb5aeSMahesh Salgaonkar 			      &prstatus, sizeof(prstatus));
752ebaeb5aeSMahesh Salgaonkar 	return buf;
753ebaeb5aeSMahesh Salgaonkar }
754ebaeb5aeSMahesh Salgaonkar 
7557f0ad11dSHari Bathini void fadump_update_elfcore_header(char *bufp)
756ebaeb5aeSMahesh Salgaonkar {
757ebaeb5aeSMahesh Salgaonkar 	struct elfhdr *elf;
758ebaeb5aeSMahesh Salgaonkar 	struct elf_phdr *phdr;
759ebaeb5aeSMahesh Salgaonkar 
760ebaeb5aeSMahesh Salgaonkar 	elf = (struct elfhdr *)bufp;
761ebaeb5aeSMahesh Salgaonkar 	bufp += sizeof(struct elfhdr);
762ebaeb5aeSMahesh Salgaonkar 
763ebaeb5aeSMahesh Salgaonkar 	/* First note is a place holder for cpu notes info. */
764ebaeb5aeSMahesh Salgaonkar 	phdr = (struct elf_phdr *)bufp;
765ebaeb5aeSMahesh Salgaonkar 
766ebaeb5aeSMahesh Salgaonkar 	if (phdr->p_type == PT_NOTE) {
767961cf26aSHari Bathini 		phdr->p_paddr	= __pa(fw_dump.cpu_notes_buf_vaddr);
768ebaeb5aeSMahesh Salgaonkar 		phdr->p_offset	= phdr->p_paddr;
769ebaeb5aeSMahesh Salgaonkar 		phdr->p_filesz	= fw_dump.cpu_notes_buf_size;
770ebaeb5aeSMahesh Salgaonkar 		phdr->p_memsz = fw_dump.cpu_notes_buf_size;
771ebaeb5aeSMahesh Salgaonkar 	}
772ebaeb5aeSMahesh Salgaonkar 	return;
773ebaeb5aeSMahesh Salgaonkar }
774ebaeb5aeSMahesh Salgaonkar 
775961cf26aSHari Bathini static void *fadump_alloc_buffer(unsigned long size)
776ebaeb5aeSMahesh Salgaonkar {
77772aa6517SHari Bathini 	unsigned long count, i;
778ebaeb5aeSMahesh Salgaonkar 	struct page *page;
77972aa6517SHari Bathini 	void *vaddr;
780ebaeb5aeSMahesh Salgaonkar 
78172aa6517SHari Bathini 	vaddr = alloc_pages_exact(size, GFP_KERNEL | __GFP_ZERO);
782ebaeb5aeSMahesh Salgaonkar 	if (!vaddr)
783ebaeb5aeSMahesh Salgaonkar 		return NULL;
784ebaeb5aeSMahesh Salgaonkar 
78572aa6517SHari Bathini 	count = PAGE_ALIGN(size) / PAGE_SIZE;
786ebaeb5aeSMahesh Salgaonkar 	page = virt_to_page(vaddr);
787ebaeb5aeSMahesh Salgaonkar 	for (i = 0; i < count; i++)
78872aa6517SHari Bathini 		mark_page_reserved(page + i);
789ebaeb5aeSMahesh Salgaonkar 	return vaddr;
790ebaeb5aeSMahesh Salgaonkar }
791ebaeb5aeSMahesh Salgaonkar 
792961cf26aSHari Bathini static void fadump_free_buffer(unsigned long vaddr, unsigned long size)
793ebaeb5aeSMahesh Salgaonkar {
79472aa6517SHari Bathini 	free_reserved_area((void *)vaddr, (void *)(vaddr + size), -1, NULL);
795ebaeb5aeSMahesh Salgaonkar }
796ebaeb5aeSMahesh Salgaonkar 
7977f0ad11dSHari Bathini s32 fadump_setup_cpu_notes_buf(u32 num_cpus)
798961cf26aSHari Bathini {
799961cf26aSHari Bathini 	/* Allocate buffer to hold cpu crash notes. */
800961cf26aSHari Bathini 	fw_dump.cpu_notes_buf_size = num_cpus * sizeof(note_buf_t);
801961cf26aSHari Bathini 	fw_dump.cpu_notes_buf_size = PAGE_ALIGN(fw_dump.cpu_notes_buf_size);
802961cf26aSHari Bathini 	fw_dump.cpu_notes_buf_vaddr =
803961cf26aSHari Bathini 		(unsigned long)fadump_alloc_buffer(fw_dump.cpu_notes_buf_size);
804961cf26aSHari Bathini 	if (!fw_dump.cpu_notes_buf_vaddr) {
805961cf26aSHari Bathini 		pr_err("Failed to allocate %ld bytes for CPU notes buffer\n",
806961cf26aSHari Bathini 		       fw_dump.cpu_notes_buf_size);
807961cf26aSHari Bathini 		return -ENOMEM;
808961cf26aSHari Bathini 	}
809961cf26aSHari Bathini 
810961cf26aSHari Bathini 	pr_debug("Allocated buffer for cpu notes of size %ld at 0x%lx\n",
811961cf26aSHari Bathini 		 fw_dump.cpu_notes_buf_size,
812961cf26aSHari Bathini 		 fw_dump.cpu_notes_buf_vaddr);
813961cf26aSHari Bathini 	return 0;
814961cf26aSHari Bathini }
815961cf26aSHari Bathini 
8167f0ad11dSHari Bathini void fadump_free_cpu_notes_buf(void)
817961cf26aSHari Bathini {
818961cf26aSHari Bathini 	if (!fw_dump.cpu_notes_buf_vaddr)
819961cf26aSHari Bathini 		return;
820961cf26aSHari Bathini 
821961cf26aSHari Bathini 	fadump_free_buffer(fw_dump.cpu_notes_buf_vaddr,
822961cf26aSHari Bathini 			   fw_dump.cpu_notes_buf_size);
823961cf26aSHari Bathini 	fw_dump.cpu_notes_buf_vaddr = 0;
824961cf26aSHari Bathini 	fw_dump.cpu_notes_buf_size = 0;
825961cf26aSHari Bathini }
826961cf26aSHari Bathini 
827e4fc48fbSHari Bathini static void fadump_free_mem_ranges(struct fadump_mrange_info *mrange_info)
8281bd6a1c4SHari Bathini {
82902c04e37SHari Bathini 	if (mrange_info->is_static) {
83002c04e37SHari Bathini 		mrange_info->mem_range_cnt = 0;
83102c04e37SHari Bathini 		return;
83202c04e37SHari Bathini 	}
83302c04e37SHari Bathini 
834e4fc48fbSHari Bathini 	kfree(mrange_info->mem_ranges);
83502c04e37SHari Bathini 	memset((void *)((u64)mrange_info + RNG_NAME_SZ), 0,
83602c04e37SHari Bathini 	       (sizeof(struct fadump_mrange_info) - RNG_NAME_SZ));
8371bd6a1c4SHari Bathini }
8381bd6a1c4SHari Bathini 
8391bd6a1c4SHari Bathini /*
840e4fc48fbSHari Bathini  * Allocate or reallocate mem_ranges array in incremental units
8411bd6a1c4SHari Bathini  * of PAGE_SIZE.
8421bd6a1c4SHari Bathini  */
843e4fc48fbSHari Bathini static int fadump_alloc_mem_ranges(struct fadump_mrange_info *mrange_info)
8441bd6a1c4SHari Bathini {
845e4fc48fbSHari Bathini 	struct fadump_memory_range *new_array;
8461bd6a1c4SHari Bathini 	u64 new_size;
8471bd6a1c4SHari Bathini 
848e4fc48fbSHari Bathini 	new_size = mrange_info->mem_ranges_sz + PAGE_SIZE;
849e4fc48fbSHari Bathini 	pr_debug("Allocating %llu bytes of memory for %s memory ranges\n",
850e4fc48fbSHari Bathini 		 new_size, mrange_info->name);
8511bd6a1c4SHari Bathini 
852e4fc48fbSHari Bathini 	new_array = krealloc(mrange_info->mem_ranges, new_size, GFP_KERNEL);
8531bd6a1c4SHari Bathini 	if (new_array == NULL) {
854e4fc48fbSHari Bathini 		pr_err("Insufficient memory for setting up %s memory ranges\n",
855e4fc48fbSHari Bathini 		       mrange_info->name);
856e4fc48fbSHari Bathini 		fadump_free_mem_ranges(mrange_info);
8571bd6a1c4SHari Bathini 		return -ENOMEM;
8581bd6a1c4SHari Bathini 	}
8591bd6a1c4SHari Bathini 
860e4fc48fbSHari Bathini 	mrange_info->mem_ranges = new_array;
861e4fc48fbSHari Bathini 	mrange_info->mem_ranges_sz = new_size;
862e4fc48fbSHari Bathini 	mrange_info->max_mem_ranges = (new_size /
863e4fc48fbSHari Bathini 				       sizeof(struct fadump_memory_range));
8641bd6a1c4SHari Bathini 	return 0;
8651bd6a1c4SHari Bathini }
8661bd6a1c4SHari Bathini 
867e4fc48fbSHari Bathini static inline int fadump_add_mem_range(struct fadump_mrange_info *mrange_info,
868e4fc48fbSHari Bathini 				       u64 base, u64 end)
8692df173d9SMahesh Salgaonkar {
870e4fc48fbSHari Bathini 	struct fadump_memory_range *mem_ranges = mrange_info->mem_ranges;
871ced1bf52SHari Bathini 	bool is_adjacent = false;
872e4fc48fbSHari Bathini 	u64 start, size;
873ced1bf52SHari Bathini 
8742df173d9SMahesh Salgaonkar 	if (base == end)
8751bd6a1c4SHari Bathini 		return 0;
8761bd6a1c4SHari Bathini 
877ced1bf52SHari Bathini 	/*
878ced1bf52SHari Bathini 	 * Fold adjacent memory ranges to bring down the memory ranges/
879ced1bf52SHari Bathini 	 * PT_LOAD segments count.
880ced1bf52SHari Bathini 	 */
881e4fc48fbSHari Bathini 	if (mrange_info->mem_range_cnt) {
882e4fc48fbSHari Bathini 		start = mem_ranges[mrange_info->mem_range_cnt - 1].base;
883e4fc48fbSHari Bathini 		size  = mem_ranges[mrange_info->mem_range_cnt - 1].size;
884ced1bf52SHari Bathini 
885ced1bf52SHari Bathini 		if ((start + size) == base)
886ced1bf52SHari Bathini 			is_adjacent = true;
887ced1bf52SHari Bathini 	}
888ced1bf52SHari Bathini 	if (!is_adjacent) {
889ced1bf52SHari Bathini 		/* resize the array on reaching the limit */
890e4fc48fbSHari Bathini 		if (mrange_info->mem_range_cnt == mrange_info->max_mem_ranges) {
8911bd6a1c4SHari Bathini 			int ret;
8921bd6a1c4SHari Bathini 
89302c04e37SHari Bathini 			if (mrange_info->is_static) {
89402c04e37SHari Bathini 				pr_err("Reached array size limit for %s memory ranges\n",
89502c04e37SHari Bathini 				       mrange_info->name);
89602c04e37SHari Bathini 				return -ENOSPC;
89702c04e37SHari Bathini 			}
89802c04e37SHari Bathini 
899e4fc48fbSHari Bathini 			ret = fadump_alloc_mem_ranges(mrange_info);
9001bd6a1c4SHari Bathini 			if (ret)
9011bd6a1c4SHari Bathini 				return ret;
902e4fc48fbSHari Bathini 
903e4fc48fbSHari Bathini 			/* Update to the new resized array */
904e4fc48fbSHari Bathini 			mem_ranges = mrange_info->mem_ranges;
9051bd6a1c4SHari Bathini 		}
9062df173d9SMahesh Salgaonkar 
907ced1bf52SHari Bathini 		start = base;
908e4fc48fbSHari Bathini 		mem_ranges[mrange_info->mem_range_cnt].base = start;
909e4fc48fbSHari Bathini 		mrange_info->mem_range_cnt++;
910ced1bf52SHari Bathini 	}
911ced1bf52SHari Bathini 
912e4fc48fbSHari Bathini 	mem_ranges[mrange_info->mem_range_cnt - 1].size = (end - start);
913e4fc48fbSHari Bathini 	pr_debug("%s_memory_range[%d] [%#016llx-%#016llx], %#llx bytes\n",
914e4fc48fbSHari Bathini 		 mrange_info->name, (mrange_info->mem_range_cnt - 1),
915e4fc48fbSHari Bathini 		 start, end - 1, (end - start));
9161bd6a1c4SHari Bathini 	return 0;
9172df173d9SMahesh Salgaonkar }
9182df173d9SMahesh Salgaonkar 
919e4fc48fbSHari Bathini static int fadump_exclude_reserved_area(u64 start, u64 end)
9202df173d9SMahesh Salgaonkar {
921e4fc48fbSHari Bathini 	u64 ra_start, ra_end;
9221bd6a1c4SHari Bathini 	int ret = 0;
9232df173d9SMahesh Salgaonkar 
9242df173d9SMahesh Salgaonkar 	ra_start = fw_dump.reserve_dump_area_start;
9252df173d9SMahesh Salgaonkar 	ra_end = ra_start + fw_dump.reserve_dump_area_size;
9262df173d9SMahesh Salgaonkar 
9272df173d9SMahesh Salgaonkar 	if ((ra_start < end) && (ra_end > start)) {
9282df173d9SMahesh Salgaonkar 		if ((start < ra_start) && (end > ra_end)) {
929e4fc48fbSHari Bathini 			ret = fadump_add_mem_range(&crash_mrange_info,
930e4fc48fbSHari Bathini 						   start, ra_start);
9311bd6a1c4SHari Bathini 			if (ret)
9321bd6a1c4SHari Bathini 				return ret;
9331bd6a1c4SHari Bathini 
934e4fc48fbSHari Bathini 			ret = fadump_add_mem_range(&crash_mrange_info,
935e4fc48fbSHari Bathini 						   ra_end, end);
9362df173d9SMahesh Salgaonkar 		} else if (start < ra_start) {
937e4fc48fbSHari Bathini 			ret = fadump_add_mem_range(&crash_mrange_info,
938e4fc48fbSHari Bathini 						   start, ra_start);
9392df173d9SMahesh Salgaonkar 		} else if (ra_end < end) {
940e4fc48fbSHari Bathini 			ret = fadump_add_mem_range(&crash_mrange_info,
941e4fc48fbSHari Bathini 						   ra_end, end);
9422df173d9SMahesh Salgaonkar 		}
9432df173d9SMahesh Salgaonkar 	} else
944e4fc48fbSHari Bathini 		ret = fadump_add_mem_range(&crash_mrange_info, start, end);
9451bd6a1c4SHari Bathini 
9461bd6a1c4SHari Bathini 	return ret;
9472df173d9SMahesh Salgaonkar }
9482df173d9SMahesh Salgaonkar 
9492df173d9SMahesh Salgaonkar static int fadump_init_elfcore_header(char *bufp)
9502df173d9SMahesh Salgaonkar {
9512df173d9SMahesh Salgaonkar 	struct elfhdr *elf;
9522df173d9SMahesh Salgaonkar 
9532df173d9SMahesh Salgaonkar 	elf = (struct elfhdr *) bufp;
9542df173d9SMahesh Salgaonkar 	bufp += sizeof(struct elfhdr);
9552df173d9SMahesh Salgaonkar 	memcpy(elf->e_ident, ELFMAG, SELFMAG);
9562df173d9SMahesh Salgaonkar 	elf->e_ident[EI_CLASS] = ELF_CLASS;
9572df173d9SMahesh Salgaonkar 	elf->e_ident[EI_DATA] = ELF_DATA;
9582df173d9SMahesh Salgaonkar 	elf->e_ident[EI_VERSION] = EV_CURRENT;
9592df173d9SMahesh Salgaonkar 	elf->e_ident[EI_OSABI] = ELF_OSABI;
9602df173d9SMahesh Salgaonkar 	memset(elf->e_ident+EI_PAD, 0, EI_NIDENT-EI_PAD);
9612df173d9SMahesh Salgaonkar 	elf->e_type = ET_CORE;
9622df173d9SMahesh Salgaonkar 	elf->e_machine = ELF_ARCH;
9632df173d9SMahesh Salgaonkar 	elf->e_version = EV_CURRENT;
9642df173d9SMahesh Salgaonkar 	elf->e_entry = 0;
9652df173d9SMahesh Salgaonkar 	elf->e_phoff = sizeof(struct elfhdr);
9662df173d9SMahesh Salgaonkar 	elf->e_shoff = 0;
967d8bced27SDaniel Axtens #if defined(_CALL_ELF)
968d8bced27SDaniel Axtens 	elf->e_flags = _CALL_ELF;
969d8bced27SDaniel Axtens #else
970d8bced27SDaniel Axtens 	elf->e_flags = 0;
971d8bced27SDaniel Axtens #endif
9722df173d9SMahesh Salgaonkar 	elf->e_ehsize = sizeof(struct elfhdr);
9732df173d9SMahesh Salgaonkar 	elf->e_phentsize = sizeof(struct elf_phdr);
9742df173d9SMahesh Salgaonkar 	elf->e_phnum = 0;
9752df173d9SMahesh Salgaonkar 	elf->e_shentsize = 0;
9762df173d9SMahesh Salgaonkar 	elf->e_shnum = 0;
9772df173d9SMahesh Salgaonkar 	elf->e_shstrndx = 0;
9782df173d9SMahesh Salgaonkar 
9792df173d9SMahesh Salgaonkar 	return 0;
9802df173d9SMahesh Salgaonkar }
9812df173d9SMahesh Salgaonkar 
9822df173d9SMahesh Salgaonkar /*
9832df173d9SMahesh Salgaonkar  * Traverse through memblock structure and setup crash memory ranges. These
9842df173d9SMahesh Salgaonkar  * ranges will be used create PT_LOAD program headers in elfcore header.
9852df173d9SMahesh Salgaonkar  */
9861bd6a1c4SHari Bathini static int fadump_setup_crash_memory_ranges(void)
9872df173d9SMahesh Salgaonkar {
9882df173d9SMahesh Salgaonkar 	struct memblock_region *reg;
989e4fc48fbSHari Bathini 	u64 start, end;
9907dee93a9SHari Bathini 	int i, ret;
9912df173d9SMahesh Salgaonkar 
9922df173d9SMahesh Salgaonkar 	pr_debug("Setup crash memory ranges.\n");
993e4fc48fbSHari Bathini 	crash_mrange_info.mem_range_cnt = 0;
994ced1bf52SHari Bathini 
9952df173d9SMahesh Salgaonkar 	/*
9967dee93a9SHari Bathini 	 * Boot memory region(s) registered with firmware are moved to
9977dee93a9SHari Bathini 	 * different location at the time of crash. Create separate program
9987dee93a9SHari Bathini 	 * header(s) for this memory chunk(s) with the correct offset.
9992df173d9SMahesh Salgaonkar 	 */
10007dee93a9SHari Bathini 	for (i = 0; i < fw_dump.boot_mem_regs_cnt; i++) {
10017dee93a9SHari Bathini 		start = fw_dump.boot_mem_addr[i];
10027dee93a9SHari Bathini 		end = start + fw_dump.boot_mem_sz[i];
10037dee93a9SHari Bathini 		ret = fadump_add_mem_range(&crash_mrange_info, start, end);
10041bd6a1c4SHari Bathini 		if (ret)
10051bd6a1c4SHari Bathini 			return ret;
10067dee93a9SHari Bathini 	}
10072df173d9SMahesh Salgaonkar 
10082df173d9SMahesh Salgaonkar 	for_each_memblock(memory, reg) {
1009e4fc48fbSHari Bathini 		start = (u64)reg->base;
1010e4fc48fbSHari Bathini 		end = start + (u64)reg->size;
1011a77af552SHari Bathini 
1012a77af552SHari Bathini 		/*
10137dee93a9SHari Bathini 		 * skip the memory chunk that is already added
10147dee93a9SHari Bathini 		 * (0 through boot_memory_top).
1015a77af552SHari Bathini 		 */
10167dee93a9SHari Bathini 		if (start < fw_dump.boot_mem_top) {
10177dee93a9SHari Bathini 			if (end > fw_dump.boot_mem_top)
10187dee93a9SHari Bathini 				start = fw_dump.boot_mem_top;
1019a77af552SHari Bathini 			else
1020a77af552SHari Bathini 				continue;
1021a77af552SHari Bathini 		}
10222df173d9SMahesh Salgaonkar 
10232df173d9SMahesh Salgaonkar 		/* add this range excluding the reserved dump area. */
10241bd6a1c4SHari Bathini 		ret = fadump_exclude_reserved_area(start, end);
10251bd6a1c4SHari Bathini 		if (ret)
10261bd6a1c4SHari Bathini 			return ret;
10272df173d9SMahesh Salgaonkar 	}
10281bd6a1c4SHari Bathini 
10291bd6a1c4SHari Bathini 	return 0;
10302df173d9SMahesh Salgaonkar }
10312df173d9SMahesh Salgaonkar 
1032d34c5f26SMahesh Salgaonkar /*
1033d34c5f26SMahesh Salgaonkar  * If the given physical address falls within the boot memory region then
1034d34c5f26SMahesh Salgaonkar  * return the relocated address that points to the dump region reserved
1035d34c5f26SMahesh Salgaonkar  * for saving initial boot memory contents.
1036d34c5f26SMahesh Salgaonkar  */
1037d34c5f26SMahesh Salgaonkar static inline unsigned long fadump_relocate(unsigned long paddr)
1038d34c5f26SMahesh Salgaonkar {
10397dee93a9SHari Bathini 	unsigned long raddr, rstart, rend, rlast, hole_size;
10407dee93a9SHari Bathini 	int i;
10417dee93a9SHari Bathini 
10427dee93a9SHari Bathini 	hole_size = 0;
10437dee93a9SHari Bathini 	rlast = 0;
10447dee93a9SHari Bathini 	raddr = paddr;
10457dee93a9SHari Bathini 	for (i = 0; i < fw_dump.boot_mem_regs_cnt; i++) {
10467dee93a9SHari Bathini 		rstart = fw_dump.boot_mem_addr[i];
10477dee93a9SHari Bathini 		rend = rstart + fw_dump.boot_mem_sz[i];
10487dee93a9SHari Bathini 		hole_size += (rstart - rlast);
10497dee93a9SHari Bathini 
10507dee93a9SHari Bathini 		if (paddr >= rstart && paddr < rend) {
10517dee93a9SHari Bathini 			raddr += fw_dump.boot_mem_dest_addr - hole_size;
10527dee93a9SHari Bathini 			break;
10537dee93a9SHari Bathini 		}
10547dee93a9SHari Bathini 
10557dee93a9SHari Bathini 		rlast = rend;
10567dee93a9SHari Bathini 	}
10577dee93a9SHari Bathini 
10587dee93a9SHari Bathini 	pr_debug("vmcoreinfo: paddr = 0x%lx, raddr = 0x%lx\n", paddr, raddr);
10597dee93a9SHari Bathini 	return raddr;
1060d34c5f26SMahesh Salgaonkar }
1061d34c5f26SMahesh Salgaonkar 
10622df173d9SMahesh Salgaonkar static int fadump_create_elfcore_headers(char *bufp)
10632df173d9SMahesh Salgaonkar {
10647dee93a9SHari Bathini 	unsigned long long raddr, offset;
10652df173d9SMahesh Salgaonkar 	struct elf_phdr *phdr;
10667dee93a9SHari Bathini 	struct elfhdr *elf;
10677dee93a9SHari Bathini 	int i, j;
10682df173d9SMahesh Salgaonkar 
10692df173d9SMahesh Salgaonkar 	fadump_init_elfcore_header(bufp);
10702df173d9SMahesh Salgaonkar 	elf = (struct elfhdr *)bufp;
10712df173d9SMahesh Salgaonkar 	bufp += sizeof(struct elfhdr);
10722df173d9SMahesh Salgaonkar 
1073ebaeb5aeSMahesh Salgaonkar 	/*
1074ebaeb5aeSMahesh Salgaonkar 	 * setup ELF PT_NOTE, place holder for cpu notes info. The notes info
1075ebaeb5aeSMahesh Salgaonkar 	 * will be populated during second kernel boot after crash. Hence
1076ebaeb5aeSMahesh Salgaonkar 	 * this PT_NOTE will always be the first elf note.
1077ebaeb5aeSMahesh Salgaonkar 	 *
1078ebaeb5aeSMahesh Salgaonkar 	 * NOTE: Any new ELF note addition should be placed after this note.
1079ebaeb5aeSMahesh Salgaonkar 	 */
1080ebaeb5aeSMahesh Salgaonkar 	phdr = (struct elf_phdr *)bufp;
1081ebaeb5aeSMahesh Salgaonkar 	bufp += sizeof(struct elf_phdr);
1082ebaeb5aeSMahesh Salgaonkar 	phdr->p_type = PT_NOTE;
1083ebaeb5aeSMahesh Salgaonkar 	phdr->p_flags = 0;
1084ebaeb5aeSMahesh Salgaonkar 	phdr->p_vaddr = 0;
1085ebaeb5aeSMahesh Salgaonkar 	phdr->p_align = 0;
1086ebaeb5aeSMahesh Salgaonkar 
1087ebaeb5aeSMahesh Salgaonkar 	phdr->p_offset = 0;
1088ebaeb5aeSMahesh Salgaonkar 	phdr->p_paddr = 0;
1089ebaeb5aeSMahesh Salgaonkar 	phdr->p_filesz = 0;
1090ebaeb5aeSMahesh Salgaonkar 	phdr->p_memsz = 0;
1091ebaeb5aeSMahesh Salgaonkar 
1092ebaeb5aeSMahesh Salgaonkar 	(elf->e_phnum)++;
1093ebaeb5aeSMahesh Salgaonkar 
1094d34c5f26SMahesh Salgaonkar 	/* setup ELF PT_NOTE for vmcoreinfo */
1095d34c5f26SMahesh Salgaonkar 	phdr = (struct elf_phdr *)bufp;
1096d34c5f26SMahesh Salgaonkar 	bufp += sizeof(struct elf_phdr);
1097d34c5f26SMahesh Salgaonkar 	phdr->p_type	= PT_NOTE;
1098d34c5f26SMahesh Salgaonkar 	phdr->p_flags	= 0;
1099d34c5f26SMahesh Salgaonkar 	phdr->p_vaddr	= 0;
1100d34c5f26SMahesh Salgaonkar 	phdr->p_align	= 0;
1101d34c5f26SMahesh Salgaonkar 
1102d34c5f26SMahesh Salgaonkar 	phdr->p_paddr	= fadump_relocate(paddr_vmcoreinfo_note());
1103d34c5f26SMahesh Salgaonkar 	phdr->p_offset	= phdr->p_paddr;
11045203f499SXunlei Pang 	phdr->p_memsz	= phdr->p_filesz = VMCOREINFO_NOTE_SIZE;
1105d34c5f26SMahesh Salgaonkar 
1106d34c5f26SMahesh Salgaonkar 	/* Increment number of program headers. */
1107d34c5f26SMahesh Salgaonkar 	(elf->e_phnum)++;
1108d34c5f26SMahesh Salgaonkar 
11092df173d9SMahesh Salgaonkar 	/* setup PT_LOAD sections. */
11107dee93a9SHari Bathini 	j = 0;
11117dee93a9SHari Bathini 	offset = 0;
11127dee93a9SHari Bathini 	raddr = fw_dump.boot_mem_addr[0];
1113e4fc48fbSHari Bathini 	for (i = 0; i < crash_mrange_info.mem_range_cnt; i++) {
1114e4fc48fbSHari Bathini 		u64 mbase, msize;
11152df173d9SMahesh Salgaonkar 
1116e4fc48fbSHari Bathini 		mbase = crash_mrange_info.mem_ranges[i].base;
1117e4fc48fbSHari Bathini 		msize = crash_mrange_info.mem_ranges[i].size;
11182df173d9SMahesh Salgaonkar 		if (!msize)
11192df173d9SMahesh Salgaonkar 			continue;
11202df173d9SMahesh Salgaonkar 
11212df173d9SMahesh Salgaonkar 		phdr = (struct elf_phdr *)bufp;
11222df173d9SMahesh Salgaonkar 		bufp += sizeof(struct elf_phdr);
11232df173d9SMahesh Salgaonkar 		phdr->p_type	= PT_LOAD;
11242df173d9SMahesh Salgaonkar 		phdr->p_flags	= PF_R|PF_W|PF_X;
11252df173d9SMahesh Salgaonkar 		phdr->p_offset	= mbase;
11262df173d9SMahesh Salgaonkar 
11277dee93a9SHari Bathini 		if (mbase == raddr) {
11282df173d9SMahesh Salgaonkar 			/*
1129becd91d9SHari Bathini 			 * The entire real memory region will be moved by
1130becd91d9SHari Bathini 			 * firmware to the specified destination_address.
1131becd91d9SHari Bathini 			 * Hence set the correct offset.
11322df173d9SMahesh Salgaonkar 			 */
11337dee93a9SHari Bathini 			phdr->p_offset = fw_dump.boot_mem_dest_addr + offset;
11347dee93a9SHari Bathini 			if (j < (fw_dump.boot_mem_regs_cnt - 1)) {
11357dee93a9SHari Bathini 				offset += fw_dump.boot_mem_sz[j];
11367dee93a9SHari Bathini 				raddr = fw_dump.boot_mem_addr[++j];
11377dee93a9SHari Bathini 			}
11382df173d9SMahesh Salgaonkar 		}
11392df173d9SMahesh Salgaonkar 
11402df173d9SMahesh Salgaonkar 		phdr->p_paddr = mbase;
11412df173d9SMahesh Salgaonkar 		phdr->p_vaddr = (unsigned long)__va(mbase);
11422df173d9SMahesh Salgaonkar 		phdr->p_filesz = msize;
11432df173d9SMahesh Salgaonkar 		phdr->p_memsz = msize;
11442df173d9SMahesh Salgaonkar 		phdr->p_align = 0;
11452df173d9SMahesh Salgaonkar 
11462df173d9SMahesh Salgaonkar 		/* Increment number of program headers. */
11472df173d9SMahesh Salgaonkar 		(elf->e_phnum)++;
11482df173d9SMahesh Salgaonkar 	}
11492df173d9SMahesh Salgaonkar 	return 0;
11502df173d9SMahesh Salgaonkar }
11512df173d9SMahesh Salgaonkar 
11522df173d9SMahesh Salgaonkar static unsigned long init_fadump_header(unsigned long addr)
11532df173d9SMahesh Salgaonkar {
11542df173d9SMahesh Salgaonkar 	struct fadump_crash_info_header *fdh;
11552df173d9SMahesh Salgaonkar 
11562df173d9SMahesh Salgaonkar 	if (!addr)
11572df173d9SMahesh Salgaonkar 		return 0;
11582df173d9SMahesh Salgaonkar 
11592df173d9SMahesh Salgaonkar 	fdh = __va(addr);
11602df173d9SMahesh Salgaonkar 	addr += sizeof(struct fadump_crash_info_header);
11612df173d9SMahesh Salgaonkar 
11622df173d9SMahesh Salgaonkar 	memset(fdh, 0, sizeof(struct fadump_crash_info_header));
11632df173d9SMahesh Salgaonkar 	fdh->magic_number = FADUMP_CRASH_INFO_MAGIC;
11642df173d9SMahesh Salgaonkar 	fdh->elfcorehdr_addr = addr;
1165ebaeb5aeSMahesh Salgaonkar 	/* We will set the crashing cpu id in crash_fadump() during crash. */
11660226e552SHari Bathini 	fdh->crashing_cpu = FADUMP_CPU_UNKNOWN;
11672df173d9SMahesh Salgaonkar 
11682df173d9SMahesh Salgaonkar 	return addr;
11692df173d9SMahesh Salgaonkar }
11702df173d9SMahesh Salgaonkar 
117198b8cd7fSMichal Suchanek static int register_fadump(void)
11723ccc00a7SMahesh Salgaonkar {
11732df173d9SMahesh Salgaonkar 	unsigned long addr;
11742df173d9SMahesh Salgaonkar 	void *vaddr;
11751bd6a1c4SHari Bathini 	int ret;
11762df173d9SMahesh Salgaonkar 
11773ccc00a7SMahesh Salgaonkar 	/*
11783ccc00a7SMahesh Salgaonkar 	 * If no memory is reserved then we can not register for firmware-
11793ccc00a7SMahesh Salgaonkar 	 * assisted dump.
11803ccc00a7SMahesh Salgaonkar 	 */
11813ccc00a7SMahesh Salgaonkar 	if (!fw_dump.reserve_dump_area_size)
118298b8cd7fSMichal Suchanek 		return -ENODEV;
11833ccc00a7SMahesh Salgaonkar 
11841bd6a1c4SHari Bathini 	ret = fadump_setup_crash_memory_ranges();
11851bd6a1c4SHari Bathini 	if (ret)
11861bd6a1c4SHari Bathini 		return ret;
11872df173d9SMahesh Salgaonkar 
118841a65d16SHari Bathini 	addr = fw_dump.fadumphdr_addr;
118941a65d16SHari Bathini 
11902df173d9SMahesh Salgaonkar 	/* Initialize fadump crash info header. */
11912df173d9SMahesh Salgaonkar 	addr = init_fadump_header(addr);
11922df173d9SMahesh Salgaonkar 	vaddr = __va(addr);
11932df173d9SMahesh Salgaonkar 
11942df173d9SMahesh Salgaonkar 	pr_debug("Creating ELF core headers at %#016lx\n", addr);
11952df173d9SMahesh Salgaonkar 	fadump_create_elfcore_headers(vaddr);
11962df173d9SMahesh Salgaonkar 
11973ccc00a7SMahesh Salgaonkar 	/* register the future kernel dump with firmware. */
119841a65d16SHari Bathini 	pr_debug("Registering for firmware-assisted kernel dump...\n");
119941a65d16SHari Bathini 	return fw_dump.ops->fadump_register(&fw_dump);
12003ccc00a7SMahesh Salgaonkar }
12013ccc00a7SMahesh Salgaonkar 
1202b500afffSMahesh Salgaonkar void fadump_cleanup(void)
1203b500afffSMahesh Salgaonkar {
12042790d01dSHari Bathini 	if (!fw_dump.fadump_supported)
12052790d01dSHari Bathini 		return;
12062790d01dSHari Bathini 
1207b500afffSMahesh Salgaonkar 	/* Invalidate the registration only if dump is active. */
1208b500afffSMahesh Salgaonkar 	if (fw_dump.dump_active) {
1209f3512011SHari Bathini 		pr_debug("Invalidating firmware-assisted dump registration\n");
1210f3512011SHari Bathini 		fw_dump.ops->fadump_invalidate(&fw_dump);
1211722cde76SMahesh Salgaonkar 	} else if (fw_dump.dump_registered) {
1212722cde76SMahesh Salgaonkar 		/* Un-register Firmware-assisted dump if it was registered. */
121341a65d16SHari Bathini 		fw_dump.ops->fadump_unregister(&fw_dump);
1214e4fc48fbSHari Bathini 		fadump_free_mem_ranges(&crash_mrange_info);
1215b500afffSMahesh Salgaonkar 	}
12162790d01dSHari Bathini 
12172790d01dSHari Bathini 	if (fw_dump.ops->fadump_cleanup)
12182790d01dSHari Bathini 		fw_dump.ops->fadump_cleanup(&fw_dump);
1219b500afffSMahesh Salgaonkar }
1220b500afffSMahesh Salgaonkar 
122168fa6478SHari Bathini static void fadump_free_reserved_memory(unsigned long start_pfn,
122268fa6478SHari Bathini 					unsigned long end_pfn)
122368fa6478SHari Bathini {
122468fa6478SHari Bathini 	unsigned long pfn;
122568fa6478SHari Bathini 	unsigned long time_limit = jiffies + HZ;
122668fa6478SHari Bathini 
122768fa6478SHari Bathini 	pr_info("freeing reserved memory (0x%llx - 0x%llx)\n",
122868fa6478SHari Bathini 		PFN_PHYS(start_pfn), PFN_PHYS(end_pfn));
122968fa6478SHari Bathini 
123068fa6478SHari Bathini 	for (pfn = start_pfn; pfn < end_pfn; pfn++) {
123168fa6478SHari Bathini 		free_reserved_page(pfn_to_page(pfn));
123268fa6478SHari Bathini 
123368fa6478SHari Bathini 		if (time_after(jiffies, time_limit)) {
123468fa6478SHari Bathini 			cond_resched();
123568fa6478SHari Bathini 			time_limit = jiffies + HZ;
123668fa6478SHari Bathini 		}
123768fa6478SHari Bathini 	}
123868fa6478SHari Bathini }
123968fa6478SHari Bathini 
124068fa6478SHari Bathini /*
124168fa6478SHari Bathini  * Skip memory holes and free memory that was actually reserved.
124268fa6478SHari Bathini  */
1243dda9dbfeSHari Bathini static void fadump_release_reserved_area(u64 start, u64 end)
124468fa6478SHari Bathini {
1245*c9118e6cSMike Rapoport 	u64 tstart, tend, spfn, epfn, reg_spfn, reg_epfn, i;
124668fa6478SHari Bathini 
1247dda9dbfeSHari Bathini 	spfn = PHYS_PFN(start);
1248dda9dbfeSHari Bathini 	epfn = PHYS_PFN(end);
1249*c9118e6cSMike Rapoport 
1250*c9118e6cSMike Rapoport 	for_each_mem_pfn_range(i, MAX_NUMNODES, &reg_spfn, &reg_epfn, NULL) {
1251*c9118e6cSMike Rapoport 		tstart = max_t(u64, spfn, reg_spfn);
1252*c9118e6cSMike Rapoport 		tend   = min_t(u64, epfn, reg_epfn);
1253*c9118e6cSMike Rapoport 
125468fa6478SHari Bathini 		if (tstart < tend) {
125568fa6478SHari Bathini 			fadump_free_reserved_memory(tstart, tend);
125668fa6478SHari Bathini 
1257dda9dbfeSHari Bathini 			if (tend == epfn)
125868fa6478SHari Bathini 				break;
125968fa6478SHari Bathini 
1260dda9dbfeSHari Bathini 			spfn = tend;
126168fa6478SHari Bathini 		}
126268fa6478SHari Bathini 	}
126368fa6478SHari Bathini }
126468fa6478SHari Bathini 
1265b500afffSMahesh Salgaonkar /*
1266dda9dbfeSHari Bathini  * Sort the mem ranges in-place and merge adjacent ranges
1267dda9dbfeSHari Bathini  * to minimize the memory ranges count.
1268b500afffSMahesh Salgaonkar  */
1269dda9dbfeSHari Bathini static void sort_and_merge_mem_ranges(struct fadump_mrange_info *mrange_info)
1270b500afffSMahesh Salgaonkar {
1271dda9dbfeSHari Bathini 	struct fadump_memory_range *mem_ranges;
1272dda9dbfeSHari Bathini 	struct fadump_memory_range tmp_range;
1273dda9dbfeSHari Bathini 	u64 base, size;
1274dda9dbfeSHari Bathini 	int i, j, idx;
1275dda9dbfeSHari Bathini 
1276dda9dbfeSHari Bathini 	if (!reserved_mrange_info.mem_range_cnt)
1277dda9dbfeSHari Bathini 		return;
1278dda9dbfeSHari Bathini 
1279dda9dbfeSHari Bathini 	/* Sort the memory ranges */
1280dda9dbfeSHari Bathini 	mem_ranges = mrange_info->mem_ranges;
1281dda9dbfeSHari Bathini 	for (i = 0; i < mrange_info->mem_range_cnt; i++) {
1282dda9dbfeSHari Bathini 		idx = i;
1283dda9dbfeSHari Bathini 		for (j = (i + 1); j < mrange_info->mem_range_cnt; j++) {
1284dda9dbfeSHari Bathini 			if (mem_ranges[idx].base > mem_ranges[j].base)
1285dda9dbfeSHari Bathini 				idx = j;
1286dda9dbfeSHari Bathini 		}
1287dda9dbfeSHari Bathini 		if (idx != i) {
1288dda9dbfeSHari Bathini 			tmp_range = mem_ranges[idx];
1289dda9dbfeSHari Bathini 			mem_ranges[idx] = mem_ranges[i];
1290dda9dbfeSHari Bathini 			mem_ranges[i] = tmp_range;
1291dda9dbfeSHari Bathini 		}
1292dda9dbfeSHari Bathini 	}
1293dda9dbfeSHari Bathini 
1294dda9dbfeSHari Bathini 	/* Merge adjacent reserved ranges */
1295dda9dbfeSHari Bathini 	idx = 0;
1296dda9dbfeSHari Bathini 	for (i = 1; i < mrange_info->mem_range_cnt; i++) {
1297dda9dbfeSHari Bathini 		base = mem_ranges[i-1].base;
1298dda9dbfeSHari Bathini 		size = mem_ranges[i-1].size;
1299dda9dbfeSHari Bathini 		if (mem_ranges[i].base == (base + size))
1300dda9dbfeSHari Bathini 			mem_ranges[idx].size += mem_ranges[i].size;
1301dda9dbfeSHari Bathini 		else {
1302dda9dbfeSHari Bathini 			idx++;
1303dda9dbfeSHari Bathini 			if (i == idx)
1304dda9dbfeSHari Bathini 				continue;
1305dda9dbfeSHari Bathini 
1306dda9dbfeSHari Bathini 			mem_ranges[idx] = mem_ranges[i];
1307dda9dbfeSHari Bathini 		}
1308dda9dbfeSHari Bathini 	}
1309dda9dbfeSHari Bathini 	mrange_info->mem_range_cnt = idx + 1;
1310dda9dbfeSHari Bathini }
1311dda9dbfeSHari Bathini 
1312dda9dbfeSHari Bathini /*
1313dda9dbfeSHari Bathini  * Scan reserved-ranges to consider them while reserving/releasing
1314dda9dbfeSHari Bathini  * memory for FADump.
1315dda9dbfeSHari Bathini  */
131602c04e37SHari Bathini static void __init early_init_dt_scan_reserved_ranges(unsigned long node)
1317dda9dbfeSHari Bathini {
1318dda9dbfeSHari Bathini 	const __be32 *prop;
1319dda9dbfeSHari Bathini 	int len, ret = -1;
1320dda9dbfeSHari Bathini 	unsigned long i;
1321dda9dbfeSHari Bathini 
132202c04e37SHari Bathini 	/* reserved-ranges already scanned */
132302c04e37SHari Bathini 	if (reserved_mrange_info.mem_range_cnt != 0)
132402c04e37SHari Bathini 		return;
1325dda9dbfeSHari Bathini 
132602c04e37SHari Bathini 	prop = of_get_flat_dt_prop(node, "reserved-ranges", &len);
1327dda9dbfeSHari Bathini 	if (!prop)
132802c04e37SHari Bathini 		return;
1329dda9dbfeSHari Bathini 
1330dda9dbfeSHari Bathini 	/*
1331dda9dbfeSHari Bathini 	 * Each reserved range is an (address,size) pair, 2 cells each,
1332dda9dbfeSHari Bathini 	 * totalling 4 cells per range.
1333dda9dbfeSHari Bathini 	 */
1334dda9dbfeSHari Bathini 	for (i = 0; i < len / (sizeof(*prop) * 4); i++) {
1335dda9dbfeSHari Bathini 		u64 base, size;
1336dda9dbfeSHari Bathini 
1337dda9dbfeSHari Bathini 		base = of_read_number(prop + (i * 4) + 0, 2);
1338dda9dbfeSHari Bathini 		size = of_read_number(prop + (i * 4) + 2, 2);
1339dda9dbfeSHari Bathini 
1340dda9dbfeSHari Bathini 		if (size) {
1341dda9dbfeSHari Bathini 			ret = fadump_add_mem_range(&reserved_mrange_info,
1342dda9dbfeSHari Bathini 						   base, base + size);
1343dda9dbfeSHari Bathini 			if (ret < 0) {
1344dda9dbfeSHari Bathini 				pr_warn("some reserved ranges are ignored!\n");
1345dda9dbfeSHari Bathini 				break;
1346dda9dbfeSHari Bathini 			}
1347dda9dbfeSHari Bathini 		}
1348dda9dbfeSHari Bathini 	}
1349dda9dbfeSHari Bathini 
135002c04e37SHari Bathini 	/* Compact reserved ranges */
135102c04e37SHari Bathini 	sort_and_merge_mem_ranges(&reserved_mrange_info);
1352dda9dbfeSHari Bathini }
1353dda9dbfeSHari Bathini 
1354dda9dbfeSHari Bathini /*
1355dda9dbfeSHari Bathini  * Release the memory that was reserved during early boot to preserve the
1356dda9dbfeSHari Bathini  * crash'ed kernel's memory contents except reserved dump area (permanent
1357dda9dbfeSHari Bathini  * reservation) and reserved ranges used by F/W. The released memory will
1358dda9dbfeSHari Bathini  * be available for general use.
1359dda9dbfeSHari Bathini  */
1360dda9dbfeSHari Bathini static void fadump_release_memory(u64 begin, u64 end)
1361dda9dbfeSHari Bathini {
1362dda9dbfeSHari Bathini 	u64 ra_start, ra_end, tstart;
1363dda9dbfeSHari Bathini 	int i, ret;
1364dda9dbfeSHari Bathini 
1365b500afffSMahesh Salgaonkar 	ra_start = fw_dump.reserve_dump_area_start;
1366b500afffSMahesh Salgaonkar 	ra_end = ra_start + fw_dump.reserve_dump_area_size;
1367b500afffSMahesh Salgaonkar 
1368b500afffSMahesh Salgaonkar 	/*
136902c04e37SHari Bathini 	 * If reserved ranges array limit is hit, overwrite the last reserved
137002c04e37SHari Bathini 	 * memory range with reserved dump area to ensure it is excluded from
137102c04e37SHari Bathini 	 * the memory being released (reused for next FADump registration).
1372dda9dbfeSHari Bathini 	 */
137302c04e37SHari Bathini 	if (reserved_mrange_info.mem_range_cnt ==
137402c04e37SHari Bathini 	    reserved_mrange_info.max_mem_ranges)
137502c04e37SHari Bathini 		reserved_mrange_info.mem_range_cnt--;
1376dda9dbfeSHari Bathini 
137702c04e37SHari Bathini 	ret = fadump_add_mem_range(&reserved_mrange_info, ra_start, ra_end);
137802c04e37SHari Bathini 	if (ret != 0)
1379dda9dbfeSHari Bathini 		return;
1380dda9dbfeSHari Bathini 
1381dda9dbfeSHari Bathini 	/* Get the reserved ranges list in order first. */
1382dda9dbfeSHari Bathini 	sort_and_merge_mem_ranges(&reserved_mrange_info);
1383dda9dbfeSHari Bathini 
1384dda9dbfeSHari Bathini 	/* Exclude reserved ranges and release remaining memory */
1385dda9dbfeSHari Bathini 	tstart = begin;
1386dda9dbfeSHari Bathini 	for (i = 0; i < reserved_mrange_info.mem_range_cnt; i++) {
1387dda9dbfeSHari Bathini 		ra_start = reserved_mrange_info.mem_ranges[i].base;
1388dda9dbfeSHari Bathini 		ra_end = ra_start + reserved_mrange_info.mem_ranges[i].size;
1389dda9dbfeSHari Bathini 
1390dda9dbfeSHari Bathini 		if (tstart >= ra_end)
1391dda9dbfeSHari Bathini 			continue;
1392dda9dbfeSHari Bathini 
1393dda9dbfeSHari Bathini 		if (tstart < ra_start)
1394dda9dbfeSHari Bathini 			fadump_release_reserved_area(tstart, ra_start);
1395dda9dbfeSHari Bathini 		tstart = ra_end;
1396dda9dbfeSHari Bathini 	}
1397dda9dbfeSHari Bathini 
1398dda9dbfeSHari Bathini 	if (tstart < end)
1399dda9dbfeSHari Bathini 		fadump_release_reserved_area(tstart, end);
1400b500afffSMahesh Salgaonkar }
1401b500afffSMahesh Salgaonkar 
1402b500afffSMahesh Salgaonkar static void fadump_invalidate_release_mem(void)
1403b500afffSMahesh Salgaonkar {
1404b500afffSMahesh Salgaonkar 	mutex_lock(&fadump_mutex);
1405b500afffSMahesh Salgaonkar 	if (!fw_dump.dump_active) {
1406b500afffSMahesh Salgaonkar 		mutex_unlock(&fadump_mutex);
1407b500afffSMahesh Salgaonkar 		return;
1408b500afffSMahesh Salgaonkar 	}
1409b500afffSMahesh Salgaonkar 
1410b500afffSMahesh Salgaonkar 	fadump_cleanup();
1411b500afffSMahesh Salgaonkar 	mutex_unlock(&fadump_mutex);
1412b500afffSMahesh Salgaonkar 
14137dee93a9SHari Bathini 	fadump_release_memory(fw_dump.boot_mem_top, memblock_end_of_DRAM());
1414961cf26aSHari Bathini 	fadump_free_cpu_notes_buf();
1415961cf26aSHari Bathini 
1416a4e2e2caSHari Bathini 	/*
1417a4e2e2caSHari Bathini 	 * Setup kernel metadata and initialize the kernel dump
1418a4e2e2caSHari Bathini 	 * memory structure for FADump re-registration.
1419a4e2e2caSHari Bathini 	 */
1420a4e2e2caSHari Bathini 	if (fw_dump.ops->fadump_setup_metadata &&
1421a4e2e2caSHari Bathini 	    (fw_dump.ops->fadump_setup_metadata(&fw_dump) < 0))
1422a4e2e2caSHari Bathini 		pr_warn("Failed to setup kernel metadata!\n");
142341a65d16SHari Bathini 	fw_dump.ops->fadump_init_mem_struct(&fw_dump);
1424b500afffSMahesh Salgaonkar }
1425b500afffSMahesh Salgaonkar 
1426d418b19fSSourabh Jain static ssize_t release_mem_store(struct kobject *kobj,
1427b500afffSMahesh Salgaonkar 				 struct kobj_attribute *attr,
1428b500afffSMahesh Salgaonkar 				 const char *buf, size_t count)
1429b500afffSMahesh Salgaonkar {
1430dcdc4679SMichal Suchanek 	int input = -1;
1431dcdc4679SMichal Suchanek 
1432b500afffSMahesh Salgaonkar 	if (!fw_dump.dump_active)
1433b500afffSMahesh Salgaonkar 		return -EPERM;
1434b500afffSMahesh Salgaonkar 
1435dcdc4679SMichal Suchanek 	if (kstrtoint(buf, 0, &input))
1436dcdc4679SMichal Suchanek 		return -EINVAL;
1437dcdc4679SMichal Suchanek 
1438dcdc4679SMichal Suchanek 	if (input == 1) {
1439b500afffSMahesh Salgaonkar 		/*
1440b500afffSMahesh Salgaonkar 		 * Take away the '/proc/vmcore'. We are releasing the dump
1441b500afffSMahesh Salgaonkar 		 * memory, hence it will not be valid anymore.
1442b500afffSMahesh Salgaonkar 		 */
14432685f826SMichael Ellerman #ifdef CONFIG_PROC_VMCORE
1444b500afffSMahesh Salgaonkar 		vmcore_cleanup();
14452685f826SMichael Ellerman #endif
1446b500afffSMahesh Salgaonkar 		fadump_invalidate_release_mem();
1447b500afffSMahesh Salgaonkar 
1448b500afffSMahesh Salgaonkar 	} else
1449b500afffSMahesh Salgaonkar 		return -EINVAL;
1450b500afffSMahesh Salgaonkar 	return count;
1451b500afffSMahesh Salgaonkar }
1452b500afffSMahesh Salgaonkar 
1453d418b19fSSourabh Jain /* Release the reserved memory and disable the FADump */
1454d418b19fSSourabh Jain static void unregister_fadump(void)
1455d418b19fSSourabh Jain {
1456d418b19fSSourabh Jain 	fadump_cleanup();
1457d418b19fSSourabh Jain 	fadump_release_memory(fw_dump.reserve_dump_area_start,
1458d418b19fSSourabh Jain 			      fw_dump.reserve_dump_area_size);
1459d418b19fSSourabh Jain 	fw_dump.fadump_enabled = 0;
1460d418b19fSSourabh Jain 	kobject_put(fadump_kobj);
1461d418b19fSSourabh Jain }
1462d418b19fSSourabh Jain 
1463d418b19fSSourabh Jain static ssize_t enabled_show(struct kobject *kobj,
14643ccc00a7SMahesh Salgaonkar 			    struct kobj_attribute *attr,
14653ccc00a7SMahesh Salgaonkar 			    char *buf)
14663ccc00a7SMahesh Salgaonkar {
14673ccc00a7SMahesh Salgaonkar 	return sprintf(buf, "%d\n", fw_dump.fadump_enabled);
14683ccc00a7SMahesh Salgaonkar }
14693ccc00a7SMahesh Salgaonkar 
1470d8e73458SSourabh Jain static ssize_t mem_reserved_show(struct kobject *kobj,
1471d8e73458SSourabh Jain 				 struct kobj_attribute *attr,
1472d8e73458SSourabh Jain 				 char *buf)
1473d8e73458SSourabh Jain {
1474d8e73458SSourabh Jain 	return sprintf(buf, "%ld\n", fw_dump.reserve_dump_area_size);
1475d8e73458SSourabh Jain }
1476d8e73458SSourabh Jain 
1477d418b19fSSourabh Jain static ssize_t registered_show(struct kobject *kobj,
14783ccc00a7SMahesh Salgaonkar 			       struct kobj_attribute *attr,
14793ccc00a7SMahesh Salgaonkar 			       char *buf)
14803ccc00a7SMahesh Salgaonkar {
14813ccc00a7SMahesh Salgaonkar 	return sprintf(buf, "%d\n", fw_dump.dump_registered);
14823ccc00a7SMahesh Salgaonkar }
14833ccc00a7SMahesh Salgaonkar 
1484d418b19fSSourabh Jain static ssize_t registered_store(struct kobject *kobj,
14853ccc00a7SMahesh Salgaonkar 				struct kobj_attribute *attr,
14863ccc00a7SMahesh Salgaonkar 				const char *buf, size_t count)
14873ccc00a7SMahesh Salgaonkar {
14883ccc00a7SMahesh Salgaonkar 	int ret = 0;
1489dcdc4679SMichal Suchanek 	int input = -1;
14903ccc00a7SMahesh Salgaonkar 
1491f3512011SHari Bathini 	if (!fw_dump.fadump_enabled || fw_dump.dump_active)
14923ccc00a7SMahesh Salgaonkar 		return -EPERM;
14933ccc00a7SMahesh Salgaonkar 
1494dcdc4679SMichal Suchanek 	if (kstrtoint(buf, 0, &input))
1495dcdc4679SMichal Suchanek 		return -EINVAL;
1496dcdc4679SMichal Suchanek 
14973ccc00a7SMahesh Salgaonkar 	mutex_lock(&fadump_mutex);
14983ccc00a7SMahesh Salgaonkar 
1499dcdc4679SMichal Suchanek 	switch (input) {
1500dcdc4679SMichal Suchanek 	case 0:
15013ccc00a7SMahesh Salgaonkar 		if (fw_dump.dump_registered == 0) {
15023ccc00a7SMahesh Salgaonkar 			goto unlock_out;
15033ccc00a7SMahesh Salgaonkar 		}
1504f3512011SHari Bathini 
15053ccc00a7SMahesh Salgaonkar 		/* Un-register Firmware-assisted dump */
150641a65d16SHari Bathini 		pr_debug("Un-register firmware-assisted dump\n");
150741a65d16SHari Bathini 		fw_dump.ops->fadump_unregister(&fw_dump);
15083ccc00a7SMahesh Salgaonkar 		break;
1509dcdc4679SMichal Suchanek 	case 1:
15103ccc00a7SMahesh Salgaonkar 		if (fw_dump.dump_registered == 1) {
15110823c68bSHari Bathini 			/* Un-register Firmware-assisted dump */
151241a65d16SHari Bathini 			fw_dump.ops->fadump_unregister(&fw_dump);
15133ccc00a7SMahesh Salgaonkar 		}
15143ccc00a7SMahesh Salgaonkar 		/* Register Firmware-assisted dump */
151598b8cd7fSMichal Suchanek 		ret = register_fadump();
15163ccc00a7SMahesh Salgaonkar 		break;
15173ccc00a7SMahesh Salgaonkar 	default:
15183ccc00a7SMahesh Salgaonkar 		ret = -EINVAL;
15193ccc00a7SMahesh Salgaonkar 		break;
15203ccc00a7SMahesh Salgaonkar 	}
15213ccc00a7SMahesh Salgaonkar 
15223ccc00a7SMahesh Salgaonkar unlock_out:
15233ccc00a7SMahesh Salgaonkar 	mutex_unlock(&fadump_mutex);
15243ccc00a7SMahesh Salgaonkar 	return ret < 0 ? ret : count;
15253ccc00a7SMahesh Salgaonkar }
15263ccc00a7SMahesh Salgaonkar 
15273ccc00a7SMahesh Salgaonkar static int fadump_region_show(struct seq_file *m, void *private)
15283ccc00a7SMahesh Salgaonkar {
15293ccc00a7SMahesh Salgaonkar 	if (!fw_dump.fadump_enabled)
15303ccc00a7SMahesh Salgaonkar 		return 0;
15313ccc00a7SMahesh Salgaonkar 
1532b500afffSMahesh Salgaonkar 	mutex_lock(&fadump_mutex);
153341a65d16SHari Bathini 	fw_dump.ops->fadump_region_show(&fw_dump, m);
1534b500afffSMahesh Salgaonkar 	mutex_unlock(&fadump_mutex);
15353ccc00a7SMahesh Salgaonkar 	return 0;
15363ccc00a7SMahesh Salgaonkar }
15373ccc00a7SMahesh Salgaonkar 
1538d418b19fSSourabh Jain static struct kobj_attribute release_attr = __ATTR_WO(release_mem);
1539d418b19fSSourabh Jain static struct kobj_attribute enable_attr = __ATTR_RO(enabled);
1540d418b19fSSourabh Jain static struct kobj_attribute register_attr = __ATTR_RW(registered);
1541d8e73458SSourabh Jain static struct kobj_attribute mem_reserved_attr = __ATTR_RO(mem_reserved);
1542d418b19fSSourabh Jain 
1543d418b19fSSourabh Jain static struct attribute *fadump_attrs[] = {
1544d418b19fSSourabh Jain 	&enable_attr.attr,
1545d418b19fSSourabh Jain 	&register_attr.attr,
1546d8e73458SSourabh Jain 	&mem_reserved_attr.attr,
1547d418b19fSSourabh Jain 	NULL,
1548d418b19fSSourabh Jain };
1549d418b19fSSourabh Jain 
1550d418b19fSSourabh Jain ATTRIBUTE_GROUPS(fadump);
15513ccc00a7SMahesh Salgaonkar 
1552f6cee260SYangtao Li DEFINE_SHOW_ATTRIBUTE(fadump_region);
15533ccc00a7SMahesh Salgaonkar 
15543ccc00a7SMahesh Salgaonkar static void fadump_init_files(void)
15553ccc00a7SMahesh Salgaonkar {
15563ccc00a7SMahesh Salgaonkar 	int rc = 0;
15573ccc00a7SMahesh Salgaonkar 
1558d418b19fSSourabh Jain 	fadump_kobj = kobject_create_and_add("fadump", kernel_kobj);
1559d418b19fSSourabh Jain 	if (!fadump_kobj) {
1560d418b19fSSourabh Jain 		pr_err("failed to create fadump kobject\n");
1561d418b19fSSourabh Jain 		return;
1562d418b19fSSourabh Jain 	}
1563860286cfSGreg Kroah-Hartman 
1564860286cfSGreg Kroah-Hartman 	debugfs_create_file("fadump_region", 0444, powerpc_debugfs_root, NULL,
15653ccc00a7SMahesh Salgaonkar 			    &fadump_region_fops);
1566b500afffSMahesh Salgaonkar 
1567b500afffSMahesh Salgaonkar 	if (fw_dump.dump_active) {
1568d418b19fSSourabh Jain 		rc = sysfs_create_file(fadump_kobj, &release_attr.attr);
1569b500afffSMahesh Salgaonkar 		if (rc)
1570d418b19fSSourabh Jain 			pr_err("unable to create release_mem sysfs file (%d)\n",
1571d418b19fSSourabh Jain 			       rc);
1572d418b19fSSourabh Jain 	}
1573d418b19fSSourabh Jain 
1574d418b19fSSourabh Jain 	rc = sysfs_create_groups(fadump_kobj, fadump_groups);
1575d418b19fSSourabh Jain 	if (rc) {
1576d418b19fSSourabh Jain 		pr_err("sysfs group creation failed (%d), unregistering FADump",
1577d418b19fSSourabh Jain 		       rc);
1578d418b19fSSourabh Jain 		unregister_fadump();
1579d418b19fSSourabh Jain 		return;
1580d418b19fSSourabh Jain 	}
1581d418b19fSSourabh Jain 
1582d418b19fSSourabh Jain 	/*
1583d418b19fSSourabh Jain 	 * The FADump sysfs are moved from kernel_kobj to fadump_kobj need to
1584d418b19fSSourabh Jain 	 * create symlink at old location to maintain backward compatibility.
1585d418b19fSSourabh Jain 	 *
1586d418b19fSSourabh Jain 	 *      - fadump_enabled -> fadump/enabled
1587d418b19fSSourabh Jain 	 *      - fadump_registered -> fadump/registered
1588d418b19fSSourabh Jain 	 *      - fadump_release_mem -> fadump/release_mem
1589d418b19fSSourabh Jain 	 */
1590d418b19fSSourabh Jain 	rc = compat_only_sysfs_link_entry_to_kobj(kernel_kobj, fadump_kobj,
1591d418b19fSSourabh Jain 						  "enabled", "fadump_enabled");
1592d418b19fSSourabh Jain 	if (rc) {
1593d418b19fSSourabh Jain 		pr_err("unable to create fadump_enabled symlink (%d)", rc);
1594d418b19fSSourabh Jain 		return;
1595d418b19fSSourabh Jain 	}
1596d418b19fSSourabh Jain 
1597d418b19fSSourabh Jain 	rc = compat_only_sysfs_link_entry_to_kobj(kernel_kobj, fadump_kobj,
1598d418b19fSSourabh Jain 						  "registered",
1599d418b19fSSourabh Jain 						  "fadump_registered");
1600d418b19fSSourabh Jain 	if (rc) {
1601d418b19fSSourabh Jain 		pr_err("unable to create fadump_registered symlink (%d)", rc);
1602d418b19fSSourabh Jain 		sysfs_remove_link(kernel_kobj, "fadump_enabled");
1603d418b19fSSourabh Jain 		return;
1604d418b19fSSourabh Jain 	}
1605d418b19fSSourabh Jain 
1606d418b19fSSourabh Jain 	if (fw_dump.dump_active) {
1607d418b19fSSourabh Jain 		rc = compat_only_sysfs_link_entry_to_kobj(kernel_kobj,
1608d418b19fSSourabh Jain 							  fadump_kobj,
1609d418b19fSSourabh Jain 							  "release_mem",
1610d418b19fSSourabh Jain 							  "fadump_release_mem");
1611d418b19fSSourabh Jain 		if (rc)
1612d418b19fSSourabh Jain 			pr_err("unable to create fadump_release_mem symlink (%d)",
1613d418b19fSSourabh Jain 			       rc);
1614b500afffSMahesh Salgaonkar 	}
16153ccc00a7SMahesh Salgaonkar 	return;
16163ccc00a7SMahesh Salgaonkar }
16173ccc00a7SMahesh Salgaonkar 
16183ccc00a7SMahesh Salgaonkar /*
16193ccc00a7SMahesh Salgaonkar  * Prepare for firmware-assisted dump.
16203ccc00a7SMahesh Salgaonkar  */
16213ccc00a7SMahesh Salgaonkar int __init setup_fadump(void)
16223ccc00a7SMahesh Salgaonkar {
1623565f9bc0SMichal Suchanek 	if (!fw_dump.fadump_supported)
16243ccc00a7SMahesh Salgaonkar 		return 0;
16253ccc00a7SMahesh Salgaonkar 
1626565f9bc0SMichal Suchanek 	fadump_init_files();
16273ccc00a7SMahesh Salgaonkar 	fadump_show_config();
1628565f9bc0SMichal Suchanek 
1629565f9bc0SMichal Suchanek 	if (!fw_dump.fadump_enabled)
1630565f9bc0SMichal Suchanek 		return 1;
1631565f9bc0SMichal Suchanek 
16322df173d9SMahesh Salgaonkar 	/*
16332df173d9SMahesh Salgaonkar 	 * If dump data is available then see if it is valid and prepare for
16342df173d9SMahesh Salgaonkar 	 * saving it to the disk.
16352df173d9SMahesh Salgaonkar 	 */
1636b500afffSMahesh Salgaonkar 	if (fw_dump.dump_active) {
1637b500afffSMahesh Salgaonkar 		/*
1638b500afffSMahesh Salgaonkar 		 * if dump process fails then invalidate the registration
1639b500afffSMahesh Salgaonkar 		 * and release memory before proceeding for re-registration.
1640b500afffSMahesh Salgaonkar 		 */
1641f3512011SHari Bathini 		if (fw_dump.ops->fadump_process(&fw_dump) < 0)
1642b500afffSMahesh Salgaonkar 			fadump_invalidate_release_mem();
1643b500afffSMahesh Salgaonkar 	}
16443ccc00a7SMahesh Salgaonkar 	/* Initialize the kernel dump memory structure for FAD registration. */
16452df173d9SMahesh Salgaonkar 	else if (fw_dump.reserve_dump_area_size)
164641a65d16SHari Bathini 		fw_dump.ops->fadump_init_mem_struct(&fw_dump);
1647f3512011SHari Bathini 
16483ccc00a7SMahesh Salgaonkar 	return 1;
16493ccc00a7SMahesh Salgaonkar }
16503ccc00a7SMahesh Salgaonkar subsys_initcall(setup_fadump);
1651bec53196SHari Bathini #else /* !CONFIG_PRESERVE_FA_DUMP */
1652bec53196SHari Bathini 
1653bec53196SHari Bathini /* Scan the Firmware Assisted dump configuration details. */
1654bec53196SHari Bathini int __init early_init_dt_scan_fw_dump(unsigned long node, const char *uname,
1655bec53196SHari Bathini 				      int depth, void *data)
1656bec53196SHari Bathini {
1657bec53196SHari Bathini 	if ((depth != 1) || (strcmp(uname, "ibm,opal") != 0))
1658bec53196SHari Bathini 		return 0;
1659bec53196SHari Bathini 
1660bec53196SHari Bathini 	opal_fadump_dt_scan(&fw_dump, node);
1661bec53196SHari Bathini 	return 1;
1662bec53196SHari Bathini }
1663bec53196SHari Bathini 
1664bec53196SHari Bathini /*
1665bec53196SHari Bathini  * When dump is active but PRESERVE_FA_DUMP is enabled on the kernel,
1666bec53196SHari Bathini  * preserve crash data. The subsequent memory preserving kernel boot
1667bec53196SHari Bathini  * is likely to process this crash data.
1668bec53196SHari Bathini  */
1669bec53196SHari Bathini int __init fadump_reserve_mem(void)
1670bec53196SHari Bathini {
1671bec53196SHari Bathini 	if (fw_dump.dump_active) {
1672bec53196SHari Bathini 		/*
1673bec53196SHari Bathini 		 * If last boot has crashed then reserve all the memory
1674bec53196SHari Bathini 		 * above boot memory to preserve crash data.
1675bec53196SHari Bathini 		 */
1676bec53196SHari Bathini 		pr_info("Preserving crash data for processing in next boot.\n");
1677bec53196SHari Bathini 		fadump_reserve_crash_area(fw_dump.boot_mem_top);
1678bec53196SHari Bathini 	} else
1679bec53196SHari Bathini 		pr_debug("FADump-aware kernel..\n");
1680bec53196SHari Bathini 
1681bec53196SHari Bathini 	return 1;
1682bec53196SHari Bathini }
1683bec53196SHari Bathini #endif /* CONFIG_PRESERVE_FA_DUMP */
1684b2a815a5SHari Bathini 
1685b2a815a5SHari Bathini /* Preserve everything above the base address */
1686b2a815a5SHari Bathini static void __init fadump_reserve_crash_area(u64 base)
1687b2a815a5SHari Bathini {
1688b2a815a5SHari Bathini 	struct memblock_region *reg;
1689b2a815a5SHari Bathini 	u64 mstart, msize;
1690b2a815a5SHari Bathini 
1691b2a815a5SHari Bathini 	for_each_memblock(memory, reg) {
1692b2a815a5SHari Bathini 		mstart = reg->base;
1693b2a815a5SHari Bathini 		msize  = reg->size;
1694b2a815a5SHari Bathini 
1695b2a815a5SHari Bathini 		if ((mstart + msize) < base)
1696b2a815a5SHari Bathini 			continue;
1697b2a815a5SHari Bathini 
1698b2a815a5SHari Bathini 		if (mstart < base) {
1699b2a815a5SHari Bathini 			msize -= (base - mstart);
1700b2a815a5SHari Bathini 			mstart = base;
1701b2a815a5SHari Bathini 		}
1702b2a815a5SHari Bathini 
1703b2a815a5SHari Bathini 		pr_info("Reserving %lluMB of memory at %#016llx for preserving crash data",
1704b2a815a5SHari Bathini 			(msize >> 20), mstart);
1705b2a815a5SHari Bathini 		memblock_reserve(mstart, msize);
1706b2a815a5SHari Bathini 	}
1707b2a815a5SHari Bathini }
1708bec53196SHari Bathini 
1709bec53196SHari Bathini unsigned long __init arch_reserved_kernel_pages(void)
1710bec53196SHari Bathini {
1711bec53196SHari Bathini 	return memblock_reserved_size() / PAGE_SIZE;
1712bec53196SHari Bathini }
1713