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 3A002C433F5 for ; Sun, 27 Feb 2022 21:02:26 +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:MIME-Version:List-Subscribe:List-Help: List-Post:List-Archive:List-Unsubscribe:List-Id:References:In-Reply-To: Message-Id:Date:Subject:Cc:To:From:Reply-To:Content-ID:Content-Description: Resent-Date:Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID: List-Owner; bh=8VKiqDv7Sopdtq+0d0vATvRUxEDMXW5MwsdOVgP14S0=; b=SmJODpC26OWIbE u2NDxYCSj0D+zSgkAvg4/KMgD3PFvyfBgcZAzIjk7MEF0o1c9meF6F89MBMwSsTykTh7HtugeU8uY +sKzw9yjAszI/GE/CcpWLuhpApg2+qDB9iOzE85osLMFz4mQED8jehWF7xfgdZGeQbJipbklXFjan o69uFuQ6Yh1a4JneHiztl98T2KWlFZdxonYvFZo0f1wNhafUez6RXeVBf+Av+KeDvZAfzKXXaLnnH XPZVp5fHLMq8cYtsK7BP9RhusE1WxfJ0jxup/LG3qNxiq4pBNuDIC15pln1vPKf8C0I94zkI597s3 twh7t+iKAcubO0dC6sgg==; Received: from localhost ([::1] helo=bombadil.infradead.org) by bombadil.infradead.org with esmtp (Exim 4.94.2 #2 (Red Hat Linux)) id 1nOQf6-00A9Tw-VI; Sun, 27 Feb 2022 21:01:06 +0000 Received: from foss.arm.com ([217.140.110.172]) by bombadil.infradead.org with esmtp (Exim 4.94.2 #2 (Red Hat Linux)) id 1nOQax-00A7Gx-J7 for linux-arm-kernel@lists.infradead.org; Sun, 27 Feb 2022 20:56:45 +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 56994106F; Sun, 27 Feb 2022 12:56:43 -0800 (PST) Received: from e120937-lin.home (unknown [172.31.20.19]) by usa-sjc-imap-foss1.foss.arm.com (Postfix) with ESMTPSA id ECDA33F66F; Sun, 27 Feb 2022 12:56:41 -0800 (PST) From: Cristian Marussi To: linux-kernel@vger.kernel.org, linux-arm-kernel@lists.infradead.org Cc: sudeep.holla@arm.com, james.quinlan@broadcom.com, Jonathan.Cameron@Huawei.com, f.fainelli@gmail.com, vincent.guittot@linaro.org, souvik.chakravarty@arm.com, peter.hilber@opensynergy.com, cristian.marussi@arm.com Subject: [RFC PATCH 13/16] firmware: arm_scmi: Add testing Power protocol support Date: Sun, 27 Feb 2022 20:56:05 +0000 Message-Id: <20220227205608.30812-14-cristian.marussi@arm.com> X-Mailer: git-send-email 2.17.1 In-Reply-To: <20220227205608.30812-1-cristian.marussi@arm.com> References: <20220227205608.30812-1-cristian.marussi@arm.com> X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20220227_125643_800510_EDA743C6 X-CRM114-Status: GOOD ( 18.84 ) 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: , MIME-Version: 1.0 Content-Type: text/plain; charset="us-ascii" Content-Transfer-Encoding: 7bit Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org firmware: arm_scmi: Add testing Power protocol support Signed-off-by: Cristian Marussi --- .../arm_scmi/scmi_test_driver/Makefile | 3 +- .../arm_scmi/scmi_test_driver/scmi_test.c | 2 + .../arm_scmi/scmi_test_driver/test_common.h | 1 + .../arm_scmi/scmi_test_driver/test_powers.c | 105 ++++++++++++++++++ 4 files changed, 110 insertions(+), 1 deletion(-) create mode 100644 drivers/firmware/arm_scmi/scmi_test_driver/test_powers.c diff --git a/drivers/firmware/arm_scmi/scmi_test_driver/Makefile b/drivers/firmware/arm_scmi/scmi_test_driver/Makefile index 458883193f31..68a3d94a6a88 100644 --- a/drivers/firmware/arm_scmi/scmi_test_driver/Makefile +++ b/drivers/firmware/arm_scmi/scmi_test_driver/Makefile @@ -1,4 +1,5 @@ # SPDX-License-Identifier: GPL-2.0-only -scmi_test_driver-objs := scmi_test.o test_common.o test_clocks.o test_sensors.o +scmi_test_driver-objs := scmi_test.o test_common.o test_clocks.o test_sensors.o \ + test_powers.o obj-$(CONFIG_ARM_SCMI_TEST_DRIVER) += scmi_test_driver.o diff --git a/drivers/firmware/arm_scmi/scmi_test_driver/scmi_test.c b/drivers/firmware/arm_scmi/scmi_test_driver/scmi_test.c index 04e01dd114c9..df0d3e572010 100644 --- a/drivers/firmware/arm_scmi/scmi_test_driver/scmi_test.c +++ b/drivers/firmware/arm_scmi/scmi_test_driver/scmi_test.c @@ -23,6 +23,7 @@ DEFINE_MUTEX(scmi_test_mtx); static int (*scmi_test_init[SCMI_MAX_PROTOCOLS])(struct scmi_test_setup *) = { + [SCMI_PROTOCOL_POWER] = scmi_test_power_init, [SCMI_PROTOCOL_CLOCK] = scmi_test_clock_init, [SCMI_PROTOCOL_SENSOR] = scmi_test_sensor_init, }; @@ -126,6 +127,7 @@ static int scmi_testing_probe(struct scmi_device *sdev) static const struct scmi_device_id scmi_id_table[] = { { SCMI_PROTOCOL_CLOCK, "__scmi_test-clock" }, { SCMI_PROTOCOL_SENSOR, "__scmi_test-sensor" }, + { SCMI_PROTOCOL_POWER, "__scmi_test-power" }, { }, }; MODULE_DEVICE_TABLE(scmi, scmi_id_table); diff --git a/drivers/firmware/arm_scmi/scmi_test_driver/test_common.h b/drivers/firmware/arm_scmi/scmi_test_driver/test_common.h index 93c05db0ebff..9f3d35ba4477 100644 --- a/drivers/firmware/arm_scmi/scmi_test_driver/test_common.h +++ b/drivers/firmware/arm_scmi/scmi_test_driver/test_common.h @@ -102,5 +102,6 @@ int scmi_test_release(struct inode *ino, struct file *filp); int scmi_test_clock_init(struct scmi_test_setup *tsp); int scmi_test_sensor_init(struct scmi_test_setup *tsp); +int scmi_test_power_init(struct scmi_test_setup *tsp); #endif /* __SCMI_TEST_COMMON_H */ diff --git a/drivers/firmware/arm_scmi/scmi_test_driver/test_powers.c b/drivers/firmware/arm_scmi/scmi_test_driver/test_powers.c new file mode 100644 index 000000000000..5db1662f2dc7 --- /dev/null +++ b/drivers/firmware/arm_scmi/scmi_test_driver/test_powers.c @@ -0,0 +1,105 @@ +// SPDX-License-Identifier: GPL-2.0 +/* + * SCMI Testing Driver - Power Protocol + * + * Copyright (C) 2022 ARM Ltd. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include "test_common.h" + +struct scmi_power_data { + unsigned int version; + int count; +}; + +static ssize_t scmi_test_power_info_read(struct file *filp, char __user *buf, + size_t count, loff_t *ppos) +{ + struct scmi_test_buffer *data = filp->private_data; + + if (!data) + return 0; + + if (!data->used) { + u32 pstate; + char *pname; + struct scmi_test_setup *tsp = filp->f_inode->i_private; + const struct scmi_power_proto_ops *power_ops = tsp->ops; + + pname = power_ops->name_get(tsp->ph, data->id); + power_ops->state_get(tsp->ph, data->id, &pstate); + + data->used = scnprintf(data->buf, data->len, + "%s -> state:%d\n", + pname, pstate); + } + + if (*ppos >= data->used) + return 0; + + if (count > data->used) + count = data->used; + + count -= copy_to_user(buf, data->buf + *ppos, count); + *ppos += count; + + return count; +} + +static const struct file_operations test_power_info_fops = { + .open = scmi_test_setup_open, + .release = scmi_test_release, + .read = scmi_test_power_info_read, +}; + +int scmi_test_power_init(struct scmi_test_setup *tsp) +{ + int i; + struct scmi_power_data *pdata; + const struct scmi_power_proto_ops *power_ops; + struct device *dev = &tsp->sdev->dev; + + pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL); + if (!pdata) + return -ENOMEM; + + power_ops = tsp->ops; + pdata->version = power_ops->version_get(tsp->ph); + pdata->count = power_ops->num_domains_get(tsp->ph); + + if (pdata->count <= 0) { + dev_err(dev, "number of domains invalid: %d\n", + pdata->count); + return pdata->count ?: -EINVAL; + } + + tsp->priv = pdata; + debugfs_create_x32("version", 0400, tsp->parent, &pdata->version); + + dev_info(dev, "Found %d power-domain resources.\n", pdata->count); + + for (i = 0; i < pdata->count; i++) { + char power_dir[16]; + struct dentry *power_dentry; + + snprintf(power_dir, 16, "%03d", i); + power_dentry = debugfs_create_dir(power_dir, tsp->parent); + if (!IS_ERR(power_dentry)) { + debugfs_create_file("info", 0400, + power_dentry, tsp, + &test_power_info_fops); + } + } + + return 0; +} -- 2.17.1 _______________________________________________ linux-arm-kernel mailing list linux-arm-kernel@lists.infradead.org http://lists.infradead.org/mailman/listinfo/linux-arm-kernel