From mboxrd@z Thu Jan 1 00:00:00 1970 Received: from smtp.kernel.org (aws-us-west-2-korg-mail-1.web.codeaurora.org [10.30.226.201]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id 6F9D3145322 for ; Tue, 14 May 2024 14:05:22 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=10.30.226.201 ARC-Seal:i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1715695522; cv=none; b=QnxfiaD3VVLfJmIB6rGZpD8Y9ygZ3EzoT+1KJX+wiA7cE8aejv4/EcwoIk1YhFn38eZ1+VQSrumWZsXC1lzra5Ml7zr/20LBVtgel9GtHhqZ3tIeYiApiEzLbaa4jdK/K0zyfefv4tuYUtIzm+5NOm3AeIv1NU7ZkOqwdEHzkcw= ARC-Message-Signature:i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1715695522; c=relaxed/simple; bh=KrXLi2kuhfXzcPr+BoNvWMq+KlIFOy4AuLG7kxwToYM=; h=From:To:Cc:Subject:Date:Message-Id:In-Reply-To:References: MIME-Version:Content-Type; b=oud5DPSt9KdAe0kL1TSqbxcPK8gmwrVC2Qblym1qqLg6ZFZMiiqHnnvWWMJNEs6jbtrbUxTX+uuTTTAWXYijtaHbDRth4arVuhD+9DDbsgpjm2jTArkUsczO7EgnAaMzZ1hC1dq0YQvX3gTddNXDksuhvTo4fYrQUSzcjVvbCKY= ARC-Authentication-Results:i=1; smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=kernel.org header.i=@kernel.org header.b=qJp+pNmr; arc=none smtp.client-ip=10.30.226.201 Authentication-Results: smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=kernel.org header.i=@kernel.org header.b="qJp+pNmr" Received: by smtp.kernel.org (Postfix) with ESMTPSA id 71035C32782; Tue, 14 May 2024 14:05:18 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/simple; d=kernel.org; s=k20201202; t=1715695522; bh=KrXLi2kuhfXzcPr+BoNvWMq+KlIFOy4AuLG7kxwToYM=; h=From:To:Cc:Subject:Date:In-Reply-To:References:From; b=qJp+pNmrnz2hVpw3ad/kdlC3wpDSy94U8cdclU7Y7AHoh1yrK5uwu7FPeuJrmjv8m DFM/uYWS2H44l8qKMC+uOJeRNLMQyPOGghW7IuFo7YZPggnkJxEh44Gg3ZQAQSFrSq QOe4J2HCtPFecfwfKl8+/b6GjnF90naa+RZ3qRbWrLNrrF6zi/rxpo62MieP1NpgDj 9JPmB0ipQUv3I+2c7oUx9omig2cfqp+yG7/qs+VfFFwgfBf3Xs4/2Q8xjmcxox33H0 LtH2mRL8D/SX2fgmIEwUvBMZVQOYb5npRRDc2cGRpvSqdVzBllfNTxAQ/SIeEm0mcd bkyQaYhcOsyPw== From: =?UTF-8?q?Bj=C3=B6rn=20T=C3=B6pel?= To: Alexandre Ghiti , Albert Ou , David Hildenbrand , Palmer Dabbelt , Paul Walmsley , linux-riscv@lists.infradead.org Cc: =?UTF-8?q?Bj=C3=B6rn=20T=C3=B6pel?= , Andrew Bresticker , Chethan Seshadri , Lorenzo Stoakes , Oscar Salvador , Santosh Mamila , Sivakumar Munnangi , Sunil V L , linux-kernel@vger.kernel.org, linux-mm@kvack.org, virtualization@lists.linux-foundation.org Subject: [PATCH v2 4/8] riscv: mm: Add memory hotplugging support Date: Tue, 14 May 2024 16:04:42 +0200 Message-Id: <20240514140446.538622-5-bjorn@kernel.org> X-Mailer: git-send-email 2.40.1 In-Reply-To: <20240514140446.538622-1-bjorn@kernel.org> References: <20240514140446.538622-1-bjorn@kernel.org> Precedence: bulk X-Mailing-List: linux-kernel@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit From: Björn Töpel For an architecture to support memory hotplugging, a couple of callbacks needs to be implemented: arch_add_memory() This callback is responsible for adding the physical memory into the direct map, and call into the memory hotplugging generic code via __add_pages() that adds the corresponding struct page entries, and updates the vmemmap mapping. arch_remove_memory() This is the inverse of the callback above. vmemmap_free() This function tears down the vmemmap mappings (if CONFIG_SPARSEMEM_VMEMMAP is enabled), and also deallocates the backing vmemmap pages. Note that for persistent memory, an alternative allocator for the backing pages can be used; The vmem_altmap. This means that when the backing pages are cleared, extra care is needed so that the correct deallocation method is used. arch_get_mappable_range() This functions returns the PA range that the direct map can map. Used by the MHP internals for sanity checks. The page table unmap/teardown functions are heavily based on code from the x86 tree. The same remove_pgd_mapping() function is used in both vmemmap_free() and arch_remove_memory(), but in the latter function the backing pages are not removed. Signed-off-by: Björn Töpel --- arch/riscv/mm/init.c | 242 +++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 242 insertions(+) diff --git a/arch/riscv/mm/init.c b/arch/riscv/mm/init.c index 6f72b0b2b854..7f0b921a3d3a 100644 --- a/arch/riscv/mm/init.c +++ b/arch/riscv/mm/init.c @@ -1493,3 +1493,245 @@ void __init pgtable_cache_init(void) } } #endif + +#ifdef CONFIG_MEMORY_HOTPLUG +static void __meminit free_pte_table(pte_t *pte_start, pmd_t *pmd) +{ + pte_t *pte; + int i; + + for (i = 0; i < PTRS_PER_PTE; i++) { + pte = pte_start + i; + if (!pte_none(*pte)) + return; + } + + free_pages((unsigned long)page_address(pmd_page(*pmd)), 0); + pmd_clear(pmd); +} + +static void __meminit free_pmd_table(pmd_t *pmd_start, pud_t *pud) +{ + pmd_t *pmd; + int i; + + for (i = 0; i < PTRS_PER_PMD; i++) { + pmd = pmd_start + i; + if (!pmd_none(*pmd)) + return; + } + + free_pages((unsigned long)page_address(pud_page(*pud)), 0); + pud_clear(pud); +} + +static void __meminit free_pud_table(pud_t *pud_start, p4d_t *p4d) +{ + pud_t *pud; + int i; + + for (i = 0; i < PTRS_PER_PUD; i++) { + pud = pud_start + i; + if (!pud_none(*pud)) + return; + } + + free_pages((unsigned long)page_address(p4d_page(*p4d)), 0); + p4d_clear(p4d); +} + +static void __meminit free_vmemmap_storage(struct page *page, size_t size, + struct vmem_altmap *altmap) +{ + if (altmap) + vmem_altmap_free(altmap, size >> PAGE_SHIFT); + else + free_pages((unsigned long)page_address(page), get_order(size)); +} + +static void __meminit remove_pte_mapping(pte_t *pte_base, unsigned long addr, unsigned long end, + bool is_vmemmap, struct vmem_altmap *altmap) +{ + unsigned long next; + pte_t *ptep, pte; + + for (; addr < end; addr = next) { + next = (addr + PAGE_SIZE) & PAGE_MASK; + if (next > end) + next = end; + + ptep = pte_base + pte_index(addr); + pte = READ_ONCE(*ptep); + + if (!pte_present(*ptep)) + continue; + + pte_clear(&init_mm, addr, ptep); + if (is_vmemmap) + free_vmemmap_storage(pte_page(pte), PAGE_SIZE, altmap); + } +} + +static void __meminit remove_pmd_mapping(pmd_t *pmd_base, unsigned long addr, unsigned long end, + bool is_vmemmap, struct vmem_altmap *altmap) +{ + unsigned long next; + pte_t *pte_base; + pmd_t *pmdp, pmd; + + for (; addr < end; addr = next) { + next = pmd_addr_end(addr, end); + pmdp = pmd_base + pmd_index(addr); + pmd = READ_ONCE(*pmdp); + + if (!pmd_present(pmd)) + continue; + + if (pmd_leaf(pmd)) { + pmd_clear(pmdp); + if (is_vmemmap) + free_vmemmap_storage(pmd_page(pmd), PMD_SIZE, altmap); + continue; + } + + pte_base = (pte_t *)pmd_page_vaddr(*pmdp); + remove_pte_mapping(pte_base, addr, next, is_vmemmap, altmap); + free_pte_table(pte_base, pmdp); + } +} + +static void __meminit remove_pud_mapping(pud_t *pud_base, unsigned long addr, unsigned long end, + bool is_vmemmap, struct vmem_altmap *altmap) +{ + unsigned long next; + pud_t *pudp, pud; + pmd_t *pmd_base; + + for (; addr < end; addr = next) { + next = pud_addr_end(addr, end); + pudp = pud_base + pud_index(addr); + pud = READ_ONCE(*pudp); + + if (!pud_present(pud)) + continue; + + if (pud_leaf(pud)) { + if (pgtable_l4_enabled) { + pud_clear(pudp); + if (is_vmemmap) + free_vmemmap_storage(pud_page(pud), PUD_SIZE, altmap); + } + continue; + } + + pmd_base = pmd_offset(pudp, 0); + remove_pmd_mapping(pmd_base, addr, next, is_vmemmap, altmap); + + if (pgtable_l4_enabled) + free_pmd_table(pmd_base, pudp); + } +} + +static void __meminit remove_p4d_mapping(p4d_t *p4d_base, unsigned long addr, unsigned long end, + bool is_vmemmap, struct vmem_altmap *altmap) +{ + unsigned long next; + p4d_t *p4dp, p4d; + pud_t *pud_base; + + for (; addr < end; addr = next) { + next = p4d_addr_end(addr, end); + p4dp = p4d_base + p4d_index(addr); + p4d = READ_ONCE(*p4dp); + + if (!p4d_present(p4d)) + continue; + + if (p4d_leaf(p4d)) { + if (pgtable_l5_enabled) { + p4d_clear(p4dp); + if (is_vmemmap) + free_vmemmap_storage(p4d_page(p4d), P4D_SIZE, altmap); + } + continue; + } + + pud_base = pud_offset(p4dp, 0); + remove_pud_mapping(pud_base, addr, next, is_vmemmap, altmap); + + if (pgtable_l5_enabled) + free_pud_table(pud_base, p4dp); + } +} + +static void __meminit remove_pgd_mapping(unsigned long va, unsigned long end, bool is_vmemmap, + struct vmem_altmap *altmap) +{ + unsigned long addr, next; + p4d_t *p4d_base; + pgd_t *pgd; + + for (addr = va; addr < end; addr = next) { + next = pgd_addr_end(addr, end); + pgd = pgd_offset_k(addr); + + if (!pgd_present(*pgd)) + continue; + + if (pgd_leaf(*pgd)) + continue; + + p4d_base = p4d_offset(pgd, 0); + remove_p4d_mapping(p4d_base, addr, next, is_vmemmap, altmap); + } + + flush_tlb_all(); +} + +static void __meminit remove_linear_mapping(phys_addr_t start, u64 size) +{ + unsigned long va = (unsigned long)__va(start); + unsigned long end = (unsigned long)__va(start + size); + + remove_pgd_mapping(va, end, false, NULL); +} + +struct range arch_get_mappable_range(void) +{ + struct range mhp_range; + + mhp_range.start = __pa(PAGE_OFFSET); + mhp_range.end = __pa(PAGE_END - 1); + return mhp_range; +} + +int __ref arch_add_memory(int nid, u64 start, u64 size, struct mhp_params *params) +{ + int ret; + + create_linear_mapping_range(start, start + size, 0, ¶ms->pgprot); + flush_tlb_all(); + ret = __add_pages(nid, start >> PAGE_SHIFT, size >> PAGE_SHIFT, params); + if (ret) { + remove_linear_mapping(start, size); + return ret; + } + + max_pfn = PFN_UP(start + size); + max_low_pfn = max_pfn; + return 0; +} + +void __ref arch_remove_memory(u64 start, u64 size, struct vmem_altmap *altmap) +{ + __remove_pages(start >> PAGE_SHIFT, size >> PAGE_SHIFT, altmap); + remove_linear_mapping(start, size); +} + +#ifdef CONFIG_SPARSEMEM_VMEMMAP +void __ref vmemmap_free(unsigned long start, unsigned long end, struct vmem_altmap *altmap) +{ + remove_pgd_mapping(start, end, true, altmap); +} +#endif /* CONFIG_SPARSEMEM_VMEMMAP */ +#endif /* CONFIG_MEMORY_HOTPLUG */ -- 2.40.1 From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from bombadil.infradead.org (bombadil.infradead.org [198.137.202.133]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.lore.kernel.org (Postfix) with ESMTPS id 9E8CBC04FFE for ; Tue, 14 May 2024 14:05:32 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20210309; h=Sender: Content-Transfer-Encoding:Content-Type:Cc:List-Subscribe:List-Help:List-Post: List-Archive:List-Unsubscribe:List-Id:MIME-Version:References:In-Reply-To: Message-Id:Date:Subject:To:From:Reply-To:Content-ID:Content-Description: Resent-Date:Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID: List-Owner; bh=okW4HEZlp06C9nCXBOwPdsX6sLkCBv2MagyU5AsGZLs=; b=GQ5fqAL0OnWFzN ISegsok7lGs6BOSjKWjlIQSBvIj2m73W64ZaAhRFWjoFImd3ysaYLa5rRmCgCZ8xuQOBVNi09o4/M 5CXDeE3kIBE9lRKO+pMddTxo4nsC2UlNxSGzHWzSWcgZuDpSDuF+ILC1hoeygmYrwJGNHY03PboDv TLYwzxMllkUjEsMDjGTcrrCQ2oqJ80c6edwA1LOoGlmknC0RaTBwpCMoza6Lpx/v6dPQJzcQLfyRi d1TNzDEpb0FQYNFDHfZbiL/YcjzyCpPsZOwzNHWh4CvLNkQgaU0/8Q4tquI06/IsXMhmxvqHCsAXF daMgEJ2tNvCwh+un5RYw==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.97.1 #2 (Red Hat Linux)) id 1s6smX-0000000G7bU-0nQD; Tue, 14 May 2024 14:05:29 +0000 Received: from sin.source.kernel.org ([145.40.73.55]) by bombadil.infradead.org with esmtps (Exim 4.97.1 #2 (Red Hat Linux)) id 1s6smU-0000000G7ZA-0l3u for linux-riscv@lists.infradead.org; Tue, 14 May 2024 14:05:27 +0000 Received: from smtp.kernel.org (transwarp.subspace.kernel.org [100.75.92.58]) by sin.source.kernel.org (Postfix) with ESMTP id DA595CE1290; Tue, 14 May 2024 14:05:23 +0000 (UTC) Received: by smtp.kernel.org (Postfix) with ESMTPSA id 71035C32782; Tue, 14 May 2024 14:05:18 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/simple; d=kernel.org; s=k20201202; t=1715695522; bh=KrXLi2kuhfXzcPr+BoNvWMq+KlIFOy4AuLG7kxwToYM=; h=From:To:Cc:Subject:Date:In-Reply-To:References:From; b=qJp+pNmrnz2hVpw3ad/kdlC3wpDSy94U8cdclU7Y7AHoh1yrK5uwu7FPeuJrmjv8m DFM/uYWS2H44l8qKMC+uOJeRNLMQyPOGghW7IuFo7YZPggnkJxEh44Gg3ZQAQSFrSq QOe4J2HCtPFecfwfKl8+/b6GjnF90naa+RZ3qRbWrLNrrF6zi/rxpo62MieP1NpgDj 9JPmB0ipQUv3I+2c7oUx9omig2cfqp+yG7/qs+VfFFwgfBf3Xs4/2Q8xjmcxox33H0 LtH2mRL8D/SX2fgmIEwUvBMZVQOYb5npRRDc2cGRpvSqdVzBllfNTxAQ/SIeEm0mcd bkyQaYhcOsyPw== From: =?UTF-8?q?Bj=C3=B6rn=20T=C3=B6pel?= To: Alexandre Ghiti , Albert Ou , David Hildenbrand , Palmer Dabbelt , Paul Walmsley , linux-riscv@lists.infradead.org Subject: [PATCH v2 4/8] riscv: mm: Add memory hotplugging support Date: Tue, 14 May 2024 16:04:42 +0200 Message-Id: <20240514140446.538622-5-bjorn@kernel.org> X-Mailer: git-send-email 2.40.1 In-Reply-To: <20240514140446.538622-1-bjorn@kernel.org> References: <20240514140446.538622-1-bjorn@kernel.org> MIME-Version: 1.0 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20240514_070526_622693_DC0FE09B X-CRM114-Status: GOOD ( 18.65 ) X-BeenThere: linux-riscv@lists.infradead.org X-Mailman-Version: 2.1.34 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Cc: Lorenzo Stoakes , Chethan Seshadri , linux-kernel@vger.kernel.org, Andrew Bresticker , =?UTF-8?q?Bj=C3=B6rn=20T=C3=B6pel?= , Santosh Mamila , linux-mm@kvack.org, Sivakumar Munnangi , virtualization@lists.linux-foundation.org, Oscar Salvador Content-Type: text/plain; charset="utf-8" Content-Transfer-Encoding: base64 Sender: "linux-riscv" Errors-To: linux-riscv-bounces+linux-riscv=archiver.kernel.org@lists.infradead.org RnJvbTogQmrDtnJuIFTDtnBlbCA8Ympvcm5Acml2b3NpbmMuY29tPgoKRm9yIGFuIGFyY2hpdGVj dHVyZSB0byBzdXBwb3J0IG1lbW9yeSBob3RwbHVnZ2luZywgYSBjb3VwbGUgb2YKY2FsbGJhY2tz IG5lZWRzIHRvIGJlIGltcGxlbWVudGVkOgoKIGFyY2hfYWRkX21lbW9yeSgpCiAgVGhpcyBjYWxs YmFjayBpcyByZXNwb25zaWJsZSBmb3IgYWRkaW5nIHRoZSBwaHlzaWNhbCBtZW1vcnkgaW50byB0 aGUKICBkaXJlY3QgbWFwLCBhbmQgY2FsbCBpbnRvIHRoZSBtZW1vcnkgaG90cGx1Z2dpbmcgZ2Vu ZXJpYyBjb2RlIHZpYQogIF9fYWRkX3BhZ2VzKCkgdGhhdCBhZGRzIHRoZSBjb3JyZXNwb25kaW5n IHN0cnVjdCBwYWdlIGVudHJpZXMsIGFuZAogIHVwZGF0ZXMgdGhlIHZtZW1tYXAgbWFwcGluZy4K CiBhcmNoX3JlbW92ZV9tZW1vcnkoKQogIFRoaXMgaXMgdGhlIGludmVyc2Ugb2YgdGhlIGNhbGxi YWNrIGFib3ZlLgoKIHZtZW1tYXBfZnJlZSgpCiAgVGhpcyBmdW5jdGlvbiB0ZWFycyBkb3duIHRo ZSB2bWVtbWFwIG1hcHBpbmdzIChpZgogIENPTkZJR19TUEFSU0VNRU1fVk1FTU1BUCBpcyBlbmFi bGVkKSwgYW5kIGFsc28gZGVhbGxvY2F0ZXMgdGhlCiAgYmFja2luZyB2bWVtbWFwIHBhZ2VzLiBO b3RlIHRoYXQgZm9yIHBlcnNpc3RlbnQgbWVtb3J5LCBhbgogIGFsdGVybmF0aXZlIGFsbG9jYXRv ciBmb3IgdGhlIGJhY2tpbmcgcGFnZXMgY2FuIGJlIHVzZWQ7IFRoZQogIHZtZW1fYWx0bWFwLiBU aGlzIG1lYW5zIHRoYXQgd2hlbiB0aGUgYmFja2luZyBwYWdlcyBhcmUgY2xlYXJlZCwKICBleHRy YSBjYXJlIGlzIG5lZWRlZCBzbyB0aGF0IHRoZSBjb3JyZWN0IGRlYWxsb2NhdGlvbiBtZXRob2Qg aXMKICB1c2VkLgoKIGFyY2hfZ2V0X21hcHBhYmxlX3JhbmdlKCkKICBUaGlzIGZ1bmN0aW9ucyBy ZXR1cm5zIHRoZSBQQSByYW5nZSB0aGF0IHRoZSBkaXJlY3QgbWFwIGNhbiBtYXAuCiAgVXNlZCBi eSB0aGUgTUhQIGludGVybmFscyBmb3Igc2FuaXR5IGNoZWNrcy4KClRoZSBwYWdlIHRhYmxlIHVu bWFwL3RlYXJkb3duIGZ1bmN0aW9ucyBhcmUgaGVhdmlseSBiYXNlZCBvbiBjb2RlIGZyb20KdGhl IHg4NiB0cmVlLiBUaGUgc2FtZSByZW1vdmVfcGdkX21hcHBpbmcoKSBmdW5jdGlvbiBpcyB1c2Vk IGluIGJvdGgKdm1lbW1hcF9mcmVlKCkgYW5kIGFyY2hfcmVtb3ZlX21lbW9yeSgpLCBidXQgaW4g dGhlIGxhdHRlciBmdW5jdGlvbgp0aGUgYmFja2luZyBwYWdlcyBhcmUgbm90IHJlbW92ZWQuCgpT aWduZWQtb2ZmLWJ5OiBCasO2cm4gVMO2cGVsIDxiam9ybkByaXZvc2luYy5jb20+Ci0tLQogYXJj aC9yaXNjdi9tbS9pbml0LmMgfCAyNDIgKysrKysrKysrKysrKysrKysrKysrKysrKysrKysrKysr KysrKysrKysrKwogMSBmaWxlIGNoYW5nZWQsIDI0MiBpbnNlcnRpb25zKCspCgpkaWZmIC0tZ2l0 IGEvYXJjaC9yaXNjdi9tbS9pbml0LmMgYi9hcmNoL3Jpc2N2L21tL2luaXQuYwppbmRleCA2Zjcy YjBiMmI4NTQuLjdmMGI5MjFhM2QzYSAxMDA2NDQKLS0tIGEvYXJjaC9yaXNjdi9tbS9pbml0LmMK KysrIGIvYXJjaC9yaXNjdi9tbS9pbml0LmMKQEAgLTE0OTMsMyArMTQ5MywyNDUgQEAgdm9pZCBf X2luaXQgcGd0YWJsZV9jYWNoZV9pbml0KHZvaWQpCiAJfQogfQogI2VuZGlmCisKKyNpZmRlZiBD T05GSUdfTUVNT1JZX0hPVFBMVUcKK3N0YXRpYyB2b2lkIF9fbWVtaW5pdCBmcmVlX3B0ZV90YWJs ZShwdGVfdCAqcHRlX3N0YXJ0LCBwbWRfdCAqcG1kKQoreworCXB0ZV90ICpwdGU7CisJaW50IGk7 CisKKwlmb3IgKGkgPSAwOyBpIDwgUFRSU19QRVJfUFRFOyBpKyspIHsKKwkJcHRlID0gcHRlX3N0 YXJ0ICsgaTsKKwkJaWYgKCFwdGVfbm9uZSgqcHRlKSkKKwkJCXJldHVybjsKKwl9CisKKwlmcmVl X3BhZ2VzKCh1bnNpZ25lZCBsb25nKXBhZ2VfYWRkcmVzcyhwbWRfcGFnZSgqcG1kKSksIDApOwor CXBtZF9jbGVhcihwbWQpOworfQorCitzdGF0aWMgdm9pZCBfX21lbWluaXQgZnJlZV9wbWRfdGFi bGUocG1kX3QgKnBtZF9zdGFydCwgcHVkX3QgKnB1ZCkKK3sKKwlwbWRfdCAqcG1kOworCWludCBp OworCisJZm9yIChpID0gMDsgaSA8IFBUUlNfUEVSX1BNRDsgaSsrKSB7CisJCXBtZCA9IHBtZF9z dGFydCArIGk7CisJCWlmICghcG1kX25vbmUoKnBtZCkpCisJCQlyZXR1cm47CisJfQorCisJZnJl ZV9wYWdlcygodW5zaWduZWQgbG9uZylwYWdlX2FkZHJlc3MocHVkX3BhZ2UoKnB1ZCkpLCAwKTsK KwlwdWRfY2xlYXIocHVkKTsKK30KKworc3RhdGljIHZvaWQgX19tZW1pbml0IGZyZWVfcHVkX3Rh YmxlKHB1ZF90ICpwdWRfc3RhcnQsIHA0ZF90ICpwNGQpCit7CisJcHVkX3QgKnB1ZDsKKwlpbnQg aTsKKworCWZvciAoaSA9IDA7IGkgPCBQVFJTX1BFUl9QVUQ7IGkrKykgeworCQlwdWQgPSBwdWRf c3RhcnQgKyBpOworCQlpZiAoIXB1ZF9ub25lKCpwdWQpKQorCQkJcmV0dXJuOworCX0KKworCWZy ZWVfcGFnZXMoKHVuc2lnbmVkIGxvbmcpcGFnZV9hZGRyZXNzKHA0ZF9wYWdlKCpwNGQpKSwgMCk7 CisJcDRkX2NsZWFyKHA0ZCk7Cit9CisKK3N0YXRpYyB2b2lkIF9fbWVtaW5pdCBmcmVlX3ZtZW1t YXBfc3RvcmFnZShzdHJ1Y3QgcGFnZSAqcGFnZSwgc2l6ZV90IHNpemUsCisJCQkJCSAgIHN0cnVj dCB2bWVtX2FsdG1hcCAqYWx0bWFwKQoreworCWlmIChhbHRtYXApCisJCXZtZW1fYWx0bWFwX2Zy ZWUoYWx0bWFwLCBzaXplID4+IFBBR0VfU0hJRlQpOworCWVsc2UKKwkJZnJlZV9wYWdlcygodW5z aWduZWQgbG9uZylwYWdlX2FkZHJlc3MocGFnZSksIGdldF9vcmRlcihzaXplKSk7Cit9CisKK3N0 YXRpYyB2b2lkIF9fbWVtaW5pdCByZW1vdmVfcHRlX21hcHBpbmcocHRlX3QgKnB0ZV9iYXNlLCB1 bnNpZ25lZCBsb25nIGFkZHIsIHVuc2lnbmVkIGxvbmcgZW5kLAorCQkJCQkgYm9vbCBpc192bWVt bWFwLCBzdHJ1Y3Qgdm1lbV9hbHRtYXAgKmFsdG1hcCkKK3sKKwl1bnNpZ25lZCBsb25nIG5leHQ7 CisJcHRlX3QgKnB0ZXAsIHB0ZTsKKworCWZvciAoOyBhZGRyIDwgZW5kOyBhZGRyID0gbmV4dCkg eworCQluZXh0ID0gKGFkZHIgKyBQQUdFX1NJWkUpICYgUEFHRV9NQVNLOworCQlpZiAobmV4dCA+ IGVuZCkKKwkJCW5leHQgPSBlbmQ7CisKKwkJcHRlcCA9IHB0ZV9iYXNlICsgcHRlX2luZGV4KGFk ZHIpOworCQlwdGUgPSBSRUFEX09OQ0UoKnB0ZXApOworCisJCWlmICghcHRlX3ByZXNlbnQoKnB0 ZXApKQorCQkJY29udGludWU7CisKKwkJcHRlX2NsZWFyKCZpbml0X21tLCBhZGRyLCBwdGVwKTsK KwkJaWYgKGlzX3ZtZW1tYXApCisJCQlmcmVlX3ZtZW1tYXBfc3RvcmFnZShwdGVfcGFnZShwdGUp LCBQQUdFX1NJWkUsIGFsdG1hcCk7CisJfQorfQorCitzdGF0aWMgdm9pZCBfX21lbWluaXQgcmVt b3ZlX3BtZF9tYXBwaW5nKHBtZF90ICpwbWRfYmFzZSwgdW5zaWduZWQgbG9uZyBhZGRyLCB1bnNp Z25lZCBsb25nIGVuZCwKKwkJCQkJIGJvb2wgaXNfdm1lbW1hcCwgc3RydWN0IHZtZW1fYWx0bWFw ICphbHRtYXApCit7CisJdW5zaWduZWQgbG9uZyBuZXh0OworCXB0ZV90ICpwdGVfYmFzZTsKKwlw bWRfdCAqcG1kcCwgcG1kOworCisJZm9yICg7IGFkZHIgPCBlbmQ7IGFkZHIgPSBuZXh0KSB7CisJ CW5leHQgPSBwbWRfYWRkcl9lbmQoYWRkciwgZW5kKTsKKwkJcG1kcCA9IHBtZF9iYXNlICsgcG1k X2luZGV4KGFkZHIpOworCQlwbWQgPSBSRUFEX09OQ0UoKnBtZHApOworCisJCWlmICghcG1kX3By ZXNlbnQocG1kKSkKKwkJCWNvbnRpbnVlOworCisJCWlmIChwbWRfbGVhZihwbWQpKSB7CisJCQlw bWRfY2xlYXIocG1kcCk7CisJCQlpZiAoaXNfdm1lbW1hcCkKKwkJCQlmcmVlX3ZtZW1tYXBfc3Rv cmFnZShwbWRfcGFnZShwbWQpLCBQTURfU0laRSwgYWx0bWFwKTsKKwkJCWNvbnRpbnVlOworCQl9 CisKKwkJcHRlX2Jhc2UgPSAocHRlX3QgKilwbWRfcGFnZV92YWRkcigqcG1kcCk7CisJCXJlbW92 ZV9wdGVfbWFwcGluZyhwdGVfYmFzZSwgYWRkciwgbmV4dCwgaXNfdm1lbW1hcCwgYWx0bWFwKTsK KwkJZnJlZV9wdGVfdGFibGUocHRlX2Jhc2UsIHBtZHApOworCX0KK30KKworc3RhdGljIHZvaWQg X19tZW1pbml0IHJlbW92ZV9wdWRfbWFwcGluZyhwdWRfdCAqcHVkX2Jhc2UsIHVuc2lnbmVkIGxv bmcgYWRkciwgdW5zaWduZWQgbG9uZyBlbmQsCisJCQkJCSBib29sIGlzX3ZtZW1tYXAsIHN0cnVj dCB2bWVtX2FsdG1hcCAqYWx0bWFwKQoreworCXVuc2lnbmVkIGxvbmcgbmV4dDsKKwlwdWRfdCAq cHVkcCwgcHVkOworCXBtZF90ICpwbWRfYmFzZTsKKworCWZvciAoOyBhZGRyIDwgZW5kOyBhZGRy ID0gbmV4dCkgeworCQluZXh0ID0gcHVkX2FkZHJfZW5kKGFkZHIsIGVuZCk7CisJCXB1ZHAgPSBw dWRfYmFzZSArIHB1ZF9pbmRleChhZGRyKTsKKwkJcHVkID0gUkVBRF9PTkNFKCpwdWRwKTsKKwor CQlpZiAoIXB1ZF9wcmVzZW50KHB1ZCkpCisJCQljb250aW51ZTsKKworCQlpZiAocHVkX2xlYWYo cHVkKSkgeworCQkJaWYgKHBndGFibGVfbDRfZW5hYmxlZCkgeworCQkJCXB1ZF9jbGVhcihwdWRw KTsKKwkJCQlpZiAoaXNfdm1lbW1hcCkKKwkJCQkJZnJlZV92bWVtbWFwX3N0b3JhZ2UocHVkX3Bh Z2UocHVkKSwgUFVEX1NJWkUsIGFsdG1hcCk7CisJCQl9CisJCQljb250aW51ZTsKKwkJfQorCisJ CXBtZF9iYXNlID0gcG1kX29mZnNldChwdWRwLCAwKTsKKwkJcmVtb3ZlX3BtZF9tYXBwaW5nKHBt ZF9iYXNlLCBhZGRyLCBuZXh0LCBpc192bWVtbWFwLCBhbHRtYXApOworCisJCWlmIChwZ3RhYmxl X2w0X2VuYWJsZWQpCisJCQlmcmVlX3BtZF90YWJsZShwbWRfYmFzZSwgcHVkcCk7CisJfQorfQor CitzdGF0aWMgdm9pZCBfX21lbWluaXQgcmVtb3ZlX3A0ZF9tYXBwaW5nKHA0ZF90ICpwNGRfYmFz ZSwgdW5zaWduZWQgbG9uZyBhZGRyLCB1bnNpZ25lZCBsb25nIGVuZCwKKwkJCQkJIGJvb2wgaXNf dm1lbW1hcCwgc3RydWN0IHZtZW1fYWx0bWFwICphbHRtYXApCit7CisJdW5zaWduZWQgbG9uZyBu ZXh0OworCXA0ZF90ICpwNGRwLCBwNGQ7CisJcHVkX3QgKnB1ZF9iYXNlOworCisJZm9yICg7IGFk ZHIgPCBlbmQ7IGFkZHIgPSBuZXh0KSB7CisJCW5leHQgPSBwNGRfYWRkcl9lbmQoYWRkciwgZW5k KTsKKwkJcDRkcCA9IHA0ZF9iYXNlICsgcDRkX2luZGV4KGFkZHIpOworCQlwNGQgPSBSRUFEX09O Q0UoKnA0ZHApOworCisJCWlmICghcDRkX3ByZXNlbnQocDRkKSkKKwkJCWNvbnRpbnVlOworCisJ CWlmIChwNGRfbGVhZihwNGQpKSB7CisJCQlpZiAocGd0YWJsZV9sNV9lbmFibGVkKSB7CisJCQkJ cDRkX2NsZWFyKHA0ZHApOworCQkJCWlmIChpc192bWVtbWFwKQorCQkJCQlmcmVlX3ZtZW1tYXBf c3RvcmFnZShwNGRfcGFnZShwNGQpLCBQNERfU0laRSwgYWx0bWFwKTsKKwkJCX0KKwkJCWNvbnRp bnVlOworCQl9CisKKwkJcHVkX2Jhc2UgPSBwdWRfb2Zmc2V0KHA0ZHAsIDApOworCQlyZW1vdmVf cHVkX21hcHBpbmcocHVkX2Jhc2UsIGFkZHIsIG5leHQsIGlzX3ZtZW1tYXAsIGFsdG1hcCk7CisK KwkJaWYgKHBndGFibGVfbDVfZW5hYmxlZCkKKwkJCWZyZWVfcHVkX3RhYmxlKHB1ZF9iYXNlLCBw NGRwKTsKKwl9Cit9CisKK3N0YXRpYyB2b2lkIF9fbWVtaW5pdCByZW1vdmVfcGdkX21hcHBpbmco dW5zaWduZWQgbG9uZyB2YSwgdW5zaWduZWQgbG9uZyBlbmQsIGJvb2wgaXNfdm1lbW1hcCwKKwkJ CQkJIHN0cnVjdCB2bWVtX2FsdG1hcCAqYWx0bWFwKQoreworCXVuc2lnbmVkIGxvbmcgYWRkciwg bmV4dDsKKwlwNGRfdCAqcDRkX2Jhc2U7CisJcGdkX3QgKnBnZDsKKworCWZvciAoYWRkciA9IHZh OyBhZGRyIDwgZW5kOyBhZGRyID0gbmV4dCkgeworCQluZXh0ID0gcGdkX2FkZHJfZW5kKGFkZHIs IGVuZCk7CisJCXBnZCA9IHBnZF9vZmZzZXRfayhhZGRyKTsKKworCQlpZiAoIXBnZF9wcmVzZW50 KCpwZ2QpKQorCQkJY29udGludWU7CisKKwkJaWYgKHBnZF9sZWFmKCpwZ2QpKQorCQkJY29udGlu dWU7CisKKwkJcDRkX2Jhc2UgPSBwNGRfb2Zmc2V0KHBnZCwgMCk7CisJCXJlbW92ZV9wNGRfbWFw cGluZyhwNGRfYmFzZSwgYWRkciwgbmV4dCwgaXNfdm1lbW1hcCwgYWx0bWFwKTsKKwl9CisKKwlm bHVzaF90bGJfYWxsKCk7Cit9CisKK3N0YXRpYyB2b2lkIF9fbWVtaW5pdCByZW1vdmVfbGluZWFy X21hcHBpbmcocGh5c19hZGRyX3Qgc3RhcnQsIHU2NCBzaXplKQoreworCXVuc2lnbmVkIGxvbmcg dmEgPSAodW5zaWduZWQgbG9uZylfX3ZhKHN0YXJ0KTsKKwl1bnNpZ25lZCBsb25nIGVuZCA9ICh1 bnNpZ25lZCBsb25nKV9fdmEoc3RhcnQgKyBzaXplKTsKKworCXJlbW92ZV9wZ2RfbWFwcGluZyh2 YSwgZW5kLCBmYWxzZSwgTlVMTCk7Cit9CisKK3N0cnVjdCByYW5nZSBhcmNoX2dldF9tYXBwYWJs ZV9yYW5nZSh2b2lkKQoreworCXN0cnVjdCByYW5nZSBtaHBfcmFuZ2U7CisKKwltaHBfcmFuZ2Uu c3RhcnQgPSBfX3BhKFBBR0VfT0ZGU0VUKTsKKwltaHBfcmFuZ2UuZW5kID0gX19wYShQQUdFX0VO RCAtIDEpOworCXJldHVybiBtaHBfcmFuZ2U7Cit9CisKK2ludCBfX3JlZiBhcmNoX2FkZF9tZW1v cnkoaW50IG5pZCwgdTY0IHN0YXJ0LCB1NjQgc2l6ZSwgc3RydWN0IG1ocF9wYXJhbXMgKnBhcmFt cykKK3sKKwlpbnQgcmV0OworCisJY3JlYXRlX2xpbmVhcl9tYXBwaW5nX3JhbmdlKHN0YXJ0LCBz dGFydCArIHNpemUsIDAsICZwYXJhbXMtPnBncHJvdCk7CisJZmx1c2hfdGxiX2FsbCgpOworCXJl dCA9IF9fYWRkX3BhZ2VzKG5pZCwgc3RhcnQgPj4gUEFHRV9TSElGVCwgc2l6ZSA+PiBQQUdFX1NI SUZULCBwYXJhbXMpOworCWlmIChyZXQpIHsKKwkJcmVtb3ZlX2xpbmVhcl9tYXBwaW5nKHN0YXJ0 LCBzaXplKTsKKwkJcmV0dXJuIHJldDsKKwl9CisKKwltYXhfcGZuID0gUEZOX1VQKHN0YXJ0ICsg c2l6ZSk7CisJbWF4X2xvd19wZm4gPSBtYXhfcGZuOworCXJldHVybiAwOworfQorCit2b2lkIF9f cmVmIGFyY2hfcmVtb3ZlX21lbW9yeSh1NjQgc3RhcnQsIHU2NCBzaXplLCBzdHJ1Y3Qgdm1lbV9h bHRtYXAgKmFsdG1hcCkKK3sKKwlfX3JlbW92ZV9wYWdlcyhzdGFydCA+PiBQQUdFX1NISUZULCBz aXplID4+IFBBR0VfU0hJRlQsIGFsdG1hcCk7CisJcmVtb3ZlX2xpbmVhcl9tYXBwaW5nKHN0YXJ0 LCBzaXplKTsKK30KKworI2lmZGVmIENPTkZJR19TUEFSU0VNRU1fVk1FTU1BUAordm9pZCBfX3Jl ZiB2bWVtbWFwX2ZyZWUodW5zaWduZWQgbG9uZyBzdGFydCwgdW5zaWduZWQgbG9uZyBlbmQsIHN0 cnVjdCB2bWVtX2FsdG1hcCAqYWx0bWFwKQoreworCXJlbW92ZV9wZ2RfbWFwcGluZyhzdGFydCwg ZW5kLCB0cnVlLCBhbHRtYXApOworfQorI2VuZGlmIC8qIENPTkZJR19TUEFSU0VNRU1fVk1FTU1B UCAqLworI2VuZGlmIC8qIENPTkZJR19NRU1PUllfSE9UUExVRyAqLwotLSAKMi40MC4xCgoKX19f X19fX19fX19fX19fX19fX19fX19fX19fX19fX19fX19fX19fX19fX19fX18KbGludXgtcmlzY3Yg bWFpbGluZyBsaXN0CmxpbnV4LXJpc2N2QGxpc3RzLmluZnJhZGVhZC5vcmcKaHR0cDovL2xpc3Rz LmluZnJhZGVhZC5vcmcvbWFpbG1hbi9saXN0aW5mby9saW51eC1yaXNjdgo=