xref: /openbmc/linux/arch/powerpc/kernel/fadump.c (revision 72aa651795f0e9f48bfdb2b2dd0b3e6900351d2a)
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/rtas.h>
32eb39c880SMahesh Salgaonkar #include <asm/fadump.h>
33ca986d7fSHari Bathini #include <asm/fadump-internal.h>
34cad3c834SStephen Rothwell #include <asm/setup.h>
35eb39c880SMahesh Salgaonkar 
36eb39c880SMahesh Salgaonkar static struct fw_dump fw_dump;
373ccc00a7SMahesh Salgaonkar static struct fadump_mem_struct fdm;
383ccc00a7SMahesh Salgaonkar static const struct fadump_mem_struct *fdm_active;
39a4e92ce8SMahesh Salgaonkar #ifdef CONFIG_CMA
40a4e92ce8SMahesh Salgaonkar static struct cma *fadump_cma;
41a4e92ce8SMahesh Salgaonkar #endif
423ccc00a7SMahesh Salgaonkar 
433ccc00a7SMahesh Salgaonkar static DEFINE_MUTEX(fadump_mutex);
441bd6a1c4SHari Bathini struct fad_crash_memory_ranges *crash_memory_ranges;
451bd6a1c4SHari Bathini int crash_memory_ranges_size;
462df173d9SMahesh Salgaonkar int crash_mem_ranges;
471bd6a1c4SHari Bathini int max_crash_mem_ranges;
48eb39c880SMahesh Salgaonkar 
49a4e92ce8SMahesh Salgaonkar #ifdef CONFIG_CMA
50a4e92ce8SMahesh Salgaonkar /*
51a4e92ce8SMahesh Salgaonkar  * fadump_cma_init() - Initialize CMA area from a fadump reserved memory
52a4e92ce8SMahesh Salgaonkar  *
53a4e92ce8SMahesh Salgaonkar  * This function initializes CMA area from fadump reserved memory.
54a4e92ce8SMahesh Salgaonkar  * The total size of fadump reserved memory covers for boot memory size
55a4e92ce8SMahesh Salgaonkar  * + cpu data size + hpte size and metadata.
56a4e92ce8SMahesh Salgaonkar  * Initialize only the area equivalent to boot memory size for CMA use.
57a4e92ce8SMahesh Salgaonkar  * The reamining portion of fadump reserved memory will be not given
58a4e92ce8SMahesh Salgaonkar  * to CMA and pages for thoes will stay reserved. boot memory size is
59a4e92ce8SMahesh Salgaonkar  * aligned per CMA requirement to satisy cma_init_reserved_mem() call.
60a4e92ce8SMahesh Salgaonkar  * But for some reason even if it fails we still have the memory reservation
61a4e92ce8SMahesh Salgaonkar  * with us and we can still continue doing fadump.
62a4e92ce8SMahesh Salgaonkar  */
63a4e92ce8SMahesh Salgaonkar int __init fadump_cma_init(void)
64a4e92ce8SMahesh Salgaonkar {
65a4e92ce8SMahesh Salgaonkar 	unsigned long long base, size;
66a4e92ce8SMahesh Salgaonkar 	int rc;
67a4e92ce8SMahesh Salgaonkar 
68a4e92ce8SMahesh Salgaonkar 	if (!fw_dump.fadump_enabled)
69a4e92ce8SMahesh Salgaonkar 		return 0;
70a4e92ce8SMahesh Salgaonkar 
71a4e92ce8SMahesh Salgaonkar 	/*
72a4e92ce8SMahesh Salgaonkar 	 * Do not use CMA if user has provided fadump=nocma kernel parameter.
73a4e92ce8SMahesh Salgaonkar 	 * Return 1 to continue with fadump old behaviour.
74a4e92ce8SMahesh Salgaonkar 	 */
75a4e92ce8SMahesh Salgaonkar 	if (fw_dump.nocma)
76a4e92ce8SMahesh Salgaonkar 		return 1;
77a4e92ce8SMahesh Salgaonkar 
78a4e92ce8SMahesh Salgaonkar 	base = fw_dump.reserve_dump_area_start;
79a4e92ce8SMahesh Salgaonkar 	size = fw_dump.boot_memory_size;
80a4e92ce8SMahesh Salgaonkar 
81a4e92ce8SMahesh Salgaonkar 	if (!size)
82a4e92ce8SMahesh Salgaonkar 		return 0;
83a4e92ce8SMahesh Salgaonkar 
84a4e92ce8SMahesh Salgaonkar 	rc = cma_init_reserved_mem(base, size, 0, "fadump_cma", &fadump_cma);
85a4e92ce8SMahesh Salgaonkar 	if (rc) {
86a4e92ce8SMahesh Salgaonkar 		pr_err("Failed to init cma area for firmware-assisted dump,%d\n", rc);
87a4e92ce8SMahesh Salgaonkar 		/*
88a4e92ce8SMahesh Salgaonkar 		 * Though the CMA init has failed we still have memory
89a4e92ce8SMahesh Salgaonkar 		 * reservation with us. The reserved memory will be
90a4e92ce8SMahesh Salgaonkar 		 * blocked from production system usage.  Hence return 1,
91a4e92ce8SMahesh Salgaonkar 		 * so that we can continue with fadump.
92a4e92ce8SMahesh Salgaonkar 		 */
93a4e92ce8SMahesh Salgaonkar 		return 1;
94a4e92ce8SMahesh Salgaonkar 	}
95a4e92ce8SMahesh Salgaonkar 
96a4e92ce8SMahesh Salgaonkar 	/*
97a4e92ce8SMahesh Salgaonkar 	 * So we now have successfully initialized cma area for fadump.
98a4e92ce8SMahesh Salgaonkar 	 */
99a4e92ce8SMahesh Salgaonkar 	pr_info("Initialized 0x%lx bytes cma area at %ldMB from 0x%lx "
100a4e92ce8SMahesh Salgaonkar 		"bytes of memory reserved for firmware-assisted dump\n",
101a4e92ce8SMahesh Salgaonkar 		cma_get_size(fadump_cma),
102a4e92ce8SMahesh Salgaonkar 		(unsigned long)cma_get_base(fadump_cma) >> 20,
103a4e92ce8SMahesh Salgaonkar 		fw_dump.reserve_dump_area_size);
104a4e92ce8SMahesh Salgaonkar 	return 1;
105a4e92ce8SMahesh Salgaonkar }
106a4e92ce8SMahesh Salgaonkar #else
107a4e92ce8SMahesh Salgaonkar static int __init fadump_cma_init(void) { return 1; }
108a4e92ce8SMahesh Salgaonkar #endif /* CONFIG_CMA */
109a4e92ce8SMahesh Salgaonkar 
110eb39c880SMahesh Salgaonkar /* Scan the Firmware Assisted dump configuration details. */
111eb39c880SMahesh Salgaonkar int __init early_init_dt_scan_fw_dump(unsigned long node,
112eb39c880SMahesh Salgaonkar 			const char *uname, int depth, void *data)
113eb39c880SMahesh Salgaonkar {
1149d0c4dfeSRob Herring 	const __be32 *sections;
115eb39c880SMahesh Salgaonkar 	int i, num_sections;
1169d0c4dfeSRob Herring 	int size;
117408cddd9SHari Bathini 	const __be32 *token;
118eb39c880SMahesh Salgaonkar 
119eb39c880SMahesh Salgaonkar 	if (depth != 1 || strcmp(uname, "rtas") != 0)
120eb39c880SMahesh Salgaonkar 		return 0;
121eb39c880SMahesh Salgaonkar 
122eb39c880SMahesh Salgaonkar 	/*
123eb39c880SMahesh Salgaonkar 	 * Check if Firmware Assisted dump is supported. if yes, check
124eb39c880SMahesh Salgaonkar 	 * if dump has been initiated on last reboot.
125eb39c880SMahesh Salgaonkar 	 */
126eb39c880SMahesh Salgaonkar 	token = of_get_flat_dt_prop(node, "ibm,configure-kernel-dump", NULL);
127eb39c880SMahesh Salgaonkar 	if (!token)
128a7d04317SGavin Shan 		return 1;
129eb39c880SMahesh Salgaonkar 
130eb39c880SMahesh Salgaonkar 	fw_dump.fadump_supported = 1;
131408cddd9SHari Bathini 	fw_dump.ibm_configure_kernel_dump = be32_to_cpu(*token);
132eb39c880SMahesh Salgaonkar 
133eb39c880SMahesh Salgaonkar 	/*
134eb39c880SMahesh Salgaonkar 	 * The 'ibm,kernel-dump' rtas node is present only if there is
135eb39c880SMahesh Salgaonkar 	 * dump data waiting for us.
136eb39c880SMahesh Salgaonkar 	 */
1373ccc00a7SMahesh Salgaonkar 	fdm_active = of_get_flat_dt_prop(node, "ibm,kernel-dump", NULL);
1383ccc00a7SMahesh Salgaonkar 	if (fdm_active)
139eb39c880SMahesh Salgaonkar 		fw_dump.dump_active = 1;
140eb39c880SMahesh Salgaonkar 
141eb39c880SMahesh Salgaonkar 	/* Get the sizes required to store dump data for the firmware provided
142eb39c880SMahesh Salgaonkar 	 * dump sections.
143eb39c880SMahesh Salgaonkar 	 * For each dump section type supported, a 32bit cell which defines
144eb39c880SMahesh Salgaonkar 	 * the ID of a supported section followed by two 32 bit cells which
145eb39c880SMahesh Salgaonkar 	 * gives teh size of the section in bytes.
146eb39c880SMahesh Salgaonkar 	 */
147eb39c880SMahesh Salgaonkar 	sections = of_get_flat_dt_prop(node, "ibm,configure-kernel-dump-sizes",
148eb39c880SMahesh Salgaonkar 					&size);
149eb39c880SMahesh Salgaonkar 
150eb39c880SMahesh Salgaonkar 	if (!sections)
151a7d04317SGavin Shan 		return 1;
152eb39c880SMahesh Salgaonkar 
153eb39c880SMahesh Salgaonkar 	num_sections = size / (3 * sizeof(u32));
154eb39c880SMahesh Salgaonkar 
155eb39c880SMahesh Salgaonkar 	for (i = 0; i < num_sections; i++, sections += 3) {
156eb39c880SMahesh Salgaonkar 		u32 type = (u32)of_read_number(sections, 1);
157eb39c880SMahesh Salgaonkar 
158eb39c880SMahesh Salgaonkar 		switch (type) {
159eb39c880SMahesh Salgaonkar 		case FADUMP_CPU_STATE_DATA:
160eb39c880SMahesh Salgaonkar 			fw_dump.cpu_state_data_size =
161eb39c880SMahesh Salgaonkar 					of_read_ulong(&sections[1], 2);
162eb39c880SMahesh Salgaonkar 			break;
163eb39c880SMahesh Salgaonkar 		case FADUMP_HPTE_REGION:
164eb39c880SMahesh Salgaonkar 			fw_dump.hpte_region_size =
165eb39c880SMahesh Salgaonkar 					of_read_ulong(&sections[1], 2);
166eb39c880SMahesh Salgaonkar 			break;
167eb39c880SMahesh Salgaonkar 		}
168eb39c880SMahesh Salgaonkar 	}
169a7d04317SGavin Shan 
170eb39c880SMahesh Salgaonkar 	return 1;
171eb39c880SMahesh Salgaonkar }
172eb39c880SMahesh Salgaonkar 
173eae0dfccSHari Bathini /*
174eae0dfccSHari Bathini  * If fadump is registered, check if the memory provided
1750db6896fSMahesh Salgaonkar  * falls within boot memory area and reserved memory area.
176eae0dfccSHari Bathini  */
1770db6896fSMahesh Salgaonkar int is_fadump_memory_area(u64 addr, ulong size)
178eae0dfccSHari Bathini {
1790db6896fSMahesh Salgaonkar 	u64 d_start = fw_dump.reserve_dump_area_start;
1800db6896fSMahesh Salgaonkar 	u64 d_end = d_start + fw_dump.reserve_dump_area_size;
1810db6896fSMahesh Salgaonkar 
182eae0dfccSHari Bathini 	if (!fw_dump.dump_registered)
183eae0dfccSHari Bathini 		return 0;
184eae0dfccSHari Bathini 
1850db6896fSMahesh Salgaonkar 	if (((addr + size) > d_start) && (addr <= d_end))
1860db6896fSMahesh Salgaonkar 		return 1;
1870db6896fSMahesh Salgaonkar 
188eae0dfccSHari Bathini 	return (addr + size) > RMA_START && addr <= fw_dump.boot_memory_size;
189eae0dfccSHari Bathini }
190eae0dfccSHari Bathini 
1916fcd6baaSNicholas Piggin int should_fadump_crash(void)
1926fcd6baaSNicholas Piggin {
1936fcd6baaSNicholas Piggin 	if (!fw_dump.dump_registered || !fw_dump.fadumphdr_addr)
1946fcd6baaSNicholas Piggin 		return 0;
1956fcd6baaSNicholas Piggin 	return 1;
1966fcd6baaSNicholas Piggin }
1976fcd6baaSNicholas Piggin 
1983ccc00a7SMahesh Salgaonkar int is_fadump_active(void)
1993ccc00a7SMahesh Salgaonkar {
2003ccc00a7SMahesh Salgaonkar 	return fw_dump.dump_active;
2013ccc00a7SMahesh Salgaonkar }
2023ccc00a7SMahesh Salgaonkar 
203a5a05b91SHari Bathini /*
204961cf26aSHari Bathini  * Returns true, if there are no holes in memory area between d_start to d_end,
205961cf26aSHari Bathini  * false otherwise.
206a5a05b91SHari Bathini  */
207961cf26aSHari Bathini static bool is_fadump_mem_area_contiguous(u64 d_start, u64 d_end)
208a5a05b91SHari Bathini {
209a5a05b91SHari Bathini 	struct memblock_region *reg;
210961cf26aSHari Bathini 	bool ret = false;
211961cf26aSHari Bathini 	u64 start, end;
212a5a05b91SHari Bathini 
213a5a05b91SHari Bathini 	for_each_memblock(memory, reg) {
214961cf26aSHari Bathini 		start = max_t(u64, d_start, reg->base);
215961cf26aSHari Bathini 		end = min_t(u64, d_end, (reg->base + reg->size));
216961cf26aSHari Bathini 		if (d_start < end) {
217961cf26aSHari Bathini 			/* Memory hole from d_start to start */
218961cf26aSHari Bathini 			if (start > d_start)
219a5a05b91SHari Bathini 				break;
220a5a05b91SHari Bathini 
221961cf26aSHari Bathini 			if (end == d_end) {
222961cf26aSHari Bathini 				ret = true;
223a5a05b91SHari Bathini 				break;
224a5a05b91SHari Bathini 			}
225a5a05b91SHari Bathini 
226961cf26aSHari Bathini 			d_start = end + 1;
227a5a05b91SHari Bathini 		}
228a5a05b91SHari Bathini 	}
229a5a05b91SHari Bathini 
230a5a05b91SHari Bathini 	return ret;
231a5a05b91SHari Bathini }
232a5a05b91SHari Bathini 
233f86593beSMahesh Salgaonkar /*
234961cf26aSHari Bathini  * Returns true, if there are no holes in boot memory area,
235961cf26aSHari Bathini  * false otherwise.
236961cf26aSHari Bathini  */
2377f0ad11dSHari Bathini bool is_fadump_boot_mem_contiguous(void)
238961cf26aSHari Bathini {
239961cf26aSHari Bathini 	return is_fadump_mem_area_contiguous(0, fw_dump.boot_memory_size);
240961cf26aSHari Bathini }
241961cf26aSHari Bathini 
242961cf26aSHari Bathini /*
243f86593beSMahesh Salgaonkar  * Returns true, if there are no holes in reserved memory area,
244f86593beSMahesh Salgaonkar  * false otherwise.
245f86593beSMahesh Salgaonkar  */
2467f0ad11dSHari Bathini bool is_fadump_reserved_mem_contiguous(void)
247f86593beSMahesh Salgaonkar {
248961cf26aSHari Bathini 	u64 d_start, d_end;
249f86593beSMahesh Salgaonkar 
250961cf26aSHari Bathini 	d_start	= fw_dump.reserve_dump_area_start;
251961cf26aSHari Bathini 	d_end	= d_start + fw_dump.reserve_dump_area_size;
252961cf26aSHari Bathini 	return is_fadump_mem_area_contiguous(d_start, d_end);
253f86593beSMahesh Salgaonkar }
254f86593beSMahesh Salgaonkar 
2553ccc00a7SMahesh Salgaonkar /* Print firmware assisted dump configurations for debugging purpose. */
2563ccc00a7SMahesh Salgaonkar static void fadump_show_config(void)
2573ccc00a7SMahesh Salgaonkar {
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);
2723ccc00a7SMahesh Salgaonkar }
2733ccc00a7SMahesh Salgaonkar 
2743ccc00a7SMahesh Salgaonkar static unsigned long init_fadump_mem_struct(struct fadump_mem_struct *fdm,
2753ccc00a7SMahesh Salgaonkar 				unsigned long addr)
2763ccc00a7SMahesh Salgaonkar {
2773ccc00a7SMahesh Salgaonkar 	if (!fdm)
2783ccc00a7SMahesh Salgaonkar 		return 0;
2793ccc00a7SMahesh Salgaonkar 
2803ccc00a7SMahesh Salgaonkar 	memset(fdm, 0, sizeof(struct fadump_mem_struct));
2813ccc00a7SMahesh Salgaonkar 	addr = addr & PAGE_MASK;
2823ccc00a7SMahesh Salgaonkar 
283408cddd9SHari Bathini 	fdm->header.dump_format_version = cpu_to_be32(0x00000001);
284408cddd9SHari Bathini 	fdm->header.dump_num_sections = cpu_to_be16(3);
2853ccc00a7SMahesh Salgaonkar 	fdm->header.dump_status_flag = 0;
2863ccc00a7SMahesh Salgaonkar 	fdm->header.offset_first_dump_section =
287408cddd9SHari Bathini 		cpu_to_be32((u32)offsetof(struct fadump_mem_struct, cpu_state_data));
2883ccc00a7SMahesh Salgaonkar 
2893ccc00a7SMahesh Salgaonkar 	/*
2903ccc00a7SMahesh Salgaonkar 	 * Fields for disk dump option.
2913ccc00a7SMahesh Salgaonkar 	 * We are not using disk dump option, hence set these fields to 0.
2923ccc00a7SMahesh Salgaonkar 	 */
2933ccc00a7SMahesh Salgaonkar 	fdm->header.dd_block_size = 0;
2943ccc00a7SMahesh Salgaonkar 	fdm->header.dd_block_offset = 0;
2953ccc00a7SMahesh Salgaonkar 	fdm->header.dd_num_blocks = 0;
2963ccc00a7SMahesh Salgaonkar 	fdm->header.dd_offset_disk_path = 0;
2973ccc00a7SMahesh Salgaonkar 
2983ccc00a7SMahesh Salgaonkar 	/* set 0 to disable an automatic dump-reboot. */
2993ccc00a7SMahesh Salgaonkar 	fdm->header.max_time_auto = 0;
3003ccc00a7SMahesh Salgaonkar 
3013ccc00a7SMahesh Salgaonkar 	/* Kernel dump sections */
3023ccc00a7SMahesh Salgaonkar 	/* cpu state data section. */
303408cddd9SHari Bathini 	fdm->cpu_state_data.request_flag = cpu_to_be32(FADUMP_REQUEST_FLAG);
304408cddd9SHari Bathini 	fdm->cpu_state_data.source_data_type = cpu_to_be16(FADUMP_CPU_STATE_DATA);
3053ccc00a7SMahesh Salgaonkar 	fdm->cpu_state_data.source_address = 0;
306408cddd9SHari Bathini 	fdm->cpu_state_data.source_len = cpu_to_be64(fw_dump.cpu_state_data_size);
307408cddd9SHari Bathini 	fdm->cpu_state_data.destination_address = cpu_to_be64(addr);
3083ccc00a7SMahesh Salgaonkar 	addr += fw_dump.cpu_state_data_size;
3093ccc00a7SMahesh Salgaonkar 
3103ccc00a7SMahesh Salgaonkar 	/* hpte region section */
311408cddd9SHari Bathini 	fdm->hpte_region.request_flag = cpu_to_be32(FADUMP_REQUEST_FLAG);
312408cddd9SHari Bathini 	fdm->hpte_region.source_data_type = cpu_to_be16(FADUMP_HPTE_REGION);
3133ccc00a7SMahesh Salgaonkar 	fdm->hpte_region.source_address = 0;
314408cddd9SHari Bathini 	fdm->hpte_region.source_len = cpu_to_be64(fw_dump.hpte_region_size);
315408cddd9SHari Bathini 	fdm->hpte_region.destination_address = cpu_to_be64(addr);
3163ccc00a7SMahesh Salgaonkar 	addr += fw_dump.hpte_region_size;
3173ccc00a7SMahesh Salgaonkar 
3183ccc00a7SMahesh Salgaonkar 	/* RMA region section */
319408cddd9SHari Bathini 	fdm->rmr_region.request_flag = cpu_to_be32(FADUMP_REQUEST_FLAG);
320408cddd9SHari Bathini 	fdm->rmr_region.source_data_type = cpu_to_be16(FADUMP_REAL_MODE_REGION);
321408cddd9SHari Bathini 	fdm->rmr_region.source_address = cpu_to_be64(RMA_START);
322408cddd9SHari Bathini 	fdm->rmr_region.source_len = cpu_to_be64(fw_dump.boot_memory_size);
323408cddd9SHari Bathini 	fdm->rmr_region.destination_address = cpu_to_be64(addr);
3243ccc00a7SMahesh Salgaonkar 	addr += fw_dump.boot_memory_size;
3253ccc00a7SMahesh Salgaonkar 
3263ccc00a7SMahesh Salgaonkar 	return addr;
3273ccc00a7SMahesh Salgaonkar }
3283ccc00a7SMahesh Salgaonkar 
329eb39c880SMahesh Salgaonkar /**
330eb39c880SMahesh Salgaonkar  * fadump_calculate_reserve_size(): reserve variable boot area 5% of System RAM
331eb39c880SMahesh Salgaonkar  *
332eb39c880SMahesh Salgaonkar  * Function to find the largest memory size we need to reserve during early
333eb39c880SMahesh Salgaonkar  * boot process. This will be the size of the memory that is required for a
334eb39c880SMahesh Salgaonkar  * kernel to boot successfully.
335eb39c880SMahesh Salgaonkar  *
336eb39c880SMahesh Salgaonkar  * This function has been taken from phyp-assisted dump feature implementation.
337eb39c880SMahesh Salgaonkar  *
338eb39c880SMahesh Salgaonkar  * returns larger of 256MB or 5% rounded down to multiples of 256MB.
339eb39c880SMahesh Salgaonkar  *
340eb39c880SMahesh Salgaonkar  * TODO: Come up with better approach to find out more accurate memory size
341eb39c880SMahesh Salgaonkar  * that is required for a kernel to boot successfully.
342eb39c880SMahesh Salgaonkar  *
343eb39c880SMahesh Salgaonkar  */
344eb39c880SMahesh Salgaonkar static inline unsigned long fadump_calculate_reserve_size(void)
345eb39c880SMahesh Salgaonkar {
34611550dc0SHari Bathini 	int ret;
34711550dc0SHari Bathini 	unsigned long long base, size;
348eb39c880SMahesh Salgaonkar 
34981d9eca5SHari Bathini 	if (fw_dump.reserve_bootvar)
35081d9eca5SHari Bathini 		pr_warn("'fadump_reserve_mem=' parameter is deprecated in favor of 'crashkernel=' parameter.\n");
35181d9eca5SHari Bathini 
352eb39c880SMahesh Salgaonkar 	/*
35311550dc0SHari Bathini 	 * Check if the size is specified through crashkernel= cmdline
354e7467dc6SHari Bathini 	 * option. If yes, then use that but ignore base as fadump reserves
355e7467dc6SHari Bathini 	 * memory at a predefined offset.
356eb39c880SMahesh Salgaonkar 	 */
35711550dc0SHari Bathini 	ret = parse_crashkernel(boot_command_line, memblock_phys_mem_size(),
35811550dc0SHari Bathini 				&size, &base);
35911550dc0SHari Bathini 	if (ret == 0 && size > 0) {
36048a316e3SHari Bathini 		unsigned long max_size;
36148a316e3SHari Bathini 
36281d9eca5SHari Bathini 		if (fw_dump.reserve_bootvar)
36381d9eca5SHari Bathini 			pr_info("Using 'crashkernel=' parameter for memory reservation.\n");
36481d9eca5SHari Bathini 
36511550dc0SHari Bathini 		fw_dump.reserve_bootvar = (unsigned long)size;
36648a316e3SHari Bathini 
36748a316e3SHari Bathini 		/*
36848a316e3SHari Bathini 		 * Adjust if the boot memory size specified is above
36948a316e3SHari Bathini 		 * the upper limit.
37048a316e3SHari Bathini 		 */
37148a316e3SHari Bathini 		max_size = memblock_phys_mem_size() / MAX_BOOT_MEM_RATIO;
37248a316e3SHari Bathini 		if (fw_dump.reserve_bootvar > max_size) {
37348a316e3SHari Bathini 			fw_dump.reserve_bootvar = max_size;
37448a316e3SHari Bathini 			pr_info("Adjusted boot memory size to %luMB\n",
37548a316e3SHari Bathini 				(fw_dump.reserve_bootvar >> 20));
37648a316e3SHari Bathini 		}
37748a316e3SHari Bathini 
378eb39c880SMahesh Salgaonkar 		return fw_dump.reserve_bootvar;
37981d9eca5SHari Bathini 	} else if (fw_dump.reserve_bootvar) {
38081d9eca5SHari Bathini 		/*
38181d9eca5SHari Bathini 		 * 'fadump_reserve_mem=' is being used to reserve memory
38281d9eca5SHari Bathini 		 * for firmware-assisted dump.
38381d9eca5SHari Bathini 		 */
38481d9eca5SHari Bathini 		return fw_dump.reserve_bootvar;
38511550dc0SHari Bathini 	}
386eb39c880SMahesh Salgaonkar 
387eb39c880SMahesh Salgaonkar 	/* divide by 20 to get 5% of value */
38848a316e3SHari Bathini 	size = memblock_phys_mem_size() / 20;
389eb39c880SMahesh Salgaonkar 
390eb39c880SMahesh Salgaonkar 	/* round it down in multiples of 256 */
391eb39c880SMahesh Salgaonkar 	size = size & ~0x0FFFFFFFUL;
392eb39c880SMahesh Salgaonkar 
393eb39c880SMahesh Salgaonkar 	/* Truncate to memory_limit. We don't want to over reserve the memory.*/
394eb39c880SMahesh Salgaonkar 	if (memory_limit && size > memory_limit)
395eb39c880SMahesh Salgaonkar 		size = memory_limit;
396eb39c880SMahesh Salgaonkar 
397eb39c880SMahesh Salgaonkar 	return (size > MIN_BOOT_MEM ? size : MIN_BOOT_MEM);
398eb39c880SMahesh Salgaonkar }
399eb39c880SMahesh Salgaonkar 
400eb39c880SMahesh Salgaonkar /*
401eb39c880SMahesh Salgaonkar  * Calculate the total memory size required to be reserved for
402eb39c880SMahesh Salgaonkar  * firmware-assisted dump registration.
403eb39c880SMahesh Salgaonkar  */
404eb39c880SMahesh Salgaonkar static unsigned long get_fadump_area_size(void)
405eb39c880SMahesh Salgaonkar {
406eb39c880SMahesh Salgaonkar 	unsigned long size = 0;
407eb39c880SMahesh Salgaonkar 
408eb39c880SMahesh Salgaonkar 	size += fw_dump.cpu_state_data_size;
409eb39c880SMahesh Salgaonkar 	size += fw_dump.hpte_region_size;
410eb39c880SMahesh Salgaonkar 	size += fw_dump.boot_memory_size;
4112df173d9SMahesh Salgaonkar 	size += sizeof(struct fadump_crash_info_header);
4122df173d9SMahesh Salgaonkar 	size += sizeof(struct elfhdr); /* ELF core header.*/
413ebaeb5aeSMahesh Salgaonkar 	size += sizeof(struct elf_phdr); /* place holder for cpu notes */
4142df173d9SMahesh Salgaonkar 	/* Program headers for crash memory regions. */
4152df173d9SMahesh Salgaonkar 	size += sizeof(struct elf_phdr) * (memblock_num_regions(memory) + 2);
416eb39c880SMahesh Salgaonkar 
417eb39c880SMahesh Salgaonkar 	size = PAGE_ALIGN(size);
418eb39c880SMahesh Salgaonkar 	return size;
419eb39c880SMahesh Salgaonkar }
420eb39c880SMahesh Salgaonkar 
421b71a693dSMahesh Salgaonkar static void __init fadump_reserve_crash_area(unsigned long base,
422b71a693dSMahesh Salgaonkar 					     unsigned long size)
423b71a693dSMahesh Salgaonkar {
424b71a693dSMahesh Salgaonkar 	struct memblock_region *reg;
425b71a693dSMahesh Salgaonkar 	unsigned long mstart, mend, msize;
426b71a693dSMahesh Salgaonkar 
427b71a693dSMahesh Salgaonkar 	for_each_memblock(memory, reg) {
428b71a693dSMahesh Salgaonkar 		mstart = max_t(unsigned long, base, reg->base);
429b71a693dSMahesh Salgaonkar 		mend = reg->base + reg->size;
430b71a693dSMahesh Salgaonkar 		mend = min(base + size, mend);
431b71a693dSMahesh Salgaonkar 
432b71a693dSMahesh Salgaonkar 		if (mstart < mend) {
433b71a693dSMahesh Salgaonkar 			msize = mend - mstart;
434b71a693dSMahesh Salgaonkar 			memblock_reserve(mstart, msize);
435b71a693dSMahesh Salgaonkar 			pr_info("Reserved %ldMB of memory at %#016lx for saving crash dump\n",
436b71a693dSMahesh Salgaonkar 				(msize >> 20), mstart);
437b71a693dSMahesh Salgaonkar 		}
438b71a693dSMahesh Salgaonkar 	}
439b71a693dSMahesh Salgaonkar }
440b71a693dSMahesh Salgaonkar 
441eb39c880SMahesh Salgaonkar int __init fadump_reserve_mem(void)
442eb39c880SMahesh Salgaonkar {
443eb39c880SMahesh Salgaonkar 	unsigned long base, size, memory_boundary;
444eb39c880SMahesh Salgaonkar 
445eb39c880SMahesh Salgaonkar 	if (!fw_dump.fadump_enabled)
446eb39c880SMahesh Salgaonkar 		return 0;
447eb39c880SMahesh Salgaonkar 
448eb39c880SMahesh Salgaonkar 	if (!fw_dump.fadump_supported) {
449eb39c880SMahesh Salgaonkar 		printk(KERN_INFO "Firmware-assisted dump is not supported on"
450eb39c880SMahesh Salgaonkar 				" this hardware\n");
451eb39c880SMahesh Salgaonkar 		fw_dump.fadump_enabled = 0;
452eb39c880SMahesh Salgaonkar 		return 0;
453eb39c880SMahesh Salgaonkar 	}
4543ccc00a7SMahesh Salgaonkar 	/*
4553ccc00a7SMahesh Salgaonkar 	 * Initialize boot memory size
4563ccc00a7SMahesh Salgaonkar 	 * If dump is active then we have already calculated the size during
4573ccc00a7SMahesh Salgaonkar 	 * first kernel.
4583ccc00a7SMahesh Salgaonkar 	 */
4593ccc00a7SMahesh Salgaonkar 	if (fdm_active)
460408cddd9SHari Bathini 		fw_dump.boot_memory_size = be64_to_cpu(fdm_active->rmr_region.source_len);
461a4e92ce8SMahesh Salgaonkar 	else {
462eb39c880SMahesh Salgaonkar 		fw_dump.boot_memory_size = fadump_calculate_reserve_size();
463a4e92ce8SMahesh Salgaonkar #ifdef CONFIG_CMA
464a4e92ce8SMahesh Salgaonkar 		if (!fw_dump.nocma)
465a4e92ce8SMahesh Salgaonkar 			fw_dump.boot_memory_size =
466a4e92ce8SMahesh Salgaonkar 				ALIGN(fw_dump.boot_memory_size,
467a4e92ce8SMahesh Salgaonkar 							FADUMP_CMA_ALIGNMENT);
468a4e92ce8SMahesh Salgaonkar #endif
469a4e92ce8SMahesh Salgaonkar 	}
470eb39c880SMahesh Salgaonkar 
471eb39c880SMahesh Salgaonkar 	/*
472eb39c880SMahesh Salgaonkar 	 * Calculate the memory boundary.
473eb39c880SMahesh Salgaonkar 	 * If memory_limit is less than actual memory boundary then reserve
474eb39c880SMahesh Salgaonkar 	 * the memory for fadump beyond the memory_limit and adjust the
475eb39c880SMahesh Salgaonkar 	 * memory_limit accordingly, so that the running kernel can run with
476eb39c880SMahesh Salgaonkar 	 * specified memory_limit.
477eb39c880SMahesh Salgaonkar 	 */
478eb39c880SMahesh Salgaonkar 	if (memory_limit && memory_limit < memblock_end_of_DRAM()) {
479eb39c880SMahesh Salgaonkar 		size = get_fadump_area_size();
480eb39c880SMahesh Salgaonkar 		if ((memory_limit + size) < memblock_end_of_DRAM())
481eb39c880SMahesh Salgaonkar 			memory_limit += size;
482eb39c880SMahesh Salgaonkar 		else
483eb39c880SMahesh Salgaonkar 			memory_limit = memblock_end_of_DRAM();
484eb39c880SMahesh Salgaonkar 		printk(KERN_INFO "Adjusted memory_limit for firmware-assisted"
485a84fcd46SSuzuki Poulose 				" dump, now %#016llx\n", memory_limit);
486eb39c880SMahesh Salgaonkar 	}
487eb39c880SMahesh Salgaonkar 	if (memory_limit)
488eb39c880SMahesh Salgaonkar 		memory_boundary = memory_limit;
489eb39c880SMahesh Salgaonkar 	else
490eb39c880SMahesh Salgaonkar 		memory_boundary = memblock_end_of_DRAM();
491eb39c880SMahesh Salgaonkar 
492eb39c880SMahesh Salgaonkar 	if (fw_dump.dump_active) {
493b71a693dSMahesh Salgaonkar 		pr_info("Firmware-assisted dump is active.\n");
494b71a693dSMahesh Salgaonkar 
49585975387SHari Bathini #ifdef CONFIG_HUGETLB_PAGE
49685975387SHari Bathini 		/*
49785975387SHari Bathini 		 * FADump capture kernel doesn't care much about hugepages.
49885975387SHari Bathini 		 * In fact, handling hugepages in capture kernel is asking for
49985975387SHari Bathini 		 * trouble. So, disable HugeTLB support when fadump is active.
50085975387SHari Bathini 		 */
50185975387SHari Bathini 		hugetlb_disabled = true;
50285975387SHari Bathini #endif
503eb39c880SMahesh Salgaonkar 		/*
504eb39c880SMahesh Salgaonkar 		 * If last boot has crashed then reserve all the memory
505eb39c880SMahesh Salgaonkar 		 * above boot_memory_size so that we don't touch it until
506eb39c880SMahesh Salgaonkar 		 * dump is written to disk by userspace tool. This memory
507eb39c880SMahesh Salgaonkar 		 * will be released for general use once the dump is saved.
508eb39c880SMahesh Salgaonkar 		 */
509eb39c880SMahesh Salgaonkar 		base = fw_dump.boot_memory_size;
510eb39c880SMahesh Salgaonkar 		size = memory_boundary - base;
511b71a693dSMahesh Salgaonkar 		fadump_reserve_crash_area(base, size);
5122df173d9SMahesh Salgaonkar 
5132df173d9SMahesh Salgaonkar 		fw_dump.fadumphdr_addr =
514408cddd9SHari Bathini 				be64_to_cpu(fdm_active->rmr_region.destination_address) +
515408cddd9SHari Bathini 				be64_to_cpu(fdm_active->rmr_region.source_len);
516a4e92ce8SMahesh Salgaonkar 		pr_debug("fadumphdr_addr = %pa\n", &fw_dump.fadumphdr_addr);
517a4e92ce8SMahesh Salgaonkar 		fw_dump.reserve_dump_area_start = base;
518a4e92ce8SMahesh Salgaonkar 		fw_dump.reserve_dump_area_size = size;
519eb39c880SMahesh Salgaonkar 	} else {
520eb39c880SMahesh Salgaonkar 		size = get_fadump_area_size();
521f6e6bedbSHari Bathini 
522f6e6bedbSHari Bathini 		/*
523f6e6bedbSHari Bathini 		 * Reserve memory at an offset closer to bottom of the RAM to
524f6e6bedbSHari Bathini 		 * minimize the impact of memory hot-remove operation. We can't
525f6e6bedbSHari Bathini 		 * use memblock_find_in_range() here since it doesn't allocate
526f6e6bedbSHari Bathini 		 * from bottom to top.
527f6e6bedbSHari Bathini 		 */
528f6e6bedbSHari Bathini 		for (base = fw_dump.boot_memory_size;
529f6e6bedbSHari Bathini 		     base <= (memory_boundary - size);
530f6e6bedbSHari Bathini 		     base += size) {
531f6e6bedbSHari Bathini 			if (memblock_is_region_memory(base, size) &&
532f6e6bedbSHari Bathini 			    !memblock_is_region_reserved(base, size))
533f6e6bedbSHari Bathini 				break;
534eb39c880SMahesh Salgaonkar 		}
535f6e6bedbSHari Bathini 		if ((base > (memory_boundary - size)) ||
536f6e6bedbSHari Bathini 		    memblock_reserve(base, size)) {
537f6e6bedbSHari Bathini 			pr_err("Failed to reserve memory\n");
538f6e6bedbSHari Bathini 			return 0;
539f6e6bedbSHari Bathini 		}
540f6e6bedbSHari Bathini 
541f6e6bedbSHari Bathini 		pr_info("Reserved %ldMB of memory at %ldMB for firmware-"
542f6e6bedbSHari Bathini 			"assisted dump (System RAM: %ldMB)\n",
543f6e6bedbSHari Bathini 			(unsigned long)(size >> 20),
544f6e6bedbSHari Bathini 			(unsigned long)(base >> 20),
545f6e6bedbSHari Bathini 			(unsigned long)(memblock_phys_mem_size() >> 20));
546f6e6bedbSHari Bathini 
547eb39c880SMahesh Salgaonkar 		fw_dump.reserve_dump_area_start = base;
548eb39c880SMahesh Salgaonkar 		fw_dump.reserve_dump_area_size = size;
549a4e92ce8SMahesh Salgaonkar 		return fadump_cma_init();
550a4e92ce8SMahesh Salgaonkar 	}
551eb39c880SMahesh Salgaonkar 	return 1;
552eb39c880SMahesh Salgaonkar }
553eb39c880SMahesh Salgaonkar 
5541e76609cSSrikar Dronamraju unsigned long __init arch_reserved_kernel_pages(void)
5551e76609cSSrikar Dronamraju {
5561e76609cSSrikar Dronamraju 	return memblock_reserved_size() / PAGE_SIZE;
5571e76609cSSrikar Dronamraju }
5581e76609cSSrikar Dronamraju 
559eb39c880SMahesh Salgaonkar /* Look for fadump= cmdline option. */
560eb39c880SMahesh Salgaonkar static int __init early_fadump_param(char *p)
561eb39c880SMahesh Salgaonkar {
562eb39c880SMahesh Salgaonkar 	if (!p)
563eb39c880SMahesh Salgaonkar 		return 1;
564eb39c880SMahesh Salgaonkar 
565eb39c880SMahesh Salgaonkar 	if (strncmp(p, "on", 2) == 0)
566eb39c880SMahesh Salgaonkar 		fw_dump.fadump_enabled = 1;
567eb39c880SMahesh Salgaonkar 	else if (strncmp(p, "off", 3) == 0)
568eb39c880SMahesh Salgaonkar 		fw_dump.fadump_enabled = 0;
569a4e92ce8SMahesh Salgaonkar 	else if (strncmp(p, "nocma", 5) == 0) {
570a4e92ce8SMahesh Salgaonkar 		fw_dump.fadump_enabled = 1;
571a4e92ce8SMahesh Salgaonkar 		fw_dump.nocma = 1;
572a4e92ce8SMahesh Salgaonkar 	}
573eb39c880SMahesh Salgaonkar 
574eb39c880SMahesh Salgaonkar 	return 0;
575eb39c880SMahesh Salgaonkar }
576eb39c880SMahesh Salgaonkar early_param("fadump", early_fadump_param);
577eb39c880SMahesh Salgaonkar 
57881d9eca5SHari Bathini /*
57981d9eca5SHari Bathini  * Look for fadump_reserve_mem= cmdline option
58081d9eca5SHari Bathini  * TODO: Remove references to 'fadump_reserve_mem=' parameter,
58181d9eca5SHari Bathini  *       the sooner 'crashkernel=' parameter is accustomed to.
58281d9eca5SHari Bathini  */
58381d9eca5SHari Bathini static int __init early_fadump_reserve_mem(char *p)
58481d9eca5SHari Bathini {
58581d9eca5SHari Bathini 	if (p)
58681d9eca5SHari Bathini 		fw_dump.reserve_bootvar = memparse(p, &p);
58781d9eca5SHari Bathini 	return 0;
58881d9eca5SHari Bathini }
58981d9eca5SHari Bathini early_param("fadump_reserve_mem", early_fadump_reserve_mem);
59081d9eca5SHari Bathini 
59198b8cd7fSMichal Suchanek static int register_fw_dump(struct fadump_mem_struct *fdm)
5923ccc00a7SMahesh Salgaonkar {
59398b8cd7fSMichal Suchanek 	int rc, err;
5943ccc00a7SMahesh Salgaonkar 	unsigned int wait_time;
5953ccc00a7SMahesh Salgaonkar 
5963ccc00a7SMahesh Salgaonkar 	pr_debug("Registering for firmware-assisted kernel dump...\n");
5973ccc00a7SMahesh Salgaonkar 
5983ccc00a7SMahesh Salgaonkar 	/* TODO: Add upper time limit for the delay */
5993ccc00a7SMahesh Salgaonkar 	do {
6003ccc00a7SMahesh Salgaonkar 		rc = rtas_call(fw_dump.ibm_configure_kernel_dump, 3, 1, NULL,
6013ccc00a7SMahesh Salgaonkar 			FADUMP_REGISTER, fdm,
6023ccc00a7SMahesh Salgaonkar 			sizeof(struct fadump_mem_struct));
6033ccc00a7SMahesh Salgaonkar 
6043ccc00a7SMahesh Salgaonkar 		wait_time = rtas_busy_delay_time(rc);
6053ccc00a7SMahesh Salgaonkar 		if (wait_time)
6063ccc00a7SMahesh Salgaonkar 			mdelay(wait_time);
6073ccc00a7SMahesh Salgaonkar 
6083ccc00a7SMahesh Salgaonkar 	} while (wait_time);
6093ccc00a7SMahesh Salgaonkar 
61098b8cd7fSMichal Suchanek 	err = -EIO;
6113ccc00a7SMahesh Salgaonkar 	switch (rc) {
61298b8cd7fSMichal Suchanek 	default:
61398b8cd7fSMichal Suchanek 		pr_err("Failed to register. Unknown Error(%d).\n", rc);
61498b8cd7fSMichal Suchanek 		break;
6153ccc00a7SMahesh Salgaonkar 	case -1:
6163ccc00a7SMahesh Salgaonkar 		printk(KERN_ERR "Failed to register firmware-assisted kernel"
6173ccc00a7SMahesh Salgaonkar 			" dump. Hardware Error(%d).\n", rc);
6183ccc00a7SMahesh Salgaonkar 		break;
6193ccc00a7SMahesh Salgaonkar 	case -3:
6207f0ad11dSHari Bathini 		if (!is_fadump_boot_mem_contiguous())
621f86593beSMahesh Salgaonkar 			pr_err("Can't have holes in boot memory area while registering fadump\n");
6227f0ad11dSHari Bathini 		else if (!is_fadump_reserved_mem_contiguous())
623f86593beSMahesh Salgaonkar 			pr_err("Can't have holes in reserved memory area while"
624a5a05b91SHari Bathini 			       " registering fadump\n");
625a5a05b91SHari Bathini 
6263ccc00a7SMahesh Salgaonkar 		printk(KERN_ERR "Failed to register firmware-assisted kernel"
6273ccc00a7SMahesh Salgaonkar 			" dump. Parameter Error(%d).\n", rc);
62898b8cd7fSMichal Suchanek 		err = -EINVAL;
6293ccc00a7SMahesh Salgaonkar 		break;
6303ccc00a7SMahesh Salgaonkar 	case -9:
6313ccc00a7SMahesh Salgaonkar 		printk(KERN_ERR "firmware-assisted kernel dump is already "
6323ccc00a7SMahesh Salgaonkar 			" registered.");
6333ccc00a7SMahesh Salgaonkar 		fw_dump.dump_registered = 1;
63498b8cd7fSMichal Suchanek 		err = -EEXIST;
6353ccc00a7SMahesh Salgaonkar 		break;
6363ccc00a7SMahesh Salgaonkar 	case 0:
6373ccc00a7SMahesh Salgaonkar 		printk(KERN_INFO "firmware-assisted kernel dump registration"
6383ccc00a7SMahesh Salgaonkar 			" is successful\n");
6393ccc00a7SMahesh Salgaonkar 		fw_dump.dump_registered = 1;
64098b8cd7fSMichal Suchanek 		err = 0;
6413ccc00a7SMahesh Salgaonkar 		break;
6423ccc00a7SMahesh Salgaonkar 	}
64398b8cd7fSMichal Suchanek 	return err;
6443ccc00a7SMahesh Salgaonkar }
6453ccc00a7SMahesh Salgaonkar 
646ebaeb5aeSMahesh Salgaonkar void crash_fadump(struct pt_regs *regs, const char *str)
647ebaeb5aeSMahesh Salgaonkar {
648ebaeb5aeSMahesh Salgaonkar 	struct fadump_crash_info_header *fdh = NULL;
649f2a5e8f0SMahesh Salgaonkar 	int old_cpu, this_cpu;
650ebaeb5aeSMahesh Salgaonkar 
6516fcd6baaSNicholas Piggin 	if (!should_fadump_crash())
652ebaeb5aeSMahesh Salgaonkar 		return;
653ebaeb5aeSMahesh Salgaonkar 
654f2a5e8f0SMahesh Salgaonkar 	/*
655f2a5e8f0SMahesh Salgaonkar 	 * old_cpu == -1 means this is the first CPU which has come here,
656f2a5e8f0SMahesh Salgaonkar 	 * go ahead and trigger fadump.
657f2a5e8f0SMahesh Salgaonkar 	 *
658f2a5e8f0SMahesh Salgaonkar 	 * old_cpu != -1 means some other CPU has already on it's way
659f2a5e8f0SMahesh Salgaonkar 	 * to trigger fadump, just keep looping here.
660f2a5e8f0SMahesh Salgaonkar 	 */
661f2a5e8f0SMahesh Salgaonkar 	this_cpu = smp_processor_id();
662f2a5e8f0SMahesh Salgaonkar 	old_cpu = cmpxchg(&crashing_cpu, -1, this_cpu);
663f2a5e8f0SMahesh Salgaonkar 
664f2a5e8f0SMahesh Salgaonkar 	if (old_cpu != -1) {
665f2a5e8f0SMahesh Salgaonkar 		/*
666f2a5e8f0SMahesh Salgaonkar 		 * We can't loop here indefinitely. Wait as long as fadump
667f2a5e8f0SMahesh Salgaonkar 		 * is in force. If we race with fadump un-registration this
668f2a5e8f0SMahesh Salgaonkar 		 * loop will break and then we go down to normal panic path
669f2a5e8f0SMahesh Salgaonkar 		 * and reboot. If fadump is in force the first crashing
670f2a5e8f0SMahesh Salgaonkar 		 * cpu will definitely trigger fadump.
671f2a5e8f0SMahesh Salgaonkar 		 */
672f2a5e8f0SMahesh Salgaonkar 		while (fw_dump.dump_registered)
673f2a5e8f0SMahesh Salgaonkar 			cpu_relax();
674f2a5e8f0SMahesh Salgaonkar 		return;
675f2a5e8f0SMahesh Salgaonkar 	}
676f2a5e8f0SMahesh Salgaonkar 
677ebaeb5aeSMahesh Salgaonkar 	fdh = __va(fw_dump.fadumphdr_addr);
678ebaeb5aeSMahesh Salgaonkar 	fdh->crashing_cpu = crashing_cpu;
679ebaeb5aeSMahesh Salgaonkar 	crash_save_vmcoreinfo();
680ebaeb5aeSMahesh Salgaonkar 
681ebaeb5aeSMahesh Salgaonkar 	if (regs)
682ebaeb5aeSMahesh Salgaonkar 		fdh->regs = *regs;
683ebaeb5aeSMahesh Salgaonkar 	else
684ebaeb5aeSMahesh Salgaonkar 		ppc_save_regs(&fdh->regs);
685ebaeb5aeSMahesh Salgaonkar 
686a0512164SRasmus Villemoes 	fdh->online_mask = *cpu_online_mask;
687ebaeb5aeSMahesh Salgaonkar 
688ebaeb5aeSMahesh Salgaonkar 	/* Call ibm,os-term rtas call to trigger firmware assisted dump */
689ebaeb5aeSMahesh Salgaonkar 	rtas_os_term((char *)str);
690ebaeb5aeSMahesh Salgaonkar }
691ebaeb5aeSMahesh Salgaonkar 
692ebaeb5aeSMahesh Salgaonkar #define GPR_MASK	0xffffff0000000000
693ebaeb5aeSMahesh Salgaonkar static inline int fadump_gpr_index(u64 id)
694ebaeb5aeSMahesh Salgaonkar {
695ebaeb5aeSMahesh Salgaonkar 	int i = -1;
696ebaeb5aeSMahesh Salgaonkar 	char str[3];
697ebaeb5aeSMahesh Salgaonkar 
698ebaeb5aeSMahesh Salgaonkar 	if ((id & GPR_MASK) == REG_ID("GPR")) {
699ebaeb5aeSMahesh Salgaonkar 		/* get the digits at the end */
700ebaeb5aeSMahesh Salgaonkar 		id &= ~GPR_MASK;
701ebaeb5aeSMahesh Salgaonkar 		id >>= 24;
702ebaeb5aeSMahesh Salgaonkar 		str[2] = '\0';
703ebaeb5aeSMahesh Salgaonkar 		str[1] = id & 0xff;
704ebaeb5aeSMahesh Salgaonkar 		str[0] = (id >> 8) & 0xff;
705ebaeb5aeSMahesh Salgaonkar 		sscanf(str, "%d", &i);
706ebaeb5aeSMahesh Salgaonkar 		if (i > 31)
707ebaeb5aeSMahesh Salgaonkar 			i = -1;
708ebaeb5aeSMahesh Salgaonkar 	}
709ebaeb5aeSMahesh Salgaonkar 	return i;
710ebaeb5aeSMahesh Salgaonkar }
711ebaeb5aeSMahesh Salgaonkar 
712ebaeb5aeSMahesh Salgaonkar static inline void fadump_set_regval(struct pt_regs *regs, u64 reg_id,
713ebaeb5aeSMahesh Salgaonkar 								u64 reg_val)
714ebaeb5aeSMahesh Salgaonkar {
715ebaeb5aeSMahesh Salgaonkar 	int i;
716ebaeb5aeSMahesh Salgaonkar 
717ebaeb5aeSMahesh Salgaonkar 	i = fadump_gpr_index(reg_id);
718ebaeb5aeSMahesh Salgaonkar 	if (i >= 0)
719ebaeb5aeSMahesh Salgaonkar 		regs->gpr[i] = (unsigned long)reg_val;
720ebaeb5aeSMahesh Salgaonkar 	else if (reg_id == REG_ID("NIA"))
721ebaeb5aeSMahesh Salgaonkar 		regs->nip = (unsigned long)reg_val;
722ebaeb5aeSMahesh Salgaonkar 	else if (reg_id == REG_ID("MSR"))
723ebaeb5aeSMahesh Salgaonkar 		regs->msr = (unsigned long)reg_val;
724ebaeb5aeSMahesh Salgaonkar 	else if (reg_id == REG_ID("CTR"))
725ebaeb5aeSMahesh Salgaonkar 		regs->ctr = (unsigned long)reg_val;
726ebaeb5aeSMahesh Salgaonkar 	else if (reg_id == REG_ID("LR"))
727ebaeb5aeSMahesh Salgaonkar 		regs->link = (unsigned long)reg_val;
728ebaeb5aeSMahesh Salgaonkar 	else if (reg_id == REG_ID("XER"))
729ebaeb5aeSMahesh Salgaonkar 		regs->xer = (unsigned long)reg_val;
730ebaeb5aeSMahesh Salgaonkar 	else if (reg_id == REG_ID("CR"))
731ebaeb5aeSMahesh Salgaonkar 		regs->ccr = (unsigned long)reg_val;
732ebaeb5aeSMahesh Salgaonkar 	else if (reg_id == REG_ID("DAR"))
733ebaeb5aeSMahesh Salgaonkar 		regs->dar = (unsigned long)reg_val;
734ebaeb5aeSMahesh Salgaonkar 	else if (reg_id == REG_ID("DSISR"))
735ebaeb5aeSMahesh Salgaonkar 		regs->dsisr = (unsigned long)reg_val;
736ebaeb5aeSMahesh Salgaonkar }
737ebaeb5aeSMahesh Salgaonkar 
738ebaeb5aeSMahesh Salgaonkar static struct fadump_reg_entry*
739ebaeb5aeSMahesh Salgaonkar fadump_read_registers(struct fadump_reg_entry *reg_entry, struct pt_regs *regs)
740ebaeb5aeSMahesh Salgaonkar {
741ebaeb5aeSMahesh Salgaonkar 	memset(regs, 0, sizeof(struct pt_regs));
742ebaeb5aeSMahesh Salgaonkar 
743408cddd9SHari Bathini 	while (be64_to_cpu(reg_entry->reg_id) != REG_ID("CPUEND")) {
744408cddd9SHari Bathini 		fadump_set_regval(regs, be64_to_cpu(reg_entry->reg_id),
745408cddd9SHari Bathini 					be64_to_cpu(reg_entry->reg_value));
746ebaeb5aeSMahesh Salgaonkar 		reg_entry++;
747ebaeb5aeSMahesh Salgaonkar 	}
748ebaeb5aeSMahesh Salgaonkar 	reg_entry++;
749ebaeb5aeSMahesh Salgaonkar 	return reg_entry;
750ebaeb5aeSMahesh Salgaonkar }
751ebaeb5aeSMahesh Salgaonkar 
7527f0ad11dSHari Bathini u32 *fadump_regs_to_elf_notes(u32 *buf, struct pt_regs *regs)
753ebaeb5aeSMahesh Salgaonkar {
754ebaeb5aeSMahesh Salgaonkar 	struct elf_prstatus prstatus;
755ebaeb5aeSMahesh Salgaonkar 
756ebaeb5aeSMahesh Salgaonkar 	memset(&prstatus, 0, sizeof(prstatus));
757ebaeb5aeSMahesh Salgaonkar 	/*
758ebaeb5aeSMahesh Salgaonkar 	 * FIXME: How do i get PID? Do I really need it?
759ebaeb5aeSMahesh Salgaonkar 	 * prstatus.pr_pid = ????
760ebaeb5aeSMahesh Salgaonkar 	 */
761ebaeb5aeSMahesh Salgaonkar 	elf_core_copy_kernel_regs(&prstatus.pr_reg, regs);
76222bd0177SHari Bathini 	buf = append_elf_note(buf, CRASH_CORE_NOTE_NAME, NT_PRSTATUS,
763ebaeb5aeSMahesh Salgaonkar 			      &prstatus, sizeof(prstatus));
764ebaeb5aeSMahesh Salgaonkar 	return buf;
765ebaeb5aeSMahesh Salgaonkar }
766ebaeb5aeSMahesh Salgaonkar 
7677f0ad11dSHari Bathini void fadump_update_elfcore_header(char *bufp)
768ebaeb5aeSMahesh Salgaonkar {
769ebaeb5aeSMahesh Salgaonkar 	struct elfhdr *elf;
770ebaeb5aeSMahesh Salgaonkar 	struct elf_phdr *phdr;
771ebaeb5aeSMahesh Salgaonkar 
772ebaeb5aeSMahesh Salgaonkar 	elf = (struct elfhdr *)bufp;
773ebaeb5aeSMahesh Salgaonkar 	bufp += sizeof(struct elfhdr);
774ebaeb5aeSMahesh Salgaonkar 
775ebaeb5aeSMahesh Salgaonkar 	/* First note is a place holder for cpu notes info. */
776ebaeb5aeSMahesh Salgaonkar 	phdr = (struct elf_phdr *)bufp;
777ebaeb5aeSMahesh Salgaonkar 
778ebaeb5aeSMahesh Salgaonkar 	if (phdr->p_type == PT_NOTE) {
779961cf26aSHari Bathini 		phdr->p_paddr	= __pa(fw_dump.cpu_notes_buf_vaddr);
780ebaeb5aeSMahesh Salgaonkar 		phdr->p_offset	= phdr->p_paddr;
781ebaeb5aeSMahesh Salgaonkar 		phdr->p_filesz	= fw_dump.cpu_notes_buf_size;
782ebaeb5aeSMahesh Salgaonkar 		phdr->p_memsz = fw_dump.cpu_notes_buf_size;
783ebaeb5aeSMahesh Salgaonkar 	}
784ebaeb5aeSMahesh Salgaonkar 	return;
785ebaeb5aeSMahesh Salgaonkar }
786ebaeb5aeSMahesh Salgaonkar 
787961cf26aSHari Bathini static void *fadump_alloc_buffer(unsigned long size)
788ebaeb5aeSMahesh Salgaonkar {
789*72aa6517SHari Bathini 	unsigned long count, i;
790ebaeb5aeSMahesh Salgaonkar 	struct page *page;
791*72aa6517SHari Bathini 	void *vaddr;
792ebaeb5aeSMahesh Salgaonkar 
793*72aa6517SHari Bathini 	vaddr = alloc_pages_exact(size, GFP_KERNEL | __GFP_ZERO);
794ebaeb5aeSMahesh Salgaonkar 	if (!vaddr)
795ebaeb5aeSMahesh Salgaonkar 		return NULL;
796ebaeb5aeSMahesh Salgaonkar 
797*72aa6517SHari Bathini 	count = PAGE_ALIGN(size) / PAGE_SIZE;
798ebaeb5aeSMahesh Salgaonkar 	page = virt_to_page(vaddr);
799ebaeb5aeSMahesh Salgaonkar 	for (i = 0; i < count; i++)
800*72aa6517SHari Bathini 		mark_page_reserved(page + i);
801ebaeb5aeSMahesh Salgaonkar 	return vaddr;
802ebaeb5aeSMahesh Salgaonkar }
803ebaeb5aeSMahesh Salgaonkar 
804961cf26aSHari Bathini static void fadump_free_buffer(unsigned long vaddr, unsigned long size)
805ebaeb5aeSMahesh Salgaonkar {
806*72aa6517SHari Bathini 	free_reserved_area((void *)vaddr, (void *)(vaddr + size), -1, NULL);
807ebaeb5aeSMahesh Salgaonkar }
808ebaeb5aeSMahesh Salgaonkar 
8097f0ad11dSHari Bathini s32 fadump_setup_cpu_notes_buf(u32 num_cpus)
810961cf26aSHari Bathini {
811961cf26aSHari Bathini 	/* Allocate buffer to hold cpu crash notes. */
812961cf26aSHari Bathini 	fw_dump.cpu_notes_buf_size = num_cpus * sizeof(note_buf_t);
813961cf26aSHari Bathini 	fw_dump.cpu_notes_buf_size = PAGE_ALIGN(fw_dump.cpu_notes_buf_size);
814961cf26aSHari Bathini 	fw_dump.cpu_notes_buf_vaddr =
815961cf26aSHari Bathini 		(unsigned long)fadump_alloc_buffer(fw_dump.cpu_notes_buf_size);
816961cf26aSHari Bathini 	if (!fw_dump.cpu_notes_buf_vaddr) {
817961cf26aSHari Bathini 		pr_err("Failed to allocate %ld bytes for CPU notes buffer\n",
818961cf26aSHari Bathini 		       fw_dump.cpu_notes_buf_size);
819961cf26aSHari Bathini 		return -ENOMEM;
820961cf26aSHari Bathini 	}
821961cf26aSHari Bathini 
822961cf26aSHari Bathini 	pr_debug("Allocated buffer for cpu notes of size %ld at 0x%lx\n",
823961cf26aSHari Bathini 		 fw_dump.cpu_notes_buf_size,
824961cf26aSHari Bathini 		 fw_dump.cpu_notes_buf_vaddr);
825961cf26aSHari Bathini 	return 0;
826961cf26aSHari Bathini }
827961cf26aSHari Bathini 
8287f0ad11dSHari Bathini void fadump_free_cpu_notes_buf(void)
829961cf26aSHari Bathini {
830961cf26aSHari Bathini 	if (!fw_dump.cpu_notes_buf_vaddr)
831961cf26aSHari Bathini 		return;
832961cf26aSHari Bathini 
833961cf26aSHari Bathini 	fadump_free_buffer(fw_dump.cpu_notes_buf_vaddr,
834961cf26aSHari Bathini 			   fw_dump.cpu_notes_buf_size);
835961cf26aSHari Bathini 	fw_dump.cpu_notes_buf_vaddr = 0;
836961cf26aSHari Bathini 	fw_dump.cpu_notes_buf_size = 0;
837961cf26aSHari Bathini }
838961cf26aSHari Bathini 
839ebaeb5aeSMahesh Salgaonkar /*
840ebaeb5aeSMahesh Salgaonkar  * Read CPU state dump data and convert it into ELF notes.
841ebaeb5aeSMahesh Salgaonkar  * The CPU dump starts with magic number "REGSAVE". NumCpusOffset should be
842ebaeb5aeSMahesh Salgaonkar  * used to access the data to allow for additional fields to be added without
843ebaeb5aeSMahesh Salgaonkar  * affecting compatibility. Each list of registers for a CPU starts with
844ebaeb5aeSMahesh Salgaonkar  * "CPUSTRT" and ends with "CPUEND". Each register entry is of 16 bytes,
845ebaeb5aeSMahesh Salgaonkar  * 8 Byte ASCII identifier and 8 Byte register value. The register entry
846ebaeb5aeSMahesh Salgaonkar  * with identifier "CPUSTRT" and "CPUEND" contains 4 byte cpu id as part
847ebaeb5aeSMahesh Salgaonkar  * of register value. For more details refer to PAPR document.
848ebaeb5aeSMahesh Salgaonkar  *
849ebaeb5aeSMahesh Salgaonkar  * Only for the crashing cpu we ignore the CPU dump data and get exact
850ebaeb5aeSMahesh Salgaonkar  * state from fadump crash info structure populated by first kernel at the
851ebaeb5aeSMahesh Salgaonkar  * time of crash.
852ebaeb5aeSMahesh Salgaonkar  */
853ebaeb5aeSMahesh Salgaonkar static int __init fadump_build_cpu_notes(const struct fadump_mem_struct *fdm)
854ebaeb5aeSMahesh Salgaonkar {
855ebaeb5aeSMahesh Salgaonkar 	struct fadump_reg_save_area_header *reg_header;
856ebaeb5aeSMahesh Salgaonkar 	struct fadump_reg_entry *reg_entry;
857ebaeb5aeSMahesh Salgaonkar 	struct fadump_crash_info_header *fdh = NULL;
858ebaeb5aeSMahesh Salgaonkar 	void *vaddr;
859ebaeb5aeSMahesh Salgaonkar 	unsigned long addr;
860ebaeb5aeSMahesh Salgaonkar 	u32 num_cpus, *note_buf;
861ebaeb5aeSMahesh Salgaonkar 	struct pt_regs regs;
862ebaeb5aeSMahesh Salgaonkar 	int i, rc = 0, cpu = 0;
863ebaeb5aeSMahesh Salgaonkar 
864ebaeb5aeSMahesh Salgaonkar 	if (!fdm->cpu_state_data.bytes_dumped)
865ebaeb5aeSMahesh Salgaonkar 		return -EINVAL;
866ebaeb5aeSMahesh Salgaonkar 
867408cddd9SHari Bathini 	addr = be64_to_cpu(fdm->cpu_state_data.destination_address);
868ebaeb5aeSMahesh Salgaonkar 	vaddr = __va(addr);
869ebaeb5aeSMahesh Salgaonkar 
870ebaeb5aeSMahesh Salgaonkar 	reg_header = vaddr;
871408cddd9SHari Bathini 	if (be64_to_cpu(reg_header->magic_number) != REGSAVE_AREA_MAGIC) {
872ebaeb5aeSMahesh Salgaonkar 		printk(KERN_ERR "Unable to read register save area.\n");
873ebaeb5aeSMahesh Salgaonkar 		return -ENOENT;
874ebaeb5aeSMahesh Salgaonkar 	}
875ebaeb5aeSMahesh Salgaonkar 	pr_debug("--------CPU State Data------------\n");
876408cddd9SHari Bathini 	pr_debug("Magic Number: %llx\n", be64_to_cpu(reg_header->magic_number));
877408cddd9SHari Bathini 	pr_debug("NumCpuOffset: %x\n", be32_to_cpu(reg_header->num_cpu_offset));
878ebaeb5aeSMahesh Salgaonkar 
879408cddd9SHari Bathini 	vaddr += be32_to_cpu(reg_header->num_cpu_offset);
880408cddd9SHari Bathini 	num_cpus = be32_to_cpu(*((__be32 *)(vaddr)));
881ebaeb5aeSMahesh Salgaonkar 	pr_debug("NumCpus     : %u\n", num_cpus);
882ebaeb5aeSMahesh Salgaonkar 	vaddr += sizeof(u32);
883ebaeb5aeSMahesh Salgaonkar 	reg_entry = (struct fadump_reg_entry *)vaddr;
884ebaeb5aeSMahesh Salgaonkar 
885961cf26aSHari Bathini 	rc = fadump_setup_cpu_notes_buf(num_cpus);
886961cf26aSHari Bathini 	if (rc != 0)
887961cf26aSHari Bathini 		return rc;
888ebaeb5aeSMahesh Salgaonkar 
889961cf26aSHari Bathini 	note_buf = (u32 *)fw_dump.cpu_notes_buf_vaddr;
890ebaeb5aeSMahesh Salgaonkar 
891ebaeb5aeSMahesh Salgaonkar 	if (fw_dump.fadumphdr_addr)
892ebaeb5aeSMahesh Salgaonkar 		fdh = __va(fw_dump.fadumphdr_addr);
893ebaeb5aeSMahesh Salgaonkar 
894ebaeb5aeSMahesh Salgaonkar 	for (i = 0; i < num_cpus; i++) {
895408cddd9SHari Bathini 		if (be64_to_cpu(reg_entry->reg_id) != REG_ID("CPUSTRT")) {
896ebaeb5aeSMahesh Salgaonkar 			printk(KERN_ERR "Unable to read CPU state data\n");
897ebaeb5aeSMahesh Salgaonkar 			rc = -ENOENT;
898ebaeb5aeSMahesh Salgaonkar 			goto error_out;
899ebaeb5aeSMahesh Salgaonkar 		}
900ebaeb5aeSMahesh Salgaonkar 		/* Lower 4 bytes of reg_value contains logical cpu id */
901408cddd9SHari Bathini 		cpu = be64_to_cpu(reg_entry->reg_value) & FADUMP_CPU_ID_MASK;
902a0512164SRasmus Villemoes 		if (fdh && !cpumask_test_cpu(cpu, &fdh->online_mask)) {
903ebaeb5aeSMahesh Salgaonkar 			SKIP_TO_NEXT_CPU(reg_entry);
904ebaeb5aeSMahesh Salgaonkar 			continue;
905ebaeb5aeSMahesh Salgaonkar 		}
906ebaeb5aeSMahesh Salgaonkar 		pr_debug("Reading register data for cpu %d...\n", cpu);
907ebaeb5aeSMahesh Salgaonkar 		if (fdh && fdh->crashing_cpu == cpu) {
908ebaeb5aeSMahesh Salgaonkar 			regs = fdh->regs;
909ebaeb5aeSMahesh Salgaonkar 			note_buf = fadump_regs_to_elf_notes(note_buf, &regs);
910ebaeb5aeSMahesh Salgaonkar 			SKIP_TO_NEXT_CPU(reg_entry);
911ebaeb5aeSMahesh Salgaonkar 		} else {
912ebaeb5aeSMahesh Salgaonkar 			reg_entry++;
913ebaeb5aeSMahesh Salgaonkar 			reg_entry = fadump_read_registers(reg_entry, &regs);
914ebaeb5aeSMahesh Salgaonkar 			note_buf = fadump_regs_to_elf_notes(note_buf, &regs);
915ebaeb5aeSMahesh Salgaonkar 		}
916ebaeb5aeSMahesh Salgaonkar 	}
91722bd0177SHari Bathini 	final_note(note_buf);
918ebaeb5aeSMahesh Salgaonkar 
919b717d985SRickard Strandqvist 	if (fdh) {
920ebaeb5aeSMahesh Salgaonkar 		pr_debug("Updating elfcore header (%llx) with cpu notes\n",
921ebaeb5aeSMahesh Salgaonkar 							fdh->elfcorehdr_addr);
922ebaeb5aeSMahesh Salgaonkar 		fadump_update_elfcore_header((char *)__va(fdh->elfcorehdr_addr));
923b717d985SRickard Strandqvist 	}
924ebaeb5aeSMahesh Salgaonkar 	return 0;
925ebaeb5aeSMahesh Salgaonkar 
926ebaeb5aeSMahesh Salgaonkar error_out:
927961cf26aSHari Bathini 	fadump_free_cpu_notes_buf();
928ebaeb5aeSMahesh Salgaonkar 	return rc;
929ebaeb5aeSMahesh Salgaonkar 
930ebaeb5aeSMahesh Salgaonkar }
931ebaeb5aeSMahesh Salgaonkar 
9322df173d9SMahesh Salgaonkar /*
9332df173d9SMahesh Salgaonkar  * Validate and process the dump data stored by firmware before exporting
9342df173d9SMahesh Salgaonkar  * it through '/proc/vmcore'.
9352df173d9SMahesh Salgaonkar  */
9362df173d9SMahesh Salgaonkar static int __init process_fadump(const struct fadump_mem_struct *fdm_active)
9372df173d9SMahesh Salgaonkar {
9382df173d9SMahesh Salgaonkar 	struct fadump_crash_info_header *fdh;
939ebaeb5aeSMahesh Salgaonkar 	int rc = 0;
9402df173d9SMahesh Salgaonkar 
9412df173d9SMahesh Salgaonkar 	if (!fdm_active || !fw_dump.fadumphdr_addr)
9422df173d9SMahesh Salgaonkar 		return -EINVAL;
9432df173d9SMahesh Salgaonkar 
9442df173d9SMahesh Salgaonkar 	/* Check if the dump data is valid. */
945408cddd9SHari Bathini 	if ((be16_to_cpu(fdm_active->header.dump_status_flag) == FADUMP_ERROR_FLAG) ||
946ebaeb5aeSMahesh Salgaonkar 			(fdm_active->cpu_state_data.error_flags != 0) ||
9472df173d9SMahesh Salgaonkar 			(fdm_active->rmr_region.error_flags != 0)) {
9482df173d9SMahesh Salgaonkar 		printk(KERN_ERR "Dump taken by platform is not valid\n");
9492df173d9SMahesh Salgaonkar 		return -EINVAL;
9502df173d9SMahesh Salgaonkar 	}
951ebaeb5aeSMahesh Salgaonkar 	if ((fdm_active->rmr_region.bytes_dumped !=
952ebaeb5aeSMahesh Salgaonkar 			fdm_active->rmr_region.source_len) ||
953ebaeb5aeSMahesh Salgaonkar 			!fdm_active->cpu_state_data.bytes_dumped) {
9542df173d9SMahesh Salgaonkar 		printk(KERN_ERR "Dump taken by platform is incomplete\n");
9552df173d9SMahesh Salgaonkar 		return -EINVAL;
9562df173d9SMahesh Salgaonkar 	}
9572df173d9SMahesh Salgaonkar 
9582df173d9SMahesh Salgaonkar 	/* Validate the fadump crash info header */
9592df173d9SMahesh Salgaonkar 	fdh = __va(fw_dump.fadumphdr_addr);
9602df173d9SMahesh Salgaonkar 	if (fdh->magic_number != FADUMP_CRASH_INFO_MAGIC) {
9612df173d9SMahesh Salgaonkar 		printk(KERN_ERR "Crash info header is not valid.\n");
9622df173d9SMahesh Salgaonkar 		return -EINVAL;
9632df173d9SMahesh Salgaonkar 	}
9642df173d9SMahesh Salgaonkar 
965ebaeb5aeSMahesh Salgaonkar 	rc = fadump_build_cpu_notes(fdm_active);
966ebaeb5aeSMahesh Salgaonkar 	if (rc)
967ebaeb5aeSMahesh Salgaonkar 		return rc;
968ebaeb5aeSMahesh Salgaonkar 
9692df173d9SMahesh Salgaonkar 	/*
9702df173d9SMahesh Salgaonkar 	 * We are done validating dump info and elfcore header is now ready
9712df173d9SMahesh Salgaonkar 	 * to be exported. set elfcorehdr_addr so that vmcore module will
9722df173d9SMahesh Salgaonkar 	 * export the elfcore header through '/proc/vmcore'.
9732df173d9SMahesh Salgaonkar 	 */
9742df173d9SMahesh Salgaonkar 	elfcorehdr_addr = fdh->elfcorehdr_addr;
9752df173d9SMahesh Salgaonkar 
9762df173d9SMahesh Salgaonkar 	return 0;
9772df173d9SMahesh Salgaonkar }
9782df173d9SMahesh Salgaonkar 
9791bd6a1c4SHari Bathini static void free_crash_memory_ranges(void)
9801bd6a1c4SHari Bathini {
9811bd6a1c4SHari Bathini 	kfree(crash_memory_ranges);
9821bd6a1c4SHari Bathini 	crash_memory_ranges = NULL;
9831bd6a1c4SHari Bathini 	crash_memory_ranges_size = 0;
9841bd6a1c4SHari Bathini 	max_crash_mem_ranges = 0;
9851bd6a1c4SHari Bathini }
9861bd6a1c4SHari Bathini 
9871bd6a1c4SHari Bathini /*
9881bd6a1c4SHari Bathini  * Allocate or reallocate crash memory ranges array in incremental units
9891bd6a1c4SHari Bathini  * of PAGE_SIZE.
9901bd6a1c4SHari Bathini  */
9911bd6a1c4SHari Bathini static int allocate_crash_memory_ranges(void)
9921bd6a1c4SHari Bathini {
9931bd6a1c4SHari Bathini 	struct fad_crash_memory_ranges *new_array;
9941bd6a1c4SHari Bathini 	u64 new_size;
9951bd6a1c4SHari Bathini 
9961bd6a1c4SHari Bathini 	new_size = crash_memory_ranges_size + PAGE_SIZE;
9971bd6a1c4SHari Bathini 	pr_debug("Allocating %llu bytes of memory for crash memory ranges\n",
9981bd6a1c4SHari Bathini 		 new_size);
9991bd6a1c4SHari Bathini 
10001bd6a1c4SHari Bathini 	new_array = krealloc(crash_memory_ranges, new_size, GFP_KERNEL);
10011bd6a1c4SHari Bathini 	if (new_array == NULL) {
10021bd6a1c4SHari Bathini 		pr_err("Insufficient memory for setting up crash memory ranges\n");
10031bd6a1c4SHari Bathini 		free_crash_memory_ranges();
10041bd6a1c4SHari Bathini 		return -ENOMEM;
10051bd6a1c4SHari Bathini 	}
10061bd6a1c4SHari Bathini 
10071bd6a1c4SHari Bathini 	crash_memory_ranges = new_array;
10081bd6a1c4SHari Bathini 	crash_memory_ranges_size = new_size;
10091bd6a1c4SHari Bathini 	max_crash_mem_ranges = (new_size /
10101bd6a1c4SHari Bathini 				sizeof(struct fad_crash_memory_ranges));
10111bd6a1c4SHari Bathini 	return 0;
10121bd6a1c4SHari Bathini }
10131bd6a1c4SHari Bathini 
10141bd6a1c4SHari Bathini static inline int fadump_add_crash_memory(unsigned long long base,
10152df173d9SMahesh Salgaonkar 					  unsigned long long end)
10162df173d9SMahesh Salgaonkar {
1017ced1bf52SHari Bathini 	u64  start, size;
1018ced1bf52SHari Bathini 	bool is_adjacent = false;
1019ced1bf52SHari Bathini 
10202df173d9SMahesh Salgaonkar 	if (base == end)
10211bd6a1c4SHari Bathini 		return 0;
10221bd6a1c4SHari Bathini 
1023ced1bf52SHari Bathini 	/*
1024ced1bf52SHari Bathini 	 * Fold adjacent memory ranges to bring down the memory ranges/
1025ced1bf52SHari Bathini 	 * PT_LOAD segments count.
1026ced1bf52SHari Bathini 	 */
1027ced1bf52SHari Bathini 	if (crash_mem_ranges) {
1028ced1bf52SHari Bathini 		start = crash_memory_ranges[crash_mem_ranges - 1].base;
1029ced1bf52SHari Bathini 		size = crash_memory_ranges[crash_mem_ranges - 1].size;
1030ced1bf52SHari Bathini 
1031ced1bf52SHari Bathini 		if ((start + size) == base)
1032ced1bf52SHari Bathini 			is_adjacent = true;
1033ced1bf52SHari Bathini 	}
1034ced1bf52SHari Bathini 	if (!is_adjacent) {
1035ced1bf52SHari Bathini 		/* resize the array on reaching the limit */
10361bd6a1c4SHari Bathini 		if (crash_mem_ranges == max_crash_mem_ranges) {
10371bd6a1c4SHari Bathini 			int ret;
10381bd6a1c4SHari Bathini 
10391bd6a1c4SHari Bathini 			ret = allocate_crash_memory_ranges();
10401bd6a1c4SHari Bathini 			if (ret)
10411bd6a1c4SHari Bathini 				return ret;
10421bd6a1c4SHari Bathini 		}
10432df173d9SMahesh Salgaonkar 
1044ced1bf52SHari Bathini 		start = base;
1045ced1bf52SHari Bathini 		crash_memory_ranges[crash_mem_ranges].base = start;
10462df173d9SMahesh Salgaonkar 		crash_mem_ranges++;
1047ced1bf52SHari Bathini 	}
1048ced1bf52SHari Bathini 
1049ced1bf52SHari Bathini 	crash_memory_ranges[crash_mem_ranges - 1].size = (end - start);
1050ced1bf52SHari Bathini 	pr_debug("crash_memory_range[%d] [%#016llx-%#016llx], %#llx bytes\n",
1051ced1bf52SHari Bathini 		(crash_mem_ranges - 1), start, end - 1, (end - start));
10521bd6a1c4SHari Bathini 	return 0;
10532df173d9SMahesh Salgaonkar }
10542df173d9SMahesh Salgaonkar 
10551bd6a1c4SHari Bathini static int fadump_exclude_reserved_area(unsigned long long start,
10562df173d9SMahesh Salgaonkar 					unsigned long long end)
10572df173d9SMahesh Salgaonkar {
10582df173d9SMahesh Salgaonkar 	unsigned long long ra_start, ra_end;
10591bd6a1c4SHari Bathini 	int ret = 0;
10602df173d9SMahesh Salgaonkar 
10612df173d9SMahesh Salgaonkar 	ra_start = fw_dump.reserve_dump_area_start;
10622df173d9SMahesh Salgaonkar 	ra_end = ra_start + fw_dump.reserve_dump_area_size;
10632df173d9SMahesh Salgaonkar 
10642df173d9SMahesh Salgaonkar 	if ((ra_start < end) && (ra_end > start)) {
10652df173d9SMahesh Salgaonkar 		if ((start < ra_start) && (end > ra_end)) {
10661bd6a1c4SHari Bathini 			ret = fadump_add_crash_memory(start, ra_start);
10671bd6a1c4SHari Bathini 			if (ret)
10681bd6a1c4SHari Bathini 				return ret;
10691bd6a1c4SHari Bathini 
10701bd6a1c4SHari Bathini 			ret = fadump_add_crash_memory(ra_end, end);
10712df173d9SMahesh Salgaonkar 		} else if (start < ra_start) {
10721bd6a1c4SHari Bathini 			ret = fadump_add_crash_memory(start, ra_start);
10732df173d9SMahesh Salgaonkar 		} else if (ra_end < end) {
10741bd6a1c4SHari Bathini 			ret = fadump_add_crash_memory(ra_end, end);
10752df173d9SMahesh Salgaonkar 		}
10762df173d9SMahesh Salgaonkar 	} else
10771bd6a1c4SHari Bathini 		ret = fadump_add_crash_memory(start, end);
10781bd6a1c4SHari Bathini 
10791bd6a1c4SHari Bathini 	return ret;
10802df173d9SMahesh Salgaonkar }
10812df173d9SMahesh Salgaonkar 
10822df173d9SMahesh Salgaonkar static int fadump_init_elfcore_header(char *bufp)
10832df173d9SMahesh Salgaonkar {
10842df173d9SMahesh Salgaonkar 	struct elfhdr *elf;
10852df173d9SMahesh Salgaonkar 
10862df173d9SMahesh Salgaonkar 	elf = (struct elfhdr *) bufp;
10872df173d9SMahesh Salgaonkar 	bufp += sizeof(struct elfhdr);
10882df173d9SMahesh Salgaonkar 	memcpy(elf->e_ident, ELFMAG, SELFMAG);
10892df173d9SMahesh Salgaonkar 	elf->e_ident[EI_CLASS] = ELF_CLASS;
10902df173d9SMahesh Salgaonkar 	elf->e_ident[EI_DATA] = ELF_DATA;
10912df173d9SMahesh Salgaonkar 	elf->e_ident[EI_VERSION] = EV_CURRENT;
10922df173d9SMahesh Salgaonkar 	elf->e_ident[EI_OSABI] = ELF_OSABI;
10932df173d9SMahesh Salgaonkar 	memset(elf->e_ident+EI_PAD, 0, EI_NIDENT-EI_PAD);
10942df173d9SMahesh Salgaonkar 	elf->e_type = ET_CORE;
10952df173d9SMahesh Salgaonkar 	elf->e_machine = ELF_ARCH;
10962df173d9SMahesh Salgaonkar 	elf->e_version = EV_CURRENT;
10972df173d9SMahesh Salgaonkar 	elf->e_entry = 0;
10982df173d9SMahesh Salgaonkar 	elf->e_phoff = sizeof(struct elfhdr);
10992df173d9SMahesh Salgaonkar 	elf->e_shoff = 0;
1100d8bced27SDaniel Axtens #if defined(_CALL_ELF)
1101d8bced27SDaniel Axtens 	elf->e_flags = _CALL_ELF;
1102d8bced27SDaniel Axtens #else
1103d8bced27SDaniel Axtens 	elf->e_flags = 0;
1104d8bced27SDaniel Axtens #endif
11052df173d9SMahesh Salgaonkar 	elf->e_ehsize = sizeof(struct elfhdr);
11062df173d9SMahesh Salgaonkar 	elf->e_phentsize = sizeof(struct elf_phdr);
11072df173d9SMahesh Salgaonkar 	elf->e_phnum = 0;
11082df173d9SMahesh Salgaonkar 	elf->e_shentsize = 0;
11092df173d9SMahesh Salgaonkar 	elf->e_shnum = 0;
11102df173d9SMahesh Salgaonkar 	elf->e_shstrndx = 0;
11112df173d9SMahesh Salgaonkar 
11122df173d9SMahesh Salgaonkar 	return 0;
11132df173d9SMahesh Salgaonkar }
11142df173d9SMahesh Salgaonkar 
11152df173d9SMahesh Salgaonkar /*
11162df173d9SMahesh Salgaonkar  * Traverse through memblock structure and setup crash memory ranges. These
11172df173d9SMahesh Salgaonkar  * ranges will be used create PT_LOAD program headers in elfcore header.
11182df173d9SMahesh Salgaonkar  */
11191bd6a1c4SHari Bathini static int fadump_setup_crash_memory_ranges(void)
11202df173d9SMahesh Salgaonkar {
11212df173d9SMahesh Salgaonkar 	struct memblock_region *reg;
11222df173d9SMahesh Salgaonkar 	unsigned long long start, end;
11231bd6a1c4SHari Bathini 	int ret;
11242df173d9SMahesh Salgaonkar 
11252df173d9SMahesh Salgaonkar 	pr_debug("Setup crash memory ranges.\n");
11262df173d9SMahesh Salgaonkar 	crash_mem_ranges = 0;
1127ced1bf52SHari Bathini 
11282df173d9SMahesh Salgaonkar 	/*
11292df173d9SMahesh Salgaonkar 	 * add the first memory chunk (RMA_START through boot_memory_size) as
11302df173d9SMahesh Salgaonkar 	 * a separate memory chunk. The reason is, at the time crash firmware
11312df173d9SMahesh Salgaonkar 	 * will move the content of this memory chunk to different location
11322df173d9SMahesh Salgaonkar 	 * specified during fadump registration. We need to create a separate
11332df173d9SMahesh Salgaonkar 	 * program header for this chunk with the correct offset.
11342df173d9SMahesh Salgaonkar 	 */
11351bd6a1c4SHari Bathini 	ret = fadump_add_crash_memory(RMA_START, fw_dump.boot_memory_size);
11361bd6a1c4SHari Bathini 	if (ret)
11371bd6a1c4SHari Bathini 		return ret;
11382df173d9SMahesh Salgaonkar 
11392df173d9SMahesh Salgaonkar 	for_each_memblock(memory, reg) {
11402df173d9SMahesh Salgaonkar 		start = (unsigned long long)reg->base;
11412df173d9SMahesh Salgaonkar 		end = start + (unsigned long long)reg->size;
1142a77af552SHari Bathini 
1143a77af552SHari Bathini 		/*
1144a77af552SHari Bathini 		 * skip the first memory chunk that is already added (RMA_START
1145a77af552SHari Bathini 		 * through boot_memory_size). This logic needs a relook if and
1146a77af552SHari Bathini 		 * when RMA_START changes to a non-zero value.
1147a77af552SHari Bathini 		 */
1148a77af552SHari Bathini 		BUILD_BUG_ON(RMA_START != 0);
1149a77af552SHari Bathini 		if (start < fw_dump.boot_memory_size) {
1150a77af552SHari Bathini 			if (end > fw_dump.boot_memory_size)
11512df173d9SMahesh Salgaonkar 				start = fw_dump.boot_memory_size;
1152a77af552SHari Bathini 			else
1153a77af552SHari Bathini 				continue;
1154a77af552SHari Bathini 		}
11552df173d9SMahesh Salgaonkar 
11562df173d9SMahesh Salgaonkar 		/* add this range excluding the reserved dump area. */
11571bd6a1c4SHari Bathini 		ret = fadump_exclude_reserved_area(start, end);
11581bd6a1c4SHari Bathini 		if (ret)
11591bd6a1c4SHari Bathini 			return ret;
11602df173d9SMahesh Salgaonkar 	}
11611bd6a1c4SHari Bathini 
11621bd6a1c4SHari Bathini 	return 0;
11632df173d9SMahesh Salgaonkar }
11642df173d9SMahesh Salgaonkar 
1165d34c5f26SMahesh Salgaonkar /*
1166d34c5f26SMahesh Salgaonkar  * If the given physical address falls within the boot memory region then
1167d34c5f26SMahesh Salgaonkar  * return the relocated address that points to the dump region reserved
1168d34c5f26SMahesh Salgaonkar  * for saving initial boot memory contents.
1169d34c5f26SMahesh Salgaonkar  */
1170d34c5f26SMahesh Salgaonkar static inline unsigned long fadump_relocate(unsigned long paddr)
1171d34c5f26SMahesh Salgaonkar {
1172d34c5f26SMahesh Salgaonkar 	if (paddr > RMA_START && paddr < fw_dump.boot_memory_size)
1173408cddd9SHari Bathini 		return be64_to_cpu(fdm.rmr_region.destination_address) + paddr;
1174d34c5f26SMahesh Salgaonkar 	else
1175d34c5f26SMahesh Salgaonkar 		return paddr;
1176d34c5f26SMahesh Salgaonkar }
1177d34c5f26SMahesh Salgaonkar 
11782df173d9SMahesh Salgaonkar static int fadump_create_elfcore_headers(char *bufp)
11792df173d9SMahesh Salgaonkar {
11802df173d9SMahesh Salgaonkar 	struct elfhdr *elf;
11812df173d9SMahesh Salgaonkar 	struct elf_phdr *phdr;
11822df173d9SMahesh Salgaonkar 	int i;
11832df173d9SMahesh Salgaonkar 
11842df173d9SMahesh Salgaonkar 	fadump_init_elfcore_header(bufp);
11852df173d9SMahesh Salgaonkar 	elf = (struct elfhdr *)bufp;
11862df173d9SMahesh Salgaonkar 	bufp += sizeof(struct elfhdr);
11872df173d9SMahesh Salgaonkar 
1188ebaeb5aeSMahesh Salgaonkar 	/*
1189ebaeb5aeSMahesh Salgaonkar 	 * setup ELF PT_NOTE, place holder for cpu notes info. The notes info
1190ebaeb5aeSMahesh Salgaonkar 	 * will be populated during second kernel boot after crash. Hence
1191ebaeb5aeSMahesh Salgaonkar 	 * this PT_NOTE will always be the first elf note.
1192ebaeb5aeSMahesh Salgaonkar 	 *
1193ebaeb5aeSMahesh Salgaonkar 	 * NOTE: Any new ELF note addition should be placed after this note.
1194ebaeb5aeSMahesh Salgaonkar 	 */
1195ebaeb5aeSMahesh Salgaonkar 	phdr = (struct elf_phdr *)bufp;
1196ebaeb5aeSMahesh Salgaonkar 	bufp += sizeof(struct elf_phdr);
1197ebaeb5aeSMahesh Salgaonkar 	phdr->p_type = PT_NOTE;
1198ebaeb5aeSMahesh Salgaonkar 	phdr->p_flags = 0;
1199ebaeb5aeSMahesh Salgaonkar 	phdr->p_vaddr = 0;
1200ebaeb5aeSMahesh Salgaonkar 	phdr->p_align = 0;
1201ebaeb5aeSMahesh Salgaonkar 
1202ebaeb5aeSMahesh Salgaonkar 	phdr->p_offset = 0;
1203ebaeb5aeSMahesh Salgaonkar 	phdr->p_paddr = 0;
1204ebaeb5aeSMahesh Salgaonkar 	phdr->p_filesz = 0;
1205ebaeb5aeSMahesh Salgaonkar 	phdr->p_memsz = 0;
1206ebaeb5aeSMahesh Salgaonkar 
1207ebaeb5aeSMahesh Salgaonkar 	(elf->e_phnum)++;
1208ebaeb5aeSMahesh Salgaonkar 
1209d34c5f26SMahesh Salgaonkar 	/* setup ELF PT_NOTE for vmcoreinfo */
1210d34c5f26SMahesh Salgaonkar 	phdr = (struct elf_phdr *)bufp;
1211d34c5f26SMahesh Salgaonkar 	bufp += sizeof(struct elf_phdr);
1212d34c5f26SMahesh Salgaonkar 	phdr->p_type	= PT_NOTE;
1213d34c5f26SMahesh Salgaonkar 	phdr->p_flags	= 0;
1214d34c5f26SMahesh Salgaonkar 	phdr->p_vaddr	= 0;
1215d34c5f26SMahesh Salgaonkar 	phdr->p_align	= 0;
1216d34c5f26SMahesh Salgaonkar 
1217d34c5f26SMahesh Salgaonkar 	phdr->p_paddr	= fadump_relocate(paddr_vmcoreinfo_note());
1218d34c5f26SMahesh Salgaonkar 	phdr->p_offset	= phdr->p_paddr;
12195203f499SXunlei Pang 	phdr->p_memsz	= phdr->p_filesz = VMCOREINFO_NOTE_SIZE;
1220d34c5f26SMahesh Salgaonkar 
1221d34c5f26SMahesh Salgaonkar 	/* Increment number of program headers. */
1222d34c5f26SMahesh Salgaonkar 	(elf->e_phnum)++;
1223d34c5f26SMahesh Salgaonkar 
12242df173d9SMahesh Salgaonkar 	/* setup PT_LOAD sections. */
12252df173d9SMahesh Salgaonkar 
12262df173d9SMahesh Salgaonkar 	for (i = 0; i < crash_mem_ranges; i++) {
12272df173d9SMahesh Salgaonkar 		unsigned long long mbase, msize;
12282df173d9SMahesh Salgaonkar 		mbase = crash_memory_ranges[i].base;
12292df173d9SMahesh Salgaonkar 		msize = crash_memory_ranges[i].size;
12302df173d9SMahesh Salgaonkar 
12312df173d9SMahesh Salgaonkar 		if (!msize)
12322df173d9SMahesh Salgaonkar 			continue;
12332df173d9SMahesh Salgaonkar 
12342df173d9SMahesh Salgaonkar 		phdr = (struct elf_phdr *)bufp;
12352df173d9SMahesh Salgaonkar 		bufp += sizeof(struct elf_phdr);
12362df173d9SMahesh Salgaonkar 		phdr->p_type	= PT_LOAD;
12372df173d9SMahesh Salgaonkar 		phdr->p_flags	= PF_R|PF_W|PF_X;
12382df173d9SMahesh Salgaonkar 		phdr->p_offset	= mbase;
12392df173d9SMahesh Salgaonkar 
12402df173d9SMahesh Salgaonkar 		if (mbase == RMA_START) {
12412df173d9SMahesh Salgaonkar 			/*
12422df173d9SMahesh Salgaonkar 			 * The entire RMA region will be moved by firmware
12432df173d9SMahesh Salgaonkar 			 * to the specified destination_address. Hence set
12442df173d9SMahesh Salgaonkar 			 * the correct offset.
12452df173d9SMahesh Salgaonkar 			 */
1246408cddd9SHari Bathini 			phdr->p_offset = be64_to_cpu(fdm.rmr_region.destination_address);
12472df173d9SMahesh Salgaonkar 		}
12482df173d9SMahesh Salgaonkar 
12492df173d9SMahesh Salgaonkar 		phdr->p_paddr = mbase;
12502df173d9SMahesh Salgaonkar 		phdr->p_vaddr = (unsigned long)__va(mbase);
12512df173d9SMahesh Salgaonkar 		phdr->p_filesz = msize;
12522df173d9SMahesh Salgaonkar 		phdr->p_memsz = msize;
12532df173d9SMahesh Salgaonkar 		phdr->p_align = 0;
12542df173d9SMahesh Salgaonkar 
12552df173d9SMahesh Salgaonkar 		/* Increment number of program headers. */
12562df173d9SMahesh Salgaonkar 		(elf->e_phnum)++;
12572df173d9SMahesh Salgaonkar 	}
12582df173d9SMahesh Salgaonkar 	return 0;
12592df173d9SMahesh Salgaonkar }
12602df173d9SMahesh Salgaonkar 
12612df173d9SMahesh Salgaonkar static unsigned long init_fadump_header(unsigned long addr)
12622df173d9SMahesh Salgaonkar {
12632df173d9SMahesh Salgaonkar 	struct fadump_crash_info_header *fdh;
12642df173d9SMahesh Salgaonkar 
12652df173d9SMahesh Salgaonkar 	if (!addr)
12662df173d9SMahesh Salgaonkar 		return 0;
12672df173d9SMahesh Salgaonkar 
12682df173d9SMahesh Salgaonkar 	fw_dump.fadumphdr_addr = addr;
12692df173d9SMahesh Salgaonkar 	fdh = __va(addr);
12702df173d9SMahesh Salgaonkar 	addr += sizeof(struct fadump_crash_info_header);
12712df173d9SMahesh Salgaonkar 
12722df173d9SMahesh Salgaonkar 	memset(fdh, 0, sizeof(struct fadump_crash_info_header));
12732df173d9SMahesh Salgaonkar 	fdh->magic_number = FADUMP_CRASH_INFO_MAGIC;
12742df173d9SMahesh Salgaonkar 	fdh->elfcorehdr_addr = addr;
1275ebaeb5aeSMahesh Salgaonkar 	/* We will set the crashing cpu id in crash_fadump() during crash. */
1276ebaeb5aeSMahesh Salgaonkar 	fdh->crashing_cpu = CPU_UNKNOWN;
12772df173d9SMahesh Salgaonkar 
12782df173d9SMahesh Salgaonkar 	return addr;
12792df173d9SMahesh Salgaonkar }
12802df173d9SMahesh Salgaonkar 
128198b8cd7fSMichal Suchanek static int register_fadump(void)
12823ccc00a7SMahesh Salgaonkar {
12832df173d9SMahesh Salgaonkar 	unsigned long addr;
12842df173d9SMahesh Salgaonkar 	void *vaddr;
12851bd6a1c4SHari Bathini 	int ret;
12862df173d9SMahesh Salgaonkar 
12873ccc00a7SMahesh Salgaonkar 	/*
12883ccc00a7SMahesh Salgaonkar 	 * If no memory is reserved then we can not register for firmware-
12893ccc00a7SMahesh Salgaonkar 	 * assisted dump.
12903ccc00a7SMahesh Salgaonkar 	 */
12913ccc00a7SMahesh Salgaonkar 	if (!fw_dump.reserve_dump_area_size)
129298b8cd7fSMichal Suchanek 		return -ENODEV;
12933ccc00a7SMahesh Salgaonkar 
12941bd6a1c4SHari Bathini 	ret = fadump_setup_crash_memory_ranges();
12951bd6a1c4SHari Bathini 	if (ret)
12961bd6a1c4SHari Bathini 		return ret;
12972df173d9SMahesh Salgaonkar 
1298408cddd9SHari Bathini 	addr = be64_to_cpu(fdm.rmr_region.destination_address) + be64_to_cpu(fdm.rmr_region.source_len);
12992df173d9SMahesh Salgaonkar 	/* Initialize fadump crash info header. */
13002df173d9SMahesh Salgaonkar 	addr = init_fadump_header(addr);
13012df173d9SMahesh Salgaonkar 	vaddr = __va(addr);
13022df173d9SMahesh Salgaonkar 
13032df173d9SMahesh Salgaonkar 	pr_debug("Creating ELF core headers at %#016lx\n", addr);
13042df173d9SMahesh Salgaonkar 	fadump_create_elfcore_headers(vaddr);
13052df173d9SMahesh Salgaonkar 
13063ccc00a7SMahesh Salgaonkar 	/* register the future kernel dump with firmware. */
130798b8cd7fSMichal Suchanek 	return register_fw_dump(&fdm);
13083ccc00a7SMahesh Salgaonkar }
13093ccc00a7SMahesh Salgaonkar 
13103ccc00a7SMahesh Salgaonkar static int fadump_unregister_dump(struct fadump_mem_struct *fdm)
13113ccc00a7SMahesh Salgaonkar {
13123ccc00a7SMahesh Salgaonkar 	int rc = 0;
13133ccc00a7SMahesh Salgaonkar 	unsigned int wait_time;
13143ccc00a7SMahesh Salgaonkar 
13153ccc00a7SMahesh Salgaonkar 	pr_debug("Un-register firmware-assisted dump\n");
13163ccc00a7SMahesh Salgaonkar 
13173ccc00a7SMahesh Salgaonkar 	/* TODO: Add upper time limit for the delay */
13183ccc00a7SMahesh Salgaonkar 	do {
13193ccc00a7SMahesh Salgaonkar 		rc = rtas_call(fw_dump.ibm_configure_kernel_dump, 3, 1, NULL,
13203ccc00a7SMahesh Salgaonkar 			FADUMP_UNREGISTER, fdm,
13213ccc00a7SMahesh Salgaonkar 			sizeof(struct fadump_mem_struct));
13223ccc00a7SMahesh Salgaonkar 
13233ccc00a7SMahesh Salgaonkar 		wait_time = rtas_busy_delay_time(rc);
13243ccc00a7SMahesh Salgaonkar 		if (wait_time)
13253ccc00a7SMahesh Salgaonkar 			mdelay(wait_time);
13263ccc00a7SMahesh Salgaonkar 	} while (wait_time);
13273ccc00a7SMahesh Salgaonkar 
13283ccc00a7SMahesh Salgaonkar 	if (rc) {
13293ccc00a7SMahesh Salgaonkar 		printk(KERN_ERR "Failed to un-register firmware-assisted dump."
13303ccc00a7SMahesh Salgaonkar 			" unexpected error(%d).\n", rc);
13313ccc00a7SMahesh Salgaonkar 		return rc;
13323ccc00a7SMahesh Salgaonkar 	}
13333ccc00a7SMahesh Salgaonkar 	fw_dump.dump_registered = 0;
13343ccc00a7SMahesh Salgaonkar 	return 0;
13353ccc00a7SMahesh Salgaonkar }
13363ccc00a7SMahesh Salgaonkar 
1337a4e92ce8SMahesh Salgaonkar static int fadump_invalidate_dump(const struct fadump_mem_struct *fdm)
1338b500afffSMahesh Salgaonkar {
1339b500afffSMahesh Salgaonkar 	int rc = 0;
1340b500afffSMahesh Salgaonkar 	unsigned int wait_time;
1341b500afffSMahesh Salgaonkar 
1342b500afffSMahesh Salgaonkar 	pr_debug("Invalidating firmware-assisted dump registration\n");
1343b500afffSMahesh Salgaonkar 
1344b500afffSMahesh Salgaonkar 	/* TODO: Add upper time limit for the delay */
1345b500afffSMahesh Salgaonkar 	do {
1346b500afffSMahesh Salgaonkar 		rc = rtas_call(fw_dump.ibm_configure_kernel_dump, 3, 1, NULL,
1347b500afffSMahesh Salgaonkar 			FADUMP_INVALIDATE, fdm,
1348b500afffSMahesh Salgaonkar 			sizeof(struct fadump_mem_struct));
1349b500afffSMahesh Salgaonkar 
1350b500afffSMahesh Salgaonkar 		wait_time = rtas_busy_delay_time(rc);
1351b500afffSMahesh Salgaonkar 		if (wait_time)
1352b500afffSMahesh Salgaonkar 			mdelay(wait_time);
1353b500afffSMahesh Salgaonkar 	} while (wait_time);
1354b500afffSMahesh Salgaonkar 
1355b500afffSMahesh Salgaonkar 	if (rc) {
13564a03749fSColin Ian King 		pr_err("Failed to invalidate firmware-assisted dump registration. Unexpected error (%d).\n", rc);
1357b5b1cfc5SMichael Ellerman 		return rc;
1358b500afffSMahesh Salgaonkar 	}
1359b500afffSMahesh Salgaonkar 	fw_dump.dump_active = 0;
1360b500afffSMahesh Salgaonkar 	fdm_active = NULL;
1361b500afffSMahesh Salgaonkar 	return 0;
1362b500afffSMahesh Salgaonkar }
1363b500afffSMahesh Salgaonkar 
1364b500afffSMahesh Salgaonkar void fadump_cleanup(void)
1365b500afffSMahesh Salgaonkar {
1366b500afffSMahesh Salgaonkar 	/* Invalidate the registration only if dump is active. */
1367b500afffSMahesh Salgaonkar 	if (fw_dump.dump_active) {
1368a4e92ce8SMahesh Salgaonkar 		/* pass the same memory dump structure provided by platform */
1369a4e92ce8SMahesh Salgaonkar 		fadump_invalidate_dump(fdm_active);
1370722cde76SMahesh Salgaonkar 	} else if (fw_dump.dump_registered) {
1371722cde76SMahesh Salgaonkar 		/* Un-register Firmware-assisted dump if it was registered. */
1372722cde76SMahesh Salgaonkar 		fadump_unregister_dump(&fdm);
13731bd6a1c4SHari Bathini 		free_crash_memory_ranges();
1374b500afffSMahesh Salgaonkar 	}
1375b500afffSMahesh Salgaonkar }
1376b500afffSMahesh Salgaonkar 
137768fa6478SHari Bathini static void fadump_free_reserved_memory(unsigned long start_pfn,
137868fa6478SHari Bathini 					unsigned long end_pfn)
137968fa6478SHari Bathini {
138068fa6478SHari Bathini 	unsigned long pfn;
138168fa6478SHari Bathini 	unsigned long time_limit = jiffies + HZ;
138268fa6478SHari Bathini 
138368fa6478SHari Bathini 	pr_info("freeing reserved memory (0x%llx - 0x%llx)\n",
138468fa6478SHari Bathini 		PFN_PHYS(start_pfn), PFN_PHYS(end_pfn));
138568fa6478SHari Bathini 
138668fa6478SHari Bathini 	for (pfn = start_pfn; pfn < end_pfn; pfn++) {
138768fa6478SHari Bathini 		free_reserved_page(pfn_to_page(pfn));
138868fa6478SHari Bathini 
138968fa6478SHari Bathini 		if (time_after(jiffies, time_limit)) {
139068fa6478SHari Bathini 			cond_resched();
139168fa6478SHari Bathini 			time_limit = jiffies + HZ;
139268fa6478SHari Bathini 		}
139368fa6478SHari Bathini 	}
139468fa6478SHari Bathini }
139568fa6478SHari Bathini 
139668fa6478SHari Bathini /*
139768fa6478SHari Bathini  * Skip memory holes and free memory that was actually reserved.
139868fa6478SHari Bathini  */
139968fa6478SHari Bathini static void fadump_release_reserved_area(unsigned long start, unsigned long end)
140068fa6478SHari Bathini {
140168fa6478SHari Bathini 	struct memblock_region *reg;
140268fa6478SHari Bathini 	unsigned long tstart, tend;
140368fa6478SHari Bathini 	unsigned long start_pfn = PHYS_PFN(start);
140468fa6478SHari Bathini 	unsigned long end_pfn = PHYS_PFN(end);
140568fa6478SHari Bathini 
140668fa6478SHari Bathini 	for_each_memblock(memory, reg) {
140768fa6478SHari Bathini 		tstart = max(start_pfn, memblock_region_memory_base_pfn(reg));
140868fa6478SHari Bathini 		tend = min(end_pfn, memblock_region_memory_end_pfn(reg));
140968fa6478SHari Bathini 		if (tstart < tend) {
141068fa6478SHari Bathini 			fadump_free_reserved_memory(tstart, tend);
141168fa6478SHari Bathini 
141268fa6478SHari Bathini 			if (tend == end_pfn)
141368fa6478SHari Bathini 				break;
141468fa6478SHari Bathini 
141568fa6478SHari Bathini 			start_pfn = tend + 1;
141668fa6478SHari Bathini 		}
141768fa6478SHari Bathini 	}
141868fa6478SHari Bathini }
141968fa6478SHari Bathini 
1420b500afffSMahesh Salgaonkar /*
1421b500afffSMahesh Salgaonkar  * Release the memory that was reserved in early boot to preserve the memory
1422b500afffSMahesh Salgaonkar  * contents. The released memory will be available for general use.
1423b500afffSMahesh Salgaonkar  */
1424b500afffSMahesh Salgaonkar static void fadump_release_memory(unsigned long begin, unsigned long end)
1425b500afffSMahesh Salgaonkar {
1426b500afffSMahesh Salgaonkar 	unsigned long ra_start, ra_end;
1427b500afffSMahesh Salgaonkar 
1428b500afffSMahesh Salgaonkar 	ra_start = fw_dump.reserve_dump_area_start;
1429b500afffSMahesh Salgaonkar 	ra_end = ra_start + fw_dump.reserve_dump_area_size;
1430b500afffSMahesh Salgaonkar 
1431b500afffSMahesh Salgaonkar 	/*
1432b500afffSMahesh Salgaonkar 	 * exclude the dump reserve area. Will reuse it for next
1433b500afffSMahesh Salgaonkar 	 * fadump registration.
1434b500afffSMahesh Salgaonkar 	 */
143568fa6478SHari Bathini 	if (begin < ra_end && end > ra_start) {
143668fa6478SHari Bathini 		if (begin < ra_start)
143768fa6478SHari Bathini 			fadump_release_reserved_area(begin, ra_start);
143868fa6478SHari Bathini 		if (end > ra_end)
143968fa6478SHari Bathini 			fadump_release_reserved_area(ra_end, end);
144068fa6478SHari Bathini 	} else
144168fa6478SHari Bathini 		fadump_release_reserved_area(begin, end);
1442b500afffSMahesh Salgaonkar }
1443b500afffSMahesh Salgaonkar 
1444b500afffSMahesh Salgaonkar static void fadump_invalidate_release_mem(void)
1445b500afffSMahesh Salgaonkar {
1446b500afffSMahesh Salgaonkar 	unsigned long reserved_area_start, reserved_area_end;
1447b500afffSMahesh Salgaonkar 	unsigned long destination_address;
1448b500afffSMahesh Salgaonkar 
1449b500afffSMahesh Salgaonkar 	mutex_lock(&fadump_mutex);
1450b500afffSMahesh Salgaonkar 	if (!fw_dump.dump_active) {
1451b500afffSMahesh Salgaonkar 		mutex_unlock(&fadump_mutex);
1452b500afffSMahesh Salgaonkar 		return;
1453b500afffSMahesh Salgaonkar 	}
1454b500afffSMahesh Salgaonkar 
1455408cddd9SHari Bathini 	destination_address = be64_to_cpu(fdm_active->cpu_state_data.destination_address);
1456b500afffSMahesh Salgaonkar 	fadump_cleanup();
1457b500afffSMahesh Salgaonkar 	mutex_unlock(&fadump_mutex);
1458b500afffSMahesh Salgaonkar 
1459b500afffSMahesh Salgaonkar 	/*
1460b500afffSMahesh Salgaonkar 	 * Save the current reserved memory bounds we will require them
1461b500afffSMahesh Salgaonkar 	 * later for releasing the memory for general use.
1462b500afffSMahesh Salgaonkar 	 */
1463b500afffSMahesh Salgaonkar 	reserved_area_start = fw_dump.reserve_dump_area_start;
1464b500afffSMahesh Salgaonkar 	reserved_area_end = reserved_area_start +
1465b500afffSMahesh Salgaonkar 			fw_dump.reserve_dump_area_size;
1466b500afffSMahesh Salgaonkar 	/*
1467b500afffSMahesh Salgaonkar 	 * Setup reserve_dump_area_start and its size so that we can
1468b500afffSMahesh Salgaonkar 	 * reuse this reserved memory for Re-registration.
1469b500afffSMahesh Salgaonkar 	 */
1470b500afffSMahesh Salgaonkar 	fw_dump.reserve_dump_area_start = destination_address;
1471b500afffSMahesh Salgaonkar 	fw_dump.reserve_dump_area_size = get_fadump_area_size();
1472b500afffSMahesh Salgaonkar 
1473b500afffSMahesh Salgaonkar 	fadump_release_memory(reserved_area_start, reserved_area_end);
1474961cf26aSHari Bathini 	fadump_free_cpu_notes_buf();
1475961cf26aSHari Bathini 
1476b500afffSMahesh Salgaonkar 	/* Initialize the kernel dump memory structure for FAD registration. */
1477b500afffSMahesh Salgaonkar 	init_fadump_mem_struct(&fdm, fw_dump.reserve_dump_area_start);
1478b500afffSMahesh Salgaonkar }
1479b500afffSMahesh Salgaonkar 
1480b500afffSMahesh Salgaonkar static ssize_t fadump_release_memory_store(struct kobject *kobj,
1481b500afffSMahesh Salgaonkar 					struct kobj_attribute *attr,
1482b500afffSMahesh Salgaonkar 					const char *buf, size_t count)
1483b500afffSMahesh Salgaonkar {
1484dcdc4679SMichal Suchanek 	int input = -1;
1485dcdc4679SMichal Suchanek 
1486b500afffSMahesh Salgaonkar 	if (!fw_dump.dump_active)
1487b500afffSMahesh Salgaonkar 		return -EPERM;
1488b500afffSMahesh Salgaonkar 
1489dcdc4679SMichal Suchanek 	if (kstrtoint(buf, 0, &input))
1490dcdc4679SMichal Suchanek 		return -EINVAL;
1491dcdc4679SMichal Suchanek 
1492dcdc4679SMichal Suchanek 	if (input == 1) {
1493b500afffSMahesh Salgaonkar 		/*
1494b500afffSMahesh Salgaonkar 		 * Take away the '/proc/vmcore'. We are releasing the dump
1495b500afffSMahesh Salgaonkar 		 * memory, hence it will not be valid anymore.
1496b500afffSMahesh Salgaonkar 		 */
14972685f826SMichael Ellerman #ifdef CONFIG_PROC_VMCORE
1498b500afffSMahesh Salgaonkar 		vmcore_cleanup();
14992685f826SMichael Ellerman #endif
1500b500afffSMahesh Salgaonkar 		fadump_invalidate_release_mem();
1501b500afffSMahesh Salgaonkar 
1502b500afffSMahesh Salgaonkar 	} else
1503b500afffSMahesh Salgaonkar 		return -EINVAL;
1504b500afffSMahesh Salgaonkar 	return count;
1505b500afffSMahesh Salgaonkar }
1506b500afffSMahesh Salgaonkar 
15073ccc00a7SMahesh Salgaonkar static ssize_t fadump_enabled_show(struct kobject *kobj,
15083ccc00a7SMahesh Salgaonkar 					struct kobj_attribute *attr,
15093ccc00a7SMahesh Salgaonkar 					char *buf)
15103ccc00a7SMahesh Salgaonkar {
15113ccc00a7SMahesh Salgaonkar 	return sprintf(buf, "%d\n", fw_dump.fadump_enabled);
15123ccc00a7SMahesh Salgaonkar }
15133ccc00a7SMahesh Salgaonkar 
15143ccc00a7SMahesh Salgaonkar static ssize_t fadump_register_show(struct kobject *kobj,
15153ccc00a7SMahesh Salgaonkar 					struct kobj_attribute *attr,
15163ccc00a7SMahesh Salgaonkar 					char *buf)
15173ccc00a7SMahesh Salgaonkar {
15183ccc00a7SMahesh Salgaonkar 	return sprintf(buf, "%d\n", fw_dump.dump_registered);
15193ccc00a7SMahesh Salgaonkar }
15203ccc00a7SMahesh Salgaonkar 
15213ccc00a7SMahesh Salgaonkar static ssize_t fadump_register_store(struct kobject *kobj,
15223ccc00a7SMahesh Salgaonkar 					struct kobj_attribute *attr,
15233ccc00a7SMahesh Salgaonkar 					const char *buf, size_t count)
15243ccc00a7SMahesh Salgaonkar {
15253ccc00a7SMahesh Salgaonkar 	int ret = 0;
1526dcdc4679SMichal Suchanek 	int input = -1;
15273ccc00a7SMahesh Salgaonkar 
15283ccc00a7SMahesh Salgaonkar 	if (!fw_dump.fadump_enabled || fdm_active)
15293ccc00a7SMahesh Salgaonkar 		return -EPERM;
15303ccc00a7SMahesh Salgaonkar 
1531dcdc4679SMichal Suchanek 	if (kstrtoint(buf, 0, &input))
1532dcdc4679SMichal Suchanek 		return -EINVAL;
1533dcdc4679SMichal Suchanek 
15343ccc00a7SMahesh Salgaonkar 	mutex_lock(&fadump_mutex);
15353ccc00a7SMahesh Salgaonkar 
1536dcdc4679SMichal Suchanek 	switch (input) {
1537dcdc4679SMichal Suchanek 	case 0:
15383ccc00a7SMahesh Salgaonkar 		if (fw_dump.dump_registered == 0) {
15393ccc00a7SMahesh Salgaonkar 			goto unlock_out;
15403ccc00a7SMahesh Salgaonkar 		}
15413ccc00a7SMahesh Salgaonkar 		/* Un-register Firmware-assisted dump */
15423ccc00a7SMahesh Salgaonkar 		fadump_unregister_dump(&fdm);
15433ccc00a7SMahesh Salgaonkar 		break;
1544dcdc4679SMichal Suchanek 	case 1:
15453ccc00a7SMahesh Salgaonkar 		if (fw_dump.dump_registered == 1) {
15460823c68bSHari Bathini 			/* Un-register Firmware-assisted dump */
15470823c68bSHari Bathini 			fadump_unregister_dump(&fdm);
15483ccc00a7SMahesh Salgaonkar 		}
15493ccc00a7SMahesh Salgaonkar 		/* Register Firmware-assisted dump */
155098b8cd7fSMichal Suchanek 		ret = register_fadump();
15513ccc00a7SMahesh Salgaonkar 		break;
15523ccc00a7SMahesh Salgaonkar 	default:
15533ccc00a7SMahesh Salgaonkar 		ret = -EINVAL;
15543ccc00a7SMahesh Salgaonkar 		break;
15553ccc00a7SMahesh Salgaonkar 	}
15563ccc00a7SMahesh Salgaonkar 
15573ccc00a7SMahesh Salgaonkar unlock_out:
15583ccc00a7SMahesh Salgaonkar 	mutex_unlock(&fadump_mutex);
15593ccc00a7SMahesh Salgaonkar 	return ret < 0 ? ret : count;
15603ccc00a7SMahesh Salgaonkar }
15613ccc00a7SMahesh Salgaonkar 
15623ccc00a7SMahesh Salgaonkar static int fadump_region_show(struct seq_file *m, void *private)
15633ccc00a7SMahesh Salgaonkar {
15643ccc00a7SMahesh Salgaonkar 	const struct fadump_mem_struct *fdm_ptr;
15653ccc00a7SMahesh Salgaonkar 
15663ccc00a7SMahesh Salgaonkar 	if (!fw_dump.fadump_enabled)
15673ccc00a7SMahesh Salgaonkar 		return 0;
15683ccc00a7SMahesh Salgaonkar 
1569b500afffSMahesh Salgaonkar 	mutex_lock(&fadump_mutex);
15703ccc00a7SMahesh Salgaonkar 	if (fdm_active)
15713ccc00a7SMahesh Salgaonkar 		fdm_ptr = fdm_active;
1572b500afffSMahesh Salgaonkar 	else {
1573b500afffSMahesh Salgaonkar 		mutex_unlock(&fadump_mutex);
15743ccc00a7SMahesh Salgaonkar 		fdm_ptr = &fdm;
1575b500afffSMahesh Salgaonkar 	}
15763ccc00a7SMahesh Salgaonkar 
15773ccc00a7SMahesh Salgaonkar 	seq_printf(m,
15783ccc00a7SMahesh Salgaonkar 			"CPU : [%#016llx-%#016llx] %#llx bytes, "
15793ccc00a7SMahesh Salgaonkar 			"Dumped: %#llx\n",
1580408cddd9SHari Bathini 			be64_to_cpu(fdm_ptr->cpu_state_data.destination_address),
1581408cddd9SHari Bathini 			be64_to_cpu(fdm_ptr->cpu_state_data.destination_address) +
1582408cddd9SHari Bathini 			be64_to_cpu(fdm_ptr->cpu_state_data.source_len) - 1,
1583408cddd9SHari Bathini 			be64_to_cpu(fdm_ptr->cpu_state_data.source_len),
1584408cddd9SHari Bathini 			be64_to_cpu(fdm_ptr->cpu_state_data.bytes_dumped));
15853ccc00a7SMahesh Salgaonkar 	seq_printf(m,
15863ccc00a7SMahesh Salgaonkar 			"HPTE: [%#016llx-%#016llx] %#llx bytes, "
15873ccc00a7SMahesh Salgaonkar 			"Dumped: %#llx\n",
1588408cddd9SHari Bathini 			be64_to_cpu(fdm_ptr->hpte_region.destination_address),
1589408cddd9SHari Bathini 			be64_to_cpu(fdm_ptr->hpte_region.destination_address) +
1590408cddd9SHari Bathini 			be64_to_cpu(fdm_ptr->hpte_region.source_len) - 1,
1591408cddd9SHari Bathini 			be64_to_cpu(fdm_ptr->hpte_region.source_len),
1592408cddd9SHari Bathini 			be64_to_cpu(fdm_ptr->hpte_region.bytes_dumped));
15933ccc00a7SMahesh Salgaonkar 	seq_printf(m,
15943ccc00a7SMahesh Salgaonkar 			"DUMP: [%#016llx-%#016llx] %#llx bytes, "
15953ccc00a7SMahesh Salgaonkar 			"Dumped: %#llx\n",
1596408cddd9SHari Bathini 			be64_to_cpu(fdm_ptr->rmr_region.destination_address),
1597408cddd9SHari Bathini 			be64_to_cpu(fdm_ptr->rmr_region.destination_address) +
1598408cddd9SHari Bathini 			be64_to_cpu(fdm_ptr->rmr_region.source_len) - 1,
1599408cddd9SHari Bathini 			be64_to_cpu(fdm_ptr->rmr_region.source_len),
1600408cddd9SHari Bathini 			be64_to_cpu(fdm_ptr->rmr_region.bytes_dumped));
16013ccc00a7SMahesh Salgaonkar 
16023ccc00a7SMahesh Salgaonkar 	if (!fdm_active ||
16033ccc00a7SMahesh Salgaonkar 		(fw_dump.reserve_dump_area_start ==
1604408cddd9SHari Bathini 		be64_to_cpu(fdm_ptr->cpu_state_data.destination_address)))
1605b500afffSMahesh Salgaonkar 		goto out;
16063ccc00a7SMahesh Salgaonkar 
16073ccc00a7SMahesh Salgaonkar 	/* Dump is active. Show reserved memory region. */
16083ccc00a7SMahesh Salgaonkar 	seq_printf(m,
16093ccc00a7SMahesh Salgaonkar 			"    : [%#016llx-%#016llx] %#llx bytes, "
16103ccc00a7SMahesh Salgaonkar 			"Dumped: %#llx\n",
16113ccc00a7SMahesh Salgaonkar 			(unsigned long long)fw_dump.reserve_dump_area_start,
1612408cddd9SHari Bathini 			be64_to_cpu(fdm_ptr->cpu_state_data.destination_address) - 1,
1613408cddd9SHari Bathini 			be64_to_cpu(fdm_ptr->cpu_state_data.destination_address) -
16143ccc00a7SMahesh Salgaonkar 			fw_dump.reserve_dump_area_start,
1615408cddd9SHari Bathini 			be64_to_cpu(fdm_ptr->cpu_state_data.destination_address) -
16163ccc00a7SMahesh Salgaonkar 			fw_dump.reserve_dump_area_start);
1617b500afffSMahesh Salgaonkar out:
1618b500afffSMahesh Salgaonkar 	if (fdm_active)
1619b500afffSMahesh Salgaonkar 		mutex_unlock(&fadump_mutex);
16203ccc00a7SMahesh Salgaonkar 	return 0;
16213ccc00a7SMahesh Salgaonkar }
16223ccc00a7SMahesh Salgaonkar 
1623b500afffSMahesh Salgaonkar static struct kobj_attribute fadump_release_attr = __ATTR(fadump_release_mem,
1624b500afffSMahesh Salgaonkar 						0200, NULL,
1625b500afffSMahesh Salgaonkar 						fadump_release_memory_store);
16263ccc00a7SMahesh Salgaonkar static struct kobj_attribute fadump_attr = __ATTR(fadump_enabled,
16273ccc00a7SMahesh Salgaonkar 						0444, fadump_enabled_show,
16283ccc00a7SMahesh Salgaonkar 						NULL);
16293ccc00a7SMahesh Salgaonkar static struct kobj_attribute fadump_register_attr = __ATTR(fadump_registered,
16303ccc00a7SMahesh Salgaonkar 						0644, fadump_register_show,
16313ccc00a7SMahesh Salgaonkar 						fadump_register_store);
16323ccc00a7SMahesh Salgaonkar 
1633f6cee260SYangtao Li DEFINE_SHOW_ATTRIBUTE(fadump_region);
16343ccc00a7SMahesh Salgaonkar 
16353ccc00a7SMahesh Salgaonkar static void fadump_init_files(void)
16363ccc00a7SMahesh Salgaonkar {
16373ccc00a7SMahesh Salgaonkar 	struct dentry *debugfs_file;
16383ccc00a7SMahesh Salgaonkar 	int rc = 0;
16393ccc00a7SMahesh Salgaonkar 
16403ccc00a7SMahesh Salgaonkar 	rc = sysfs_create_file(kernel_kobj, &fadump_attr.attr);
16413ccc00a7SMahesh Salgaonkar 	if (rc)
16423ccc00a7SMahesh Salgaonkar 		printk(KERN_ERR "fadump: unable to create sysfs file"
16433ccc00a7SMahesh Salgaonkar 			" fadump_enabled (%d)\n", rc);
16443ccc00a7SMahesh Salgaonkar 
16453ccc00a7SMahesh Salgaonkar 	rc = sysfs_create_file(kernel_kobj, &fadump_register_attr.attr);
16463ccc00a7SMahesh Salgaonkar 	if (rc)
16473ccc00a7SMahesh Salgaonkar 		printk(KERN_ERR "fadump: unable to create sysfs file"
16483ccc00a7SMahesh Salgaonkar 			" fadump_registered (%d)\n", rc);
16493ccc00a7SMahesh Salgaonkar 
16503ccc00a7SMahesh Salgaonkar 	debugfs_file = debugfs_create_file("fadump_region", 0444,
16513ccc00a7SMahesh Salgaonkar 					powerpc_debugfs_root, NULL,
16523ccc00a7SMahesh Salgaonkar 					&fadump_region_fops);
16533ccc00a7SMahesh Salgaonkar 	if (!debugfs_file)
16543ccc00a7SMahesh Salgaonkar 		printk(KERN_ERR "fadump: unable to create debugfs file"
16553ccc00a7SMahesh Salgaonkar 				" fadump_region\n");
1656b500afffSMahesh Salgaonkar 
1657b500afffSMahesh Salgaonkar 	if (fw_dump.dump_active) {
1658b500afffSMahesh Salgaonkar 		rc = sysfs_create_file(kernel_kobj, &fadump_release_attr.attr);
1659b500afffSMahesh Salgaonkar 		if (rc)
1660b500afffSMahesh Salgaonkar 			printk(KERN_ERR "fadump: unable to create sysfs file"
1661b500afffSMahesh Salgaonkar 				" fadump_release_mem (%d)\n", rc);
1662b500afffSMahesh Salgaonkar 	}
16633ccc00a7SMahesh Salgaonkar 	return;
16643ccc00a7SMahesh Salgaonkar }
16653ccc00a7SMahesh Salgaonkar 
16663ccc00a7SMahesh Salgaonkar /*
16673ccc00a7SMahesh Salgaonkar  * Prepare for firmware-assisted dump.
16683ccc00a7SMahesh Salgaonkar  */
16693ccc00a7SMahesh Salgaonkar int __init setup_fadump(void)
16703ccc00a7SMahesh Salgaonkar {
16713ccc00a7SMahesh Salgaonkar 	if (!fw_dump.fadump_enabled)
16723ccc00a7SMahesh Salgaonkar 		return 0;
16733ccc00a7SMahesh Salgaonkar 
16743ccc00a7SMahesh Salgaonkar 	if (!fw_dump.fadump_supported) {
16753ccc00a7SMahesh Salgaonkar 		printk(KERN_ERR "Firmware-assisted dump is not supported on"
16763ccc00a7SMahesh Salgaonkar 			" this hardware\n");
16773ccc00a7SMahesh Salgaonkar 		return 0;
16783ccc00a7SMahesh Salgaonkar 	}
16793ccc00a7SMahesh Salgaonkar 
16803ccc00a7SMahesh Salgaonkar 	fadump_show_config();
16812df173d9SMahesh Salgaonkar 	/*
16822df173d9SMahesh Salgaonkar 	 * If dump data is available then see if it is valid and prepare for
16832df173d9SMahesh Salgaonkar 	 * saving it to the disk.
16842df173d9SMahesh Salgaonkar 	 */
1685b500afffSMahesh Salgaonkar 	if (fw_dump.dump_active) {
1686b500afffSMahesh Salgaonkar 		/*
1687b500afffSMahesh Salgaonkar 		 * if dump process fails then invalidate the registration
1688b500afffSMahesh Salgaonkar 		 * and release memory before proceeding for re-registration.
1689b500afffSMahesh Salgaonkar 		 */
1690b500afffSMahesh Salgaonkar 		if (process_fadump(fdm_active) < 0)
1691b500afffSMahesh Salgaonkar 			fadump_invalidate_release_mem();
1692b500afffSMahesh Salgaonkar 	}
16933ccc00a7SMahesh Salgaonkar 	/* Initialize the kernel dump memory structure for FAD registration. */
16942df173d9SMahesh Salgaonkar 	else if (fw_dump.reserve_dump_area_size)
16953ccc00a7SMahesh Salgaonkar 		init_fadump_mem_struct(&fdm, fw_dump.reserve_dump_area_start);
16963ccc00a7SMahesh Salgaonkar 	fadump_init_files();
16973ccc00a7SMahesh Salgaonkar 
16983ccc00a7SMahesh Salgaonkar 	return 1;
16993ccc00a7SMahesh Salgaonkar }
17003ccc00a7SMahesh Salgaonkar subsys_initcall(setup_fadump);
1701