From patchwork Fri Sep 8 03:16:14 2017 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: AKASHI Takahiro X-Patchwork-Id: 112004 Delivered-To: patch@linaro.org Received: by 10.140.94.239 with SMTP id g102csp939952qge; Thu, 7 Sep 2017 20:15:42 -0700 (PDT) X-Received: by 10.98.60.220 with SMTP id b89mr1587429pfk.82.1504840542339; Thu, 07 Sep 2017 20:15:42 -0700 (PDT) ARC-Seal: i=1; a=rsa-sha256; t=1504840542; cv=none; d=google.com; s=arc-20160816; b=gW2792XR/uJhYlUv3QjsXXhvgq1abiT/B6EKV2pBvnOPKw2rddeQfNDZcH0hAID0xD FzToW92LG6K+iAHqGAz+vbKAXObYxYy5n69PS1uw90EaEBQVzT9S6n2pUk/n4MOCmaUD jsAuKCUukOj7bMdFHcq4U0L24UC4wf7LrXm7VHvKgblrEjjZc3QCpfGcV1i8awho0P0U qkiYmuTza0GzRbK3LZ35PZqdBg2aIQg52Yt9DO35cq23nuqgZfk8n8GQ1bHyl1ZqLbvM CNPtA97/XR5jhCzXKUZpDQHhWMUAOYYcm5cLPbE0s+xqFRkBwwaAwcIwqVW1FWqLEJn3 m0YQ== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:sender:references:in-reply-to:message-id:date :subject:cc:to:from:dkim-signature:arc-authentication-results; bh=ZO7Txyt9h+yWUlN5tfcJbAmZdgMn7tCdFjqhxBDNmTM=; b=y91d4lSUGTDjk0iBf6VCE06yq08XQIxq6B4rFNuBY/GJnuYW73lWM0OSHxaUSqLe0c v1A7bIJiwn9KHY0qS4e/D6yDrkxx1gHlZin1B2uLb/qNjtALYXjrjMV28iuQmVQHQyLU fzjzzWPdKj/OjcnA2Sdd/n2npW2iAVRZcb3Tas61F3r1SH20/I14uZa56gE7hzEEJQ0b zMtEBfYDOoCCIDya8EIcQ7X2BX/fMC1dL0j49FyjQqIct7UmO1LCgOojnVwLP50P6VDK SMy98x5aTP0QA89SSTJGy1Y2mtUpuIvLv+AOdarLb5IvFvuxy2P18AcrQXOh6qpvBlUn 82Zg== ARC-Authentication-Results: i=1; mx.google.com; dkim=pass header.i=@linaro.org header.s=google header.b=LlTsNIB9; spf=pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=linaro.org Return-Path: Received: from vger.kernel.org (vger.kernel.org. [209.132.180.67]) by mx.google.com with ESMTP id n69si808100pfk.442.2017.09.07.20.15.42; Thu, 07 Sep 2017 20:15:42 -0700 (PDT) Received-SPF: pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) client-ip=209.132.180.67; Authentication-Results: mx.google.com; dkim=pass header.i=@linaro.org header.s=google header.b=LlTsNIB9; spf=pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=linaro.org Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S932169AbdIHDPj (ORCPT + 26 others); Thu, 7 Sep 2017 23:15:39 -0400 Received: from mail-pg0-f51.google.com ([74.125.83.51]:34901 "EHLO mail-pg0-f51.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1753804AbdIHDPg (ORCPT ); Thu, 7 Sep 2017 23:15:36 -0400 Received: by mail-pg0-f51.google.com with SMTP id 188so2774686pgb.2 for ; Thu, 07 Sep 2017 20:15:35 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=linaro.org; s=google; h=from:to:cc:subject:date:message-id:in-reply-to:references; bh=ZO7Txyt9h+yWUlN5tfcJbAmZdgMn7tCdFjqhxBDNmTM=; b=LlTsNIB9GlqJrNRxpgNlYcE0FuaLO8snkDOjdqz6OisLwO8FpYksMMT5OnHkd2vYEF im0/dbcVVs+ArAfreHlsXWyYWttYyJ924oz7S9bPc8WGfo2uyKVxaNMZAMXOygw40yfY 3G1qJ8iWFSw2Y3BXX1WZFqGo+7qoJjsdDEz9w= X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:cc:subject:date:message-id:in-reply-to :references; bh=ZO7Txyt9h+yWUlN5tfcJbAmZdgMn7tCdFjqhxBDNmTM=; b=A06l0o99SMznZqPsW4zEajVHeaHSg+k0Cpgg7H1OXPrc2OUiTL1hSc5q2A4WNtauaZ PlBuYJ+kWwgiPvJTmQ1H+9Qf1ic8bAGMb7VWAR9pyfFzzWIA58CcKqOGnlBqad8IhcFs llv09E+Q5xQ10ESRR7Cf/2UzFMURrMd4wn6ygjF/JyYd/iKzFVFy5nT0M0YgL/D9sasO vFu60XCFCP7CmbfbpIRxg70+YWZsjgzBEYsWzz3TM3gzLhtsDyceeT6rV1g+BDWMRAoc k+FCxtGtLqUDQYBHvTaZNf5kDNErJZp6FJOtdX1xCRUpwiPHWJwbxuoVopaEX513VdMO /nAQ== X-Gm-Message-State: AHPjjUgjlu86ePMXGBg+Kv0oyWAk/1Ofs4Wf+peR7Xgt/1r57JoXRL9F 44/jizVtdh/MWp3K X-Google-Smtp-Source: ADKCNb6yPmuBRjnU3zqsZVWj58VsL7ueOc0WDB/cLkCSsHYVrLhvq+2WbEinF5ESEhtj7mSW8OQUyw== X-Received: by 10.84.216.69 with SMTP id f5mr1744342plj.212.1504840535506; Thu, 07 Sep 2017 20:15:35 -0700 (PDT) Received: from linaro.org ([121.95.100.191]) by smtp.googlemail.com with ESMTPSA id m87sm1279013pfi.122.2017.09.07.20.15.34 (version=TLS1_2 cipher=ECDHE-RSA-AES128-GCM-SHA256 bits=128/128); Thu, 07 Sep 2017 20:15:35 -0700 (PDT) From: AKASHI Takahiro To: catalin.marinas@arm.com, will.deacon@arm.com, bauerman@linux.vnet.ibm.com, dhowells@redhat.com, vgoyal@redhat.com, herbert@gondor.apana.org.au, davem@davemloft.net, akpm@linux-foundation.org, mpe@ellerman.id.au, dyoung@redhat.com, bhe@redhat.com, arnd@arndb.de, ard.biesheuvel@linaro.org Cc: kexec@lists.infradead.org, linux-arm-kernel@lists.infradead.org, linux-kernel@vger.kernel.org, AKASHI Takahiro Subject: [PATCH 7/9] arm64: kexec_file: set up for crash dump adding elf core header Date: Fri, 8 Sep 2017 12:16:14 +0900 Message-Id: <20170908031616.17916-8-takahiro.akashi@linaro.org> X-Mailer: git-send-email 2.14.1 In-Reply-To: <20170908031616.17916-1-takahiro.akashi@linaro.org> References: <20170908031616.17916-1-takahiro.akashi@linaro.org> Sender: linux-kernel-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org load_crashdump_segments() creates and loads a memory segment of elf core header for crash dump. "linux,usable-memory-range" and "linux,elfcorehdr" will add to the 2nd kernel's device-tree blob. The logic of this cod is also from kexec-tools. Signed-off-by: AKASHI Takahiro Cc: Catalin Marinas Cc: Will Deacon --- arch/arm64/include/asm/kexec.h | 5 ++ arch/arm64/kernel/machine_kexec_file.c | 145 +++++++++++++++++++++++++++++++++ 2 files changed, 150 insertions(+) -- 2.14.1 diff --git a/arch/arm64/include/asm/kexec.h b/arch/arm64/include/asm/kexec.h index d74dc49670ad..66537de588fa 100644 --- a/arch/arm64/include/asm/kexec.h +++ b/arch/arm64/include/asm/kexec.h @@ -98,6 +98,10 @@ static inline void crash_post_resume(void) {} struct kimage_arch { void *dtb_buf; + /* Core ELF header buffer */ + void *elf_headers; + unsigned long elf_headers_sz; + unsigned long elf_load_addr; }; struct kimage; @@ -110,6 +114,7 @@ extern int load_other_segments(struct kimage *image, unsigned long kernel_load_addr, char *initrd, unsigned long initrd_len, char *cmdline, unsigned long cmdline_len); +extern int load_crashdump_segments(struct kimage *image); #endif #endif /* __ASSEMBLY__ */ diff --git a/arch/arm64/kernel/machine_kexec_file.c b/arch/arm64/kernel/machine_kexec_file.c index a6d2c006b4f7..62627f5440ff 100644 --- a/arch/arm64/kernel/machine_kexec_file.c +++ b/arch/arm64/kernel/machine_kexec_file.c @@ -99,6 +99,77 @@ int arch_kexec_walk_mem(struct kexec_buf *kbuf, int (*func)(u64, u64, void *)) return walk_system_ram_res(0, ULONG_MAX, kbuf, func); } +static int __init arch_kexec_file_init(void) +{ + /* Those values are used later on loading the kernel */ + __dt_root_addr_cells = dt_root_addr_cells; + __dt_root_size_cells = dt_root_size_cells; + + return 0; +} +late_initcall(arch_kexec_file_init); + +#define FDT_ALIGN(x, a) (((x) + (a) - 1) & ~((a) - 1)) +#define FDT_TAGALIGN(x) (FDT_ALIGN((x), FDT_TAGSIZE)) + +static int fdt_prop_len(const char *prop_name, int len) +{ + return (strlen(prop_name) + 1) + + sizeof(struct fdt_property) + + FDT_TAGALIGN(len); +} + +static bool cells_size_fitted(unsigned long base, unsigned long size) +{ + /* if *_cells >= 2, cells can hold 64-bit values anyway */ + if ((__dt_root_addr_cells == 1) && (base >= (1ULL << 32))) + return false; + + if ((__dt_root_size_cells == 1) && (size >= (1ULL << 32))) + return false; + + return true; +} + +static void fill_property(void *buf, u64 val64, int cells) +{ + u32 val32; + int i; + + if (cells == 1) { + val32 = cpu_to_fdt32((u32)val64); + memcpy(buf, &val32, sizeof(val32)); + } else { + for (i = 0; i < (cells * sizeof(u32) - sizeof(u64)); i++) + *(char *)buf++ = 0; + + val64 = cpu_to_fdt64(val64); + memcpy(buf, &val64, sizeof(val64)); + } +} + +static int fdt_setprop_range(void *fdt, int nodeoffset, const char *name, + unsigned long addr, unsigned long size) +{ + u64 range[2]; + void *prop; + size_t buf_size; + int result; + + prop = range; + buf_size = (__dt_root_addr_cells + __dt_root_size_cells) * sizeof(u32); + + fill_property(prop, addr, __dt_root_addr_cells); + prop += __dt_root_addr_cells * sizeof(u32); + + fill_property(prop, size, __dt_root_size_cells); + prop += __dt_root_size_cells * sizeof(u32); + + result = fdt_setprop(fdt, nodeoffset, name, range, buf_size); + + return result; +} + int setup_dtb(struct kimage *image, unsigned long initrd_load_addr, unsigned long initrd_len, char *cmdline, unsigned long cmdline_len, @@ -111,10 +182,26 @@ int setup_dtb(struct kimage *image, int range_len; int ret; + /* check ranges against root's #address-cells and #size-cells */ + if (image->type == KEXEC_TYPE_CRASH && + (!cells_size_fitted(image->arch.elf_load_addr, + image->arch.elf_headers_sz) || + !cells_size_fitted(crashk_res.start, + crashk_res.end - crashk_res.start + 1))) { + pr_err("Crash memory region doesn't fit into DT's root cell sizes.\n"); + ret = -EINVAL; + goto out_err; + } + /* duplicate dt blob */ buf_size = fdt_totalsize(initial_boot_params); range_len = (__dt_root_addr_cells + __dt_root_size_cells) * sizeof(u32); + if (image->type == KEXEC_TYPE_CRASH) + buf_size += fdt_prop_len("linux,elfcorehdr", range_len) + + fdt_prop_len("linux,usable-memory-range", + range_len); + if (initrd_load_addr) buf_size += fdt_prop_len("initrd-start", sizeof(u64)) + fdt_prop_len("initrd-end", sizeof(u64)); @@ -136,6 +223,23 @@ int setup_dtb(struct kimage *image, if (nodeoffset < 0) goto out_err; + if (image->type == KEXEC_TYPE_CRASH) { + /* add linux,elfcorehdr */ + ret = fdt_setprop_range(buf, nodeoffset, "linux,elfcorehdr", + image->arch.elf_load_addr, + image->arch.elf_headers_sz); + if (ret) + goto out_err; + + /* add linux,usable-memory-range */ + ret = fdt_setprop_range(buf, nodeoffset, + "linux,usable-memory-range", + crashk_res.start, + crashk_res.end - crashk_res.start + 1); + if (ret) + goto out_err; + } + /* add bootargs */ if (cmdline) { ret = fdt_setprop(buf, nodeoffset, "bootargs", @@ -262,3 +366,44 @@ int load_other_segments(struct kimage *image, unsigned long kernel_load_addr, image->arch.dtb_buf = NULL; return ret; } + +int load_crashdump_segments(struct kimage *image) +{ + void *elf_addr; + unsigned long elf_sz; + struct kexec_buf kbuf; + int ret; + + if (image->type != KEXEC_TYPE_CRASH) + return 0; + + /* Prepare elf headers and add a segment */ + ret = prepare_elf_headers(image, &elf_addr, &elf_sz); + if (ret) { + pr_err("Preparing elf core header failed\n"); + return ret; + } + + kbuf.image = image; + kbuf.buffer = elf_addr; + kbuf.bufsz = elf_sz; + kbuf.memsz = elf_sz; + kbuf.buf_align = PAGE_SIZE; + kbuf.buf_min = crashk_res.start; + kbuf.buf_max = crashk_res.end + 1; + kbuf.top_down = 1; + + ret = kexec_add_buffer(&kbuf); + if (ret) { + vfree(elf_addr); + return ret; + } + image->arch.elf_headers = elf_addr; + image->arch.elf_headers_sz = elf_sz; + image->arch.elf_load_addr = kbuf.mem; + + pr_debug("Loaded elf core header at 0x%lx bufsz=0x%lx memsz=0x%lx\n", + image->arch.elf_load_addr, elf_sz, elf_sz); + + return ret; +}