From patchwork Tue Sep 19 17:40:55 2023 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 8bit X-Patchwork-Submitter: Sudeep Holla X-Patchwork-Id: 13391637 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 138C6CE79A8 for ; Tue, 19 Sep 2023 17:42: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: Content-Transfer-Encoding:Content-Type:List-Subscribe:List-Help:List-Post: List-Archive:List-Unsubscribe:List-Id:To:In-Reply-To:References:Message-Id: MIME-Version:Subject:Date:From:Reply-To:Cc:Content-ID:Content-Description: Resent-Date:Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID: List-Owner; bh=XLzwYpq4hezXJKjF/8ZMepNxXrF6p/yZTEOhdJVAKg0=; b=G5tpZhAy4WWbI9 3nnJMOEtEcYt3mlZAOwzEQXa22a7diz9XqQ9phMdOIdBtxxQSvPcSIx7oW+RhSRTQ2S8254jrx1/+ Jsh6NxR7rbhUNPMAjTFGwukw8T4OnXcsEtlTHP3h3ECz3JNpQWNkOWjC0IkfjWvXF1wGD1rAxeElB W2Zb8LxDdI/p6cJQA4VF8PY09aJ9sjE3JXcNZTLp9dkEDqyJOV8FvkjrXgq6nE7XMbM5QUnRjGBf3 dYOVmnC3J0aIBkvv7JYuhQ2N2nZxyHI2Yekx76XcJeOTV2uKG1bXJWlZSnHvtUx09MPJGAIW7ptH1 xJyKsypeiiI4u/wGxLYQ==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.96 #2 (Red Hat Linux)) id 1qiejB-000xJO-2B; Tue, 19 Sep 2023 17:41:37 +0000 Received: from foss.arm.com ([217.140.110.172]) by bombadil.infradead.org with esmtp (Exim 4.96 #2 (Red Hat Linux)) id 1qiej3-000xDs-0J for linux-arm-kernel@lists.infradead.org; Tue, 19 Sep 2023 17:41:31 +0000 Received: from usa-sjc-imap-foss1.foss.arm.com (unknown [10.121.207.14]) by usa-sjc-mx-foss1.foss.arm.com (Postfix) with ESMTP id 4857FC15; Tue, 19 Sep 2023 10:42:04 -0700 (PDT) Received: from e103737-lin.cambridge.arm.com (e103737-lin.cambridge.arm.com [10.1.197.49]) by usa-sjc-imap-foss1.foss.arm.com (Postfix) with ESMTPSA id F141F3F5A1; Tue, 19 Sep 2023 10:41:25 -0700 (PDT) From: Sudeep Holla Date: Tue, 19 Sep 2023 18:40:55 +0100 Subject: [PATCH RFT v2 07/18] firmware: arm_ffa: Implement the NOTIFICATION_INFO_GET interface MIME-Version: 1.0 Message-Id: <20230919-ffa_v1-1_notif-v2-7-6f3a3ca3923c@arm.com> References: <20230919-ffa_v1-1_notif-v2-0-6f3a3ca3923c@arm.com> In-Reply-To: <20230919-ffa_v1-1_notif-v2-0-6f3a3ca3923c@arm.com> To: linux-arm-kernel@lists.infradead.org, linux-kernel@vger.kernel.org, Sudeep Holla , Jens Wiklander , Marc Bonnici , Coboy Chen , Lorenzo Pieralisi , Olivier Deprez X-Mailer: b4 0.12.3 X-Developer-Signature: v=1; a=openpgp-sha256; l=3494; i=sudeep.holla@arm.com; h=from:subject:message-id; bh=M4lP+tc3FjAbYZf7s9A0uNcF+W8wy+ah17rMKCRmgS4=; b=owEBbQKS/ZANAwAIAQBBurwxfuKYAcsmYgBlCd07RVRasohWgmkneYDdBAwnm+z0VZdrL+/Lz k4lzOccqHGJAjMEAAEIAB0WIQS6ceUSBvMeskPdk+EAQbq8MX7imAUCZQndOwAKCRAAQbq8MX7i mHAMD/9WY6poq8i83+jU1+lc6BWslG93GKwWMvPwVYNEOCaBKgCPNauGeG6LwAqFvTB7WXZPQ5o eP1S18P5wshVJYGCmGxRaB1nYKXqt1ps858Kwp4bYcen7NkFgflWclHiTIGx2Nm1oAZ5Wd78HrU vA+GUt38o06lZQLizCe36Jaxx9EXB8kMTK6rn6OnAUZ/F37I5VDw5YTwELrnQY2qRmaPBzXAdXF kXPuZEmLv+/3eRqhyBMah4v2RlUmUsZdWbdEjJsOLgsS+cBRLEUXocpzOCekeu4T9uiZAXdrUL8 XC9IHQAxHSUVLkAulX3vT+tbgmFAJ74KqlbJXPtJzDdx981YiD0Lk5xDbb6emgz4kcjMHMj+dBh 04PPAgXfU1e2gTLy1+8Q90WnUJAQ5i9syPMLpGXDGeMNaeM+8G9XB2JVhvJvIe3/QgJeDktreE7 ZkaN6vAYBOl+2qZ6B4gpvKc5or5HIZ6j6dyK25nTcd6nUY9BtfIIvLKPt0A7kfF5iIUJTpnpkTI uqyIiCURilh3GkzQsuad8lMTBthHytCyapdUojxk4+NnlFoP4ipRC7YtTuluvUK8oQ2eAi20R0F LKw+KQHwzWWHzQZhObbT9snbeG/WeByPxkR0crPlBkQ4hPBwba7USNuoIV64wpgAunF2pZVZ22o 7gAvfKR1eo+dMig== X-Developer-Key: i=sudeep.holla@arm.com; a=openpgp; fpr=7360A21742ADF5A11767C1C139CFD4755FE2D5B4 X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20230919_104129_226801_C494E214 X-CRM114-Status: GOOD ( 13.00 ) 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 The receiver’s scheduler uses the FFA_NOTIFICATION_INFO_GET interface to retrieve the list of endpoints that have pending notifications and must be run. A notification could be signaled by a sender in the secure world to a VM. The Hypervisor needs to determine which VM and vCPU (in case a per-vCPU notification is signaled) has a pending notification in this scenario. It must obtain this information through an invocation of the FFA_NOTIFICATION_INFO_GET. Add the implementation of the NOTIFICATION_INFO_GET interface and prepare to use this to handle the schedule receiver interrupt. Implementation of handling notifications will be added later. Signed-off-by: Sudeep Holla --- drivers/firmware/arm_ffa/driver.c | 70 +++++++++++++++++++++++++++++++++++++++ 1 file changed, 70 insertions(+) diff --git a/drivers/firmware/arm_ffa/driver.c b/drivers/firmware/arm_ffa/driver.c index acb58715687c..e097e894b433 100644 --- a/drivers/firmware/arm_ffa/driver.c +++ b/drivers/firmware/arm_ffa/driver.c @@ -590,6 +590,13 @@ static int ffa_notification_bitmap_destroy(void) (FIELD_PREP(RECEIVER_VCPU_MASK, (vcpu_r)) | \ FIELD_PREP(RECEIVER_ID_MASK, (r))) +#define NOTIFICATION_INFO_GET_MORE_PEND_MASK BIT(0) +#define NOTIFICATION_INFO_GET_ID_COUNT GENMASK(11, 7) +#define ID_LIST_MASK_64 GENMASK(51, 12) +#define ID_LIST_MASK_32 GENMASK(31, 12) +#define MAX_IDS_64 20 +#define MAX_IDS_32 10 + static int ffa_notification_bind_common(u16 dst_id, u64 bitmap, u32 flags, bool is_bind) { @@ -661,6 +668,69 @@ static int ffa_notification_get(u32 flags, struct ffa_notify_bitmaps *notify) return 0; } +static void __do_sched_recv_cb(u16 partition_id, u16 vcpu, bool is_per_vcpu) +{ + pr_err("Callback for partition 0x%x failed.\n", partition_id); +} + +static void ffa_notification_info_get(bool is_64b) +{ + int idx, list, max_ids, lists_cnt, ids_processed, ids_count[MAX_IDS_64]; + ffa_value_t ret; + u64 id_list; + + do { + invoke_ffa_fn((ffa_value_t){ + .a0 = FFA_FN_NATIVE(NOTIFICATION_INFO_GET), + }, &ret); + + if (ret.a0 != FFA_FN_NATIVE(SUCCESS)) { + if (ret.a2 != FFA_RET_NO_DATA) + pr_err("Notification Info fetch failed: 0x%lx (0x%lx)", + ret.a0, ret.a2); + return; + } + + ids_processed = 0; + lists_cnt = FIELD_GET(NOTIFICATION_INFO_GET_ID_COUNT, ret.a2); + if (is_64b) { + max_ids = MAX_IDS_64; + id_list = FIELD_GET(ID_LIST_MASK_64, ret.a2); + } else { + max_ids = MAX_IDS_32; + id_list = FIELD_GET(ID_LIST_MASK_32, ret.a2); + } + + for (idx = 0; idx < lists_cnt; idx++, id_list >>= 2) + ids_count[idx] = (id_list & 0x3) + 1; + + /* Process IDs */ + for (list = 0; list < lists_cnt; list++) { + u16 vcpu_id, part_id, *packed_id_list = (u16 *)&ret.a3; + + if (ids_processed >= max_ids - 1) + break; + + part_id = packed_id_list[++ids_processed]; + + if (!ids_count[list]) { /* Global Notification */ + __do_sched_recv_cb(part_id, 0, false); + continue; + } + + /* Per vCPU Notification */ + for (idx = 0; idx < ids_count[list]; idx++) { + if (ids_processed >= max_ids - 1) + break; + + vcpu_id = packed_id_list[++ids_processed]; + + __do_sched_recv_cb(part_id, vcpu_id, true); + } + } + } while (ret.a2 & NOTIFICATION_INFO_GET_MORE_PEND_MASK); +} + static int ffa_run(struct ffa_device *dev, u16 vcpu) { ffa_value_t ret;