From patchwork Tue Jan 2 14:42:32 2018 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Sudeep Holla X-Patchwork-Id: 123144 Delivered-To: patch@linaro.org Received: by 10.140.22.227 with SMTP id 90csp9044813qgn; Tue, 2 Jan 2018 06:46:39 -0800 (PST) X-Google-Smtp-Source: ACJfBotKJNqwwASDI661iGKa4dvxuoC6agwsOSQt1TRx3IBTIE4cD4i067mt5ei7xhA8PDZg5mbt X-Received: by 10.99.109.13 with SMTP id i13mr39029100pgc.451.1514904399336; Tue, 02 Jan 2018 06:46:39 -0800 (PST) ARC-Seal: i=1; a=rsa-sha256; t=1514904399; cv=none; d=google.com; s=arc-20160816; b=h59ktn8F/nnNablauxEBta2cX6GTP9Svdf/zDTXVhagG+ffMjzfu5g1znQMOU4a++O Vuo+wIf4RZYOcaTvLXHFtZ8M6wFdopS+L+jouRQ92BVdECEOnNollw9LlznBJ69uCNCI wWaoSNq3QjTi3Ml8XJPmV2VR32tIDpNvbP/zZNp1+NhRDZ5WmcbtM+QUNHy9FTYzUqr+ Q5m7iLsO+j+mgSv0eH/vHUMMgpt6p2azedTKn/TX6eddQc0z56J4WEOnZ6wyeHeUwB/+ aBCu8RjurAH1YiU2DbNwHWkcUxB22kdxL/uwhyTyyZX/uFfl420A75KBbMhLokeVLJ+h jA3w== 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:arc-authentication-results; bh=VZ59DcYJKiNVBmqtkuMi6MaJeIHnjJR36aD0CdRTKPE=; b=UX0ncoB8GKxDfU6qQe8MI7Cb8spms6usmHAI1poigm5Hx8K7CBTMR0oy+kpmub2VhU KwSFZJeucRugrnmG33JXW/qEfRYjspSHapqK8TYkzcAp/DfLDAU6uh7FgTK10X6nxe6e vg08k8sUya1cWPaug7Uj8BSLAy1zYOgRcXSWcoC1w+h2V/m8VdeclZmVXBJSsPGiEER0 U/K833Tja5Z6cQwOortv5usU7noWtwkPg/6j5IeDint1ImD+WSawhyYdDW3syXNU+gzi 2OZJt9F5hSk2TjLcQOFatAoSwEtSRKtbQxEQgB6V1FdncLlZS/k6WKqQ2JqPAPhxcCfp x0PA== ARC-Authentication-Results: i=1; mx.google.com; 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 Return-Path: Received: from vger.kernel.org (vger.kernel.org. [209.132.180.67]) by mx.google.com with ESMTP id o3si14081358pgv.153.2018.01.02.06.46.39; Tue, 02 Jan 2018 06:46:39 -0800 (PST) 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; 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 Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1753783AbeABOqf (ORCPT + 28 others); Tue, 2 Jan 2018 09:46:35 -0500 Received: from usa-sjc-mx-foss1.foss.arm.com ([217.140.101.70]:39756 "EHLO foss.arm.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1753007AbeABOnV (ORCPT ); Tue, 2 Jan 2018 09:43:21 -0500 Received: from usa-sjc-imap-foss1.foss.arm.com (unknown [10.72.51.249]) by usa-sjc-mx-foss1.foss.arm.com (Postfix) with ESMTP id 186E9165C; Tue, 2 Jan 2018 06:43:21 -0800 (PST) Received: from e107155-lin.cambridge.arm.com (e107155-lin.cambridge.arm.com [10.1.210.28]) by usa-sjc-imap-foss1.foss.arm.com (Postfix) with ESMTPA id 05EB23F25C; Tue, 2 Jan 2018 06:43:18 -0800 (PST) From: Sudeep Holla To: ALKML , LKML , DTML Cc: Sudeep Holla , Roy Franz , Harb Abdulhamid , Nishanth Menon , Arnd Bergmann , Loc Ho , Alexey Klimov , Ryan Harkin , Jassi Brar Subject: [PATCH v5 10/20] firmware: arm_scmi: probe and initialise all the supported protocols Date: Tue, 2 Jan 2018 14:42:32 +0000 Message-Id: <1514904162-11201-11-git-send-email-sudeep.holla@arm.com> X-Mailer: git-send-email 2.7.4 In-Reply-To: <1514904162-11201-1-git-send-email-sudeep.holla@arm.com> References: <1514904162-11201-1-git-send-email-sudeep.holla@arm.com> Sender: linux-kernel-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org Now that we have basic support for all the protocols in the specification, let's probe them individually and initialise them. Cc: Arnd Bergmann Signed-off-by: Sudeep Holla --- drivers/firmware/arm_scmi/driver.c | 51 +++++++++++++++++++++++++++++++++++++- 1 file changed, 50 insertions(+), 1 deletion(-) -- 2.7.4 diff --git a/drivers/firmware/arm_scmi/driver.c b/drivers/firmware/arm_scmi/driver.c index 20d083be474c..11c18ac9816f 100644 --- a/drivers/firmware/arm_scmi/driver.c +++ b/drivers/firmware/arm_scmi/driver.c @@ -494,6 +494,21 @@ void scmi_setup_protocol_implemented(const struct scmi_handle *handle, info->protocols_imp = prot_imp; } +static bool +scmi_is_protocol_implemented(const struct scmi_handle *handle, u8 prot_id) +{ + int i; + struct scmi_info *info = handle_to_scmi_info(handle); + + if (!info->protocols_imp) + return false; + + for (i = 0; i < MAX_PROTOCOLS_IMP; i++) + if (info->protocols_imp[i] == prot_id) + return true; + return false; +} + /** * scmi_handle_get() - Get the SCMI handle for a device * @@ -691,6 +706,23 @@ static inline int scmi_mbox_chan_setup(struct scmi_info *info) return 0; } +static inline void +scmi_create_protocol_device(struct device_node *np, struct scmi_info *info, + int prot_id) +{ + struct scmi_device *sdev; + + sdev = scmi_device_create(np, info->dev, prot_id); + if (!sdev) { + dev_err(info->dev, "failed to create %d protocol device\n", + prot_id); + return; + } + + /* setup handle now as the transport is ready */ + scmi_set_handle(sdev); +} + static int scmi_probe(struct platform_device *pdev) { int ret; @@ -698,7 +730,7 @@ static int scmi_probe(struct platform_device *pdev) const struct scmi_desc *desc; struct scmi_info *info; struct device *dev = &pdev->dev; - struct device_node *np = dev->of_node; + struct device_node *child, *np = dev->of_node; /* Only mailbox method supported, check for the presence of one */ if (scmi_mailbox_check(np)) { @@ -741,6 +773,23 @@ static int scmi_probe(struct platform_device *pdev) list_add_tail(&info->node, &scmi_list); mutex_unlock(&scmi_list_mutex); + for_each_available_child_of_node(np, child) { + u32 prot_id; + + if (of_property_read_u32(child, "reg", &prot_id)) + continue; + + prot_id &= MSG_PROTOCOL_ID_MASK; + + if (!scmi_is_protocol_implemented(handle, prot_id)) { + dev_err(dev, "SCMI protocol %d not implemented\n", + prot_id); + continue; + } + + scmi_create_protocol_device(child, info, prot_id); + } + return 0; }