From patchwork Tue Dec 10 16:51:19 2024 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Rob Clark X-Patchwork-Id: 13901785 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 D9BCFE7717F for ; Tue, 10 Dec 2024 16:54:04 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20210309; h=Sender:List-Subscribe:List-Help :List-Post:List-Archive:List-Unsubscribe:List-Id:Content-Transfer-Encoding: MIME-Version:References:In-Reply-To:Message-ID:Date:Subject:Cc:To:From: Reply-To:Content-Type:Content-ID:Content-Description:Resent-Date:Resent-From: Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID:List-Owner; bh=qXOH6pZZi9eL22B8MhhX9UUu8EkOGTpVPSjjBt9TTq4=; b=Ad8QfkxqN38BRHvQ0ihOeHz8EO 77xAy4k9C1E/f+/7iOVV+q7aWkkEDGpZ2I8VSV1kzrEd19EiBZwwXcj0oyDsTCCiteijV88r3F8x3 jnn9J/d0OgID50HFH/NG4Qwyi93RAYUAONqatOD3QKOs/A6e6dzL/tEDWgR3TnKpidHcqBHfLOars oUANWeeOY4W1bySQl9n041qXXfUXuawIUKD3VzTF6iiqs4V/YSW6TpI4uBqXvDRWxEobhO9q9hsm2 BaXJV61WltuRbea+O6arPttvWwiyD1fprYZwOxJnTXdNMSu4Inxnl6O/Ujgn3Dsyu+UEAvk1qU0Px p08/yeSg==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.98 #2 (Red Hat Linux)) id 1tL3Ug-0000000CAXG-20b1; Tue, 10 Dec 2024 16:53:54 +0000 Received: from mail-pl1-x629.google.com ([2607:f8b0:4864:20::629]) by bombadil.infradead.org with esmtps (Exim 4.98 #2 (Red Hat Linux)) id 1tL3Sd-0000000CA0b-36ue for linux-arm-kernel@lists.infradead.org; Tue, 10 Dec 2024 16:51:48 +0000 Received: by mail-pl1-x629.google.com with SMTP id d9443c01a7336-21145812538so49489955ad.0 for ; Tue, 10 Dec 2024 08:51:47 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20230601; t=1733849506; x=1734454306; darn=lists.infradead.org; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:from:to:cc:subject:date :message-id:reply-to; bh=qXOH6pZZi9eL22B8MhhX9UUu8EkOGTpVPSjjBt9TTq4=; b=m97IaIt97LYpefsvPeXqTFB50/PMaLleaVoVGHC2xZDybS1fEqFMuBG7dnC1Azv38w 2AGd0Yc6ajNt+io1bPi8uFdVSJJdkYBf2InnyDOVtHI+AeedDqB78SwInJ0AraJib/No w+UcQW30Y0f14Rw69R0Fu20JvOLBHBTq1z6ZBJTgfklKqyR/jmiCq1arPGbHMf/GTHyz p8hqJQ6r4tgYiDVfQG4JvH19nThuImAA/LM7F7alEmTLme8R4JYCqoXJPtw7mw0crJ7N hvN+mkOvp0rkBEIeHphASHy2K82qI5Qx3zpjRP49NzEX5zwapU3CfRkdUkpW6JQZqgwS 4mOw== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20230601; t=1733849506; x=1734454306; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:x-gm-message-state:from:to:cc :subject:date:message-id:reply-to; bh=qXOH6pZZi9eL22B8MhhX9UUu8EkOGTpVPSjjBt9TTq4=; b=dxIqxAuxA8wKV0EDOtQJMHN0ZW/XIen9tgwDjL7ovAE+3nNL0rkxUv36VzKa9McE0K YY/4i94eF52FjdDaBKwsQFBUTKRHXK+9GxES2/WTms5kZqBj5V+Rqzkh/Pc2HvLJ8aKx RQfEoCIp6TcVYw2vigQIMsQK+41GbDpG0g/ZJaGRFl0TRNet2JxLUbAEjZJZYkzK3RC1 YuH5ORAqsJs5yyjgoznqM1T2OWNNhsm0CYiqHtSjUhORU/SRVIDPq8sV/8uSuhO0t+bs xW7DCoqYMcOAxNy3BZGDmspJK8ZZWGsmPmFZmS0eoMKE8cvZvawyAmayEYnDOnRaob83 ZT9Q== X-Forwarded-Encrypted: i=1; AJvYcCVyKHiBlB6yRntGNGSJv4aOe3TSIKkqcvmlVl8BiiJnKPkRohoimUJHtF2o82o55tFJ2EWyWCmKw8alZpg7rT2Z@lists.infradead.org X-Gm-Message-State: AOJu0YyXM9lILXtr3mOJtC+qXHFHxBATeN94WyRZlt7jDFMxeQxX+Q6d 2x3hMTaT3mMElUl8ATSWmfPk0Ll8NfVlrj7F/opTY3a72gvoYNQv X-Gm-Gg: ASbGncs76w7tkCYArGKcxS+UnBWwJTjfzCAWnxZSlbCO4B/6Zchy357cGyCar/pqg4Y A7U6xG+jzvNDR55WH74wlsQFZhraJxctgXMg9CXE+1CYn3Vws6TJee9o+6aPfBtOAUAD5yjBg+X jW46ZSLJW1bXYt5r2vtYtLyxtPuC0w3sD2ZSkMt7jdcGC24rVQlFxZnypyYxG0knCIs7F8kxe6N s118Mbmfk+qurd30Xrm2qBc9uCd9ckna3l5fUXH44IzfCCgPcy5ERZzlp3y19idl25rCWtNaCN6 UQwB7gkHiBgqdyKPi+6jM07C1rI2 X-Google-Smtp-Source: AGHT+IGzJ9YtJRIXUx2WRftwh52jZYFp+OAl8TSYa6XERyxw2e0dtG6AQ2EjYin88gd4uM+Xi+ABrA== X-Received: by 2002:a17:902:e94d:b0:216:7761:cc48 with SMTP id d9443c01a7336-2167761cd20mr46263785ad.40.1733849506543; Tue, 10 Dec 2024 08:51:46 -0800 (PST) Received: from localhost ([2a00:79e1:2e00:1301:12e9:d196:a1e9:ab67]) by smtp.gmail.com with ESMTPSA id d9443c01a7336-215f8ef9fcdsm91889225ad.146.2024.12.10.08.51.45 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Tue, 10 Dec 2024 08:51:46 -0800 (PST) From: Rob Clark To: iommu@lists.linux.dev Cc: linux-arm-msm@vger.kernel.org, freedreno@lists.freedesktop.org, Mostafa Saleh , Will Deacon , Rob Clark , Robin Murphy , Joerg Roedel , linux-arm-kernel@lists.infradead.org (moderated list:ARM SMMU DRIVERS), linux-kernel@vger.kernel.org (open list) Subject: [PATCH v11 1/4] iommu/io-pgtable-arm: Make pgtable walker more generic Date: Tue, 10 Dec 2024 08:51:19 -0800 Message-ID: <20241210165127.600817-2-robdclark@gmail.com> X-Mailer: git-send-email 2.47.1 In-Reply-To: <20241210165127.600817-1-robdclark@gmail.com> References: <20241210165127.600817-1-robdclark@gmail.com> MIME-Version: 1.0 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20241210_085147_780357_7B47184D X-CRM114-Status: GOOD ( 13.81 ) X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.34 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org From: Rob Clark We can re-use this basic pgtable walk logic in a few places. Signed-off-by: Rob Clark Reviewed-by: Mostafa Saleh --- drivers/iommu/io-pgtable-arm.c | 67 ++++++++++++++++++++++------------ 1 file changed, 43 insertions(+), 24 deletions(-) diff --git a/drivers/iommu/io-pgtable-arm.c b/drivers/iommu/io-pgtable-arm.c index 0e67f1721a3d..7e9c0f8ae138 100644 --- a/drivers/iommu/io-pgtable-arm.c +++ b/drivers/iommu/io-pgtable-arm.c @@ -749,33 +749,33 @@ static phys_addr_t arm_lpae_iova_to_phys(struct io_pgtable_ops *ops, } struct io_pgtable_walk_data { - struct iommu_dirty_bitmap *dirty; + struct io_pgtable *iop; + void *data; + int (*visit)(struct io_pgtable_walk_data *walk_data, int lvl, + arm_lpae_iopte *ptep, size_t size); unsigned long flags; u64 addr; const u64 end; }; -static int __arm_lpae_iopte_walk_dirty(struct arm_lpae_io_pgtable *data, - struct io_pgtable_walk_data *walk_data, - arm_lpae_iopte *ptep, - int lvl); +static int __arm_lpae_iopte_walk(struct arm_lpae_io_pgtable *data, + struct io_pgtable_walk_data *walk_data, + arm_lpae_iopte *ptep, + int lvl); -static int io_pgtable_visit_dirty(struct arm_lpae_io_pgtable *data, - struct io_pgtable_walk_data *walk_data, - arm_lpae_iopte *ptep, int lvl) +static int io_pgtable_visit(struct arm_lpae_io_pgtable *data, + struct io_pgtable_walk_data *walk_data, + arm_lpae_iopte *ptep, int lvl) { struct io_pgtable *iop = &data->iop; arm_lpae_iopte pte = READ_ONCE(*ptep); - if (iopte_leaf(pte, lvl, iop->fmt)) { - size_t size = ARM_LPAE_BLOCK_SIZE(lvl, data); + size_t size = ARM_LPAE_BLOCK_SIZE(lvl, data); + int ret = walk_data->visit(walk_data, lvl, ptep, size); + if (ret) + return ret; - if (iopte_writeable_dirty(pte)) { - iommu_dirty_bitmap_record(walk_data->dirty, - walk_data->addr, size); - if (!(walk_data->flags & IOMMU_DIRTY_NO_CLEAR)) - iopte_set_writeable_clean(ptep); - } + if (iopte_leaf(pte, lvl, iop->fmt)) { walk_data->addr += size; return 0; } @@ -784,13 +784,13 @@ static int io_pgtable_visit_dirty(struct arm_lpae_io_pgtable *data, return -EINVAL; ptep = iopte_deref(pte, data); - return __arm_lpae_iopte_walk_dirty(data, walk_data, ptep, lvl + 1); + return __arm_lpae_iopte_walk(data, walk_data, ptep, lvl + 1); } -static int __arm_lpae_iopte_walk_dirty(struct arm_lpae_io_pgtable *data, - struct io_pgtable_walk_data *walk_data, - arm_lpae_iopte *ptep, - int lvl) +static int __arm_lpae_iopte_walk(struct arm_lpae_io_pgtable *data, + struct io_pgtable_walk_data *walk_data, + arm_lpae_iopte *ptep, + int lvl) { u32 idx; int max_entries, ret; @@ -805,7 +805,7 @@ static int __arm_lpae_iopte_walk_dirty(struct arm_lpae_io_pgtable *data, for (idx = ARM_LPAE_LVL_IDX(walk_data->addr, lvl, data); (idx < max_entries) && (walk_data->addr < walk_data->end); ++idx) { - ret = io_pgtable_visit_dirty(data, walk_data, ptep + idx, lvl); + ret = io_pgtable_visit(data, walk_data, ptep + idx, lvl); if (ret) return ret; } @@ -813,6 +813,23 @@ static int __arm_lpae_iopte_walk_dirty(struct arm_lpae_io_pgtable *data, return 0; } +static int visit_dirty(struct io_pgtable_walk_data *walk_data, int lvl, + arm_lpae_iopte *ptep, size_t size) +{ + struct iommu_dirty_bitmap *dirty = walk_data->data; + + if (!iopte_leaf(*ptep, lvl, walk_data->iop->fmt)) + return 0; + + if (iopte_writeable_dirty(*ptep)) { + iommu_dirty_bitmap_record(dirty, walk_data->addr, size); + if (!(walk_data->flags & IOMMU_DIRTY_NO_CLEAR)) + iopte_set_writeable_clean(ptep); + } + + return 0; +} + static int arm_lpae_read_and_clear_dirty(struct io_pgtable_ops *ops, unsigned long iova, size_t size, unsigned long flags, @@ -821,7 +838,9 @@ static int arm_lpae_read_and_clear_dirty(struct io_pgtable_ops *ops, struct arm_lpae_io_pgtable *data = io_pgtable_ops_to_data(ops); struct io_pgtable_cfg *cfg = &data->iop.cfg; struct io_pgtable_walk_data walk_data = { - .dirty = dirty, + .iop = &data->iop, + .data = dirty, + .visit = visit_dirty, .flags = flags, .addr = iova, .end = iova + size, @@ -836,7 +855,7 @@ static int arm_lpae_read_and_clear_dirty(struct io_pgtable_ops *ops, if (data->iop.fmt != ARM_64_LPAE_S1) return -EINVAL; - return __arm_lpae_iopte_walk_dirty(data, &walk_data, ptep, lvl); + return __arm_lpae_iopte_walk(data, &walk_data, ptep, lvl); } static void arm_lpae_restrict_pgsizes(struct io_pgtable_cfg *cfg) From patchwork Tue Dec 10 16:51:20 2024 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Rob Clark X-Patchwork-Id: 13901787 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 10AFDE7717F for ; Tue, 10 Dec 2024 16:55:10 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20210309; h=Sender:List-Subscribe:List-Help :List-Post:List-Archive:List-Unsubscribe:List-Id:Content-Transfer-Encoding: MIME-Version:References:In-Reply-To:Message-ID:Date:Subject:Cc:To:From: Reply-To:Content-Type:Content-ID:Content-Description:Resent-Date:Resent-From: Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID:List-Owner; bh=8ldrDCueE7EtAyArj20F66jLgkk2NNyODodRKr0ilU8=; b=SlZIR7pTRFfz2H1d80RoJy7+wC ZINeE+2Dx0KxP91fO+6SKKtdIHGo/OColBHgwJgrphX9A5ZUugMMeZPEc9BaN+zxTDkqsk7VTp6iX /7N50Pp04P3udEHxOlcuoDk/S3tVEP7130A+comCP6OPA4IRt7ThTomyfGfq7LkCRKL9TkfM24e9t QI1U8uMdkCVRonWrdURDUPDb8KoocapiA528uVJMCNPZWSx/8TkbcMPWjCGcGvbLOVPmOkjWYpK8O SOeAcRCGDYaDiJb8SOQ9NeK6zNM/WfZdRbaIcKIHIBquNQQ5kXDUiPARNdgva9FN1NFIMBfC03HzB MNRsLC2w==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.98 #2 (Red Hat Linux)) id 1tL3Vi-0000000CAlR-0cVa; Tue, 10 Dec 2024 16:54:58 +0000 Received: from mail-pl1-x635.google.com ([2607:f8b0:4864:20::635]) by bombadil.infradead.org with esmtps (Exim 4.98 #2 (Red Hat Linux)) id 1tL3Sf-0000000CA1B-0K91 for linux-arm-kernel@lists.infradead.org; Tue, 10 Dec 2024 16:51:50 +0000 Received: by mail-pl1-x635.google.com with SMTP id d9443c01a7336-2156e078563so43774705ad.2 for ; Tue, 10 Dec 2024 08:51:48 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20230601; t=1733849508; x=1734454308; darn=lists.infradead.org; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:from:to:cc:subject:date :message-id:reply-to; bh=8ldrDCueE7EtAyArj20F66jLgkk2NNyODodRKr0ilU8=; b=XF0wyAeF/K5xuZFE7O0f8/ZnxM3TFvEmahWmD9eHlKBRPAwHUWVxHLjvt1yYqNbTbz LxhqvK6Az7mspQJqmr6zji6ktjQse+xLd5S1ryjjUcEYJ68u5yBmTE5iIOGVEWy1xpbT cKkL08RfkSha0A5L1Iez22X1CEF8D5ZNEUYyTwmD2KqnfxqRKquDvsuMh/DbyP5RLV9w ZIBQvx6fL4ipknJjURSxQMwwRHXEVP8+a3soznIpj3NiUpA3B6hlhaMJbGZh0GajVj5b cBLJTTOMMm95wbsHdgHixecj0Klc5sEo4o/4nZ+SIU2wi8hrarO2bC6SfwVKCP///BF5 MyeA== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20230601; t=1733849508; x=1734454308; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:x-gm-message-state:from:to:cc :subject:date:message-id:reply-to; bh=8ldrDCueE7EtAyArj20F66jLgkk2NNyODodRKr0ilU8=; b=vljcu1zx9t1+99zVP3Ql1iPdgs0vptCwyL5fMspJW7ljgAcd9XQdnwS9UFKlziGwvX /Vs0PUJAcNPgA3ddKpfgvjTxkLvbI8BFMKXpqlB4ISweiOLi9tqTP+KtT2BWUnMoCUhU JT1Ck1cxSrvcnWHuSHigR1p4LMdQW4gPnmlmMYgOV9Ic8yqyUJr4kTcJz1WBFSTWb3o7 UUVoNi1rVviZjleB7wHvEY622u6fECsNqt4d6fyMm62A4OQH+Qq8ZaYGH8kIHpLQp9Om m9HotnVdcoKzLv3heNBZggG/3Zuwn5I4mYBtXV8+8nsjo9RnjNfO7c1bUrMecx+/LqLQ OE0Q== X-Forwarded-Encrypted: i=1; AJvYcCVoAy79Yyrq9eCegIlaiPnKAz9mt3I3My5ut/5DJRzuc5BfVAAgQ1JsxKJ08xVJYbKYfagiPMl3qYIzoufkpO8G@lists.infradead.org X-Gm-Message-State: AOJu0Yw2rfOK3EcsEsMW7lPhsrAvi+Pm+37mE/G+Mv0OxnhE2LR6gSuM mZyvVTNBPFMHIAKiIg3XEAS8JCwFRhPddR50/4RquXDp0LpEcHB4Vb2GWg== X-Gm-Gg: ASbGncvMiJGr2hXw5Tige3srwSvkA3TKKCdpbSl0kS0LoL69JbSa5wJvtbE31yXtbN0 WiBMQYkcL2XdmOHhyLScy6UUzdRch6uT5hBwojwUqvMRcTtEqMavMEha6BoG7JlejaB26iICWDv lSYnq/9Kcb+7S4UoqEwvPvz7o98ASoVOjw8OtIHBJDW5mf1UahAd5DFADD3V/TMBr5XzPjIskcx xUfd2JGZMl1jV53DREmwwuq40bHT3G5RrmY1ALTkRfH+DCKNfpPZMIFNitxwKMOrlBgZ7lTODN0 6vWqCt2bzWkjCNvCcJnp82K8CFND X-Google-Smtp-Source: AGHT+IHS0LaxpkQDW28nSbT1wx8gEP6+R1uzXYbRGTNeVekseOAHAqPvkFtV0qVh9HekmfV/jSF44A== X-Received: by 2002:a17:902:d2c5:b0:216:725c:a122 with SMTP id d9443c01a7336-216725ca362mr51995685ad.19.1733849508260; Tue, 10 Dec 2024 08:51:48 -0800 (PST) Received: from localhost ([2a00:79e1:2e00:1301:12e9:d196:a1e9:ab67]) by smtp.gmail.com with ESMTPSA id d9443c01a7336-215f8f093a3sm91911265ad.192.2024.12.10.08.51.47 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Tue, 10 Dec 2024 08:51:47 -0800 (PST) From: Rob Clark To: iommu@lists.linux.dev Cc: linux-arm-msm@vger.kernel.org, freedreno@lists.freedesktop.org, Mostafa Saleh , Will Deacon , Rob Clark , Robin Murphy , Joerg Roedel , linux-arm-kernel@lists.infradead.org (moderated list:ARM SMMU DRIVERS), linux-kernel@vger.kernel.org (open list) Subject: [PATCH v11 2/4] iommu/io-pgtable-arm: Re-use the pgtable walk for iova_to_phys Date: Tue, 10 Dec 2024 08:51:20 -0800 Message-ID: <20241210165127.600817-3-robdclark@gmail.com> X-Mailer: git-send-email 2.47.1 In-Reply-To: <20241210165127.600817-1-robdclark@gmail.com> References: <20241210165127.600817-1-robdclark@gmail.com> MIME-Version: 1.0 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20241210_085149_116229_EB53A95A X-CRM114-Status: GOOD ( 13.48 ) X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.34 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org From: Rob Clark Re-use the generic pgtable walk path. Signed-off-by: Rob Clark Reviewed-by: Mostafa Saleh --- drivers/iommu/io-pgtable-arm.c | 74 +++++++++++++++++----------------- 1 file changed, 37 insertions(+), 37 deletions(-) diff --git a/drivers/iommu/io-pgtable-arm.c b/drivers/iommu/io-pgtable-arm.c index 7e9c0f8ae138..88b128c77893 100644 --- a/drivers/iommu/io-pgtable-arm.c +++ b/drivers/iommu/io-pgtable-arm.c @@ -712,42 +712,6 @@ static size_t arm_lpae_unmap_pages(struct io_pgtable_ops *ops, unsigned long iov data->start_level, ptep); } -static phys_addr_t arm_lpae_iova_to_phys(struct io_pgtable_ops *ops, - unsigned long iova) -{ - struct arm_lpae_io_pgtable *data = io_pgtable_ops_to_data(ops); - arm_lpae_iopte pte, *ptep = data->pgd; - int lvl = data->start_level; - - do { - /* Valid IOPTE pointer? */ - if (!ptep) - return 0; - - /* Grab the IOPTE we're interested in */ - ptep += ARM_LPAE_LVL_IDX(iova, lvl, data); - pte = READ_ONCE(*ptep); - - /* Valid entry? */ - if (!pte) - return 0; - - /* Leaf entry? */ - if (iopte_leaf(pte, lvl, data->iop.fmt)) - goto found_translation; - - /* Take it to the next level */ - ptep = iopte_deref(pte, data); - } while (++lvl < ARM_LPAE_MAX_LEVELS); - - /* Ran out of page tables to walk */ - return 0; - -found_translation: - iova &= (ARM_LPAE_BLOCK_SIZE(lvl, data) - 1); - return iopte_to_paddr(pte, data) | iova; -} - struct io_pgtable_walk_data { struct io_pgtable *iop; void *data; @@ -763,6 +727,41 @@ static int __arm_lpae_iopte_walk(struct arm_lpae_io_pgtable *data, arm_lpae_iopte *ptep, int lvl); +struct iova_to_phys_data { + arm_lpae_iopte pte; + int lvl; +}; + +static int visit_iova_to_phys(struct io_pgtable_walk_data *walk_data, int lvl, + arm_lpae_iopte *ptep, size_t size) +{ + struct iova_to_phys_data *data = walk_data->data; + data->pte = *ptep; + data->lvl = lvl; + return 0; +} + +static phys_addr_t arm_lpae_iova_to_phys(struct io_pgtable_ops *ops, + unsigned long iova) +{ + struct arm_lpae_io_pgtable *data = io_pgtable_ops_to_data(ops); + struct iova_to_phys_data d; + struct io_pgtable_walk_data walk_data = { + .data = &d, + .visit = visit_iova_to_phys, + .addr = iova, + .end = iova + 1, + }; + int ret; + + ret = __arm_lpae_iopte_walk(data, &walk_data, data->pgd, data->start_level); + if (ret) + return 0; + + iova &= (ARM_LPAE_BLOCK_SIZE(d.lvl, data) - 1); + return iopte_to_paddr(d.pte, data) | iova; +} + static int io_pgtable_visit(struct arm_lpae_io_pgtable *data, struct io_pgtable_walk_data *walk_data, arm_lpae_iopte *ptep, int lvl) @@ -780,8 +779,9 @@ static int io_pgtable_visit(struct arm_lpae_io_pgtable *data, return 0; } - if (WARN_ON(!iopte_table(pte, lvl))) + if (!iopte_table(pte, lvl)) { return -EINVAL; + } ptep = iopte_deref(pte, data); return __arm_lpae_iopte_walk(data, walk_data, ptep, lvl + 1); From patchwork Tue Dec 10 16:51:21 2024 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Rob Clark X-Patchwork-Id: 13901788 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 EACBBE7717F for ; Tue, 10 Dec 2024 16:56:10 +0000 (UTC) DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=bombadil.20210309; h=Sender:List-Subscribe:List-Help :List-Post:List-Archive:List-Unsubscribe:List-Id:Content-Transfer-Encoding: MIME-Version:References:In-Reply-To:Message-ID:Date:Subject:Cc:To:From: Reply-To:Content-Type:Content-ID:Content-Description:Resent-Date:Resent-From: Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID:List-Owner; bh=KlC6t8gjI6tvzSf5j3uS4n/ZcFOyWrhFgx3uHy4obYw=; b=2przMDpERWlf6m/t4Nh4rVl1uA dWi7b9KPoAfM3WQFhdEmpSzLU9vFOF7SPEi2w/hWJBWXPceb2M1Sr2Z2XGDEcsYeBC7doHqfc0Lyo XBvsc7VtMHppu8uHyaf05V3w6I7vJj9zrPKScsqjKCAlqgpfdVfMuuixWBJIhJ30zwwRxHTngzUcl z/k3hKqU82YvJTa560t0Nc0SoJuuTlNKv9nZRT26r6BKfvA2ZRPgxQ1aSbj2Luaj8iboCgwY4dFCD S63J3zWx4CDla/RlPxLym8v8282lPSWuResq1MGAO/ce2E2uVo6KgbTNQ8Euepqm9m42lOtjuJfV3 cwJbnu5A==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.98 #2 (Red Hat Linux)) id 1tL3Wi-0000000CAtb-3INV; Tue, 10 Dec 2024 16:56:00 +0000 Received: from mail-pf1-x42c.google.com ([2607:f8b0:4864:20::42c]) by bombadil.infradead.org with esmtps (Exim 4.98 #2 (Red Hat Linux)) id 1tL3Sr-0000000CA3a-2JpY for linux-arm-kernel@lists.infradead.org; Tue, 10 Dec 2024 16:52:02 +0000 Received: by mail-pf1-x42c.google.com with SMTP id d2e1a72fcca58-725ce7b82cbso3822404b3a.0 for ; Tue, 10 Dec 2024 08:52:00 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20230601; t=1733849520; x=1734454320; darn=lists.infradead.org; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:from:to:cc:subject:date :message-id:reply-to; bh=KlC6t8gjI6tvzSf5j3uS4n/ZcFOyWrhFgx3uHy4obYw=; b=Ynxetn85oc2PWgABwVKwcL4TMN1lnEDYecs3TY8JIlNVqDYcZ1zxjq+MODPe8y+1z0 suLW1oawWQ0wi24HpCXS0st4vSNJmqh/4eqE3wI5jQRXptlzi56kp7u4A4YdnGQ7uV+a FEev8Ig+uZNrM8siMxpt+js2aBzNBHxprxZUGQSe0/Dp6jacYrv/8plG02HqqI8xgQv3 CXXd0sHYJ55tEXRbFdoxRJN93rBKaHGJ8ZHWL57fai/nQi6R/5KuLrA4mGPn/jTz23UA E19975XujrLFIArXy8MP1fejFz1hpnKiXVXQTlNlbEl3UQzsVP2+Lmnp+MtIjzweHoxz b1CA== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20230601; t=1733849520; x=1734454320; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:x-gm-message-state:from:to:cc :subject:date:message-id:reply-to; bh=KlC6t8gjI6tvzSf5j3uS4n/ZcFOyWrhFgx3uHy4obYw=; b=dPgr82Krv/qBo77it1+looFP8+pzDhP8C+Zj0Wkk1uIi9BnM5t9+WPZbsuCwWBAbJT /w+sy/ZdcI4+C/aSQit/qq6gFeJmiWaJfMNcFw8kXAFcmMHp+ZsNZuaY/iIk+utr66mQ hAI4tA1XGDVXks483AQOdHJbIJIIuSKO0kxQT8yw9STcCAKgcZ6sTWIDOp1ajCMKa/jM sU/dQ5goBBJG8izJCBXHlhXMZpmy+TneFpxtFrrlb/C4SiVu94WcvVt+q+1XW+BpC7Ym 8lf/z0bkxAlGQ/M/MI7yXoqW9u5SpF++SYI7rupwV9527AMExH2SNlNKlxIMNZ27Dao5 ESmA== X-Forwarded-Encrypted: i=1; AJvYcCUT8V8wST6bVZcC3mF5rYSII86FiEFayQD6Za0K9HtBXDi2zpxaBkx8h79hdONimbcCsYP7OYgStUYczt+7agQY@lists.infradead.org X-Gm-Message-State: AOJu0YzkMyCZv3FmlMKwNAdssRR5wsviv3NdBPrkqXp+vViqpUDhIoWw P5o7YbpFi3MnKbkhOZrXMw8c0x6ERXzXQgMbj6DtQJnZmpY3FoGd X-Gm-Gg: ASbGncsv+y9yhrtl/ODAbDBoVS74jZqZ7HCN+KUbCJoTr1uQfZ8bzTRHq10r+Ihgn5P dQHVNjVs8CL+qSUZesHJsaiQeqVndnrQFaeWqsDt7TltHHsjyqok5zIIdnd8CtmIj15rvh3xU// VkYpi2LdskKOrGXYWCtMcpTMK/NaoYdTV/Ow/HK/qwhZEmae+NXhWvS2d+eOWypUjc4Hma7wH3f mowpfy+RGtRpHe2uKDt+IhmlHpTPJIZ4CHgD71+n1XUUbeRVHt5PXJjPDPvrkX1+v1THJWxwf1N SehcetXMDW7LKRql6HMQQjwQ49tJE6A= X-Google-Smtp-Source: AGHT+IH1n6c0fXB/5rusM6KflQSKemThS3VyuHQY8wT9jvY3JVEpZqXFRbfZPqjeknRfEZ0z87Krzw== X-Received: by 2002:a05:6a00:c89:b0:725:f376:f4ff with SMTP id d2e1a72fcca58-7273cb14556mr7832493b3a.13.1733849520359; Tue, 10 Dec 2024 08:52:00 -0800 (PST) Received: from localhost ([2a00:79e1:2e00:1301:12e9:d196:a1e9:ab67]) by smtp.gmail.com with ESMTPSA id d2e1a72fcca58-7261829be9dsm3195343b3a.89.2024.12.10.08.51.59 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Tue, 10 Dec 2024 08:51:59 -0800 (PST) From: Rob Clark To: iommu@lists.linux.dev Cc: linux-arm-msm@vger.kernel.org, freedreno@lists.freedesktop.org, Mostafa Saleh , Will Deacon , Rob Clark , Robin Murphy , Joerg Roedel , Jason Gunthorpe , Shameer Kolothum , Nicolin Chen , Ryan Roberts , Joao Martins , linux-arm-kernel@lists.infradead.org (moderated list:ARM SMMU DRIVERS), linux-kernel@vger.kernel.org (open list) Subject: [PATCH v11 3/4] iommu/io-pgtable-arm: Add way to debug pgtable walk Date: Tue, 10 Dec 2024 08:51:21 -0800 Message-ID: <20241210165127.600817-4-robdclark@gmail.com> X-Mailer: git-send-email 2.47.1 In-Reply-To: <20241210165127.600817-1-robdclark@gmail.com> References: <20241210165127.600817-1-robdclark@gmail.com> MIME-Version: 1.0 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20241210_085201_592948_1E664425 X-CRM114-Status: GOOD ( 12.85 ) X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.34 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org From: Rob Clark Add an io-pgtable method to walk the pgtable returning the raw PTEs that would be traversed for a given iova access. Signed-off-by: Rob Clark --- drivers/iommu/io-pgtable-arm.c | 26 ++++++++++++++++++++++++++ include/linux/io-pgtable.h | 15 +++++++++++++++ 2 files changed, 41 insertions(+) diff --git a/drivers/iommu/io-pgtable-arm.c b/drivers/iommu/io-pgtable-arm.c index 88b128c77893..c51c48851f9f 100644 --- a/drivers/iommu/io-pgtable-arm.c +++ b/drivers/iommu/io-pgtable-arm.c @@ -762,6 +762,31 @@ static phys_addr_t arm_lpae_iova_to_phys(struct io_pgtable_ops *ops, return iopte_to_paddr(d.pte, data) | iova; } +static int visit_pgtable_walk(struct io_pgtable_walk_data *walk_data, int lvl, + arm_lpae_iopte *ptep, size_t size) +{ + struct arm_lpae_io_pgtable_walk_data *data = walk_data->data; + data->ptes[lvl] = *ptep; + data->level = lvl + 1; + return 0; +} + +static int arm_lpae_pgtable_walk(struct io_pgtable_ops *ops, unsigned long iova, + void *wd) +{ + struct arm_lpae_io_pgtable *data = io_pgtable_ops_to_data(ops); + struct io_pgtable_walk_data walk_data = { + .data = wd, + .visit = visit_pgtable_walk, + .addr = iova, + .end = iova + 1, + }; + + ((struct arm_lpae_io_pgtable_walk_data *)wd)->level = 0; + + return __arm_lpae_iopte_walk(data, &walk_data, data->pgd, data->start_level); +} + static int io_pgtable_visit(struct arm_lpae_io_pgtable *data, struct io_pgtable_walk_data *walk_data, arm_lpae_iopte *ptep, int lvl) @@ -937,6 +962,7 @@ arm_lpae_alloc_pgtable(struct io_pgtable_cfg *cfg) .unmap_pages = arm_lpae_unmap_pages, .iova_to_phys = arm_lpae_iova_to_phys, .read_and_clear_dirty = arm_lpae_read_and_clear_dirty, + .pgtable_walk = arm_lpae_pgtable_walk, }; return data; diff --git a/include/linux/io-pgtable.h b/include/linux/io-pgtable.h index b1ecfc3cd5bc..d7bfbf351975 100644 --- a/include/linux/io-pgtable.h +++ b/include/linux/io-pgtable.h @@ -178,12 +178,26 @@ struct io_pgtable_cfg { }; }; +/** + * struct arm_lpae_io_pgtable_walk_data - information from a pgtable walk + * + * @ptes: The recorded PTE values from the walk + * @level: The level of the last PTE + * + * @level also specifies the last valid index in @ptes + */ +struct arm_lpae_io_pgtable_walk_data { + u64 ptes[4]; + int level; +}; + /** * struct io_pgtable_ops - Page table manipulation API for IOMMU drivers. * * @map_pages: Map a physically contiguous range of pages of the same size. * @unmap_pages: Unmap a range of virtually contiguous pages of the same size. * @iova_to_phys: Translate iova to physical address. + * @pgtable_walk: (optional) Perform a page table walk for a given iova. * * These functions map directly onto the iommu_ops member functions with * the same names. @@ -197,6 +211,7 @@ struct io_pgtable_ops { struct iommu_iotlb_gather *gather); phys_addr_t (*iova_to_phys)(struct io_pgtable_ops *ops, unsigned long iova); + int (*pgtable_walk)(struct io_pgtable_ops *ops, unsigned long iova, void *wd); int (*read_and_clear_dirty)(struct io_pgtable_ops *ops, unsigned long iova, size_t size, unsigned long flags,