From: Cristian Marussi <cristian.marussi@arm.com>
To: linux-kernel@vger.kernel.org, linux-arm-kernel@lists.infradead.org
Cc: sudeep.holla@arm.com, lukasz.luba@arm.com,
james.quinlan@broadcom.com, Jonathan.Cameron@Huawei.com,
f.fainelli@gmail.com, etienne.carriere@linaro.org,
thara.gopinath@linaro.org, vincent.guittot@linaro.org,
souvik.chakravarty@arm.com, cristian.marussi@arm.com
Subject: [PATCH 09/11] [DEBUG] firmware: arm_scmi: add example SCMI driver for custom protocol
Date: Wed, 14 Oct 2020 16:05:43 +0100 [thread overview]
Message-ID: <20201014150545.44807-10-cristian.marussi@arm.com> (raw)
In-Reply-To: <20201014150545.44807-1-cristian.marussi@arm.com>
Add an example SCMI driver using custom vendor protocol 0x99 and also
registering for Performance protocol notifications.
Signed-off-by: Cristian Marussi <cristian.marussi@arm.com>
---
drivers/firmware/Kconfig | 7 +
drivers/firmware/arm_scmi/Makefile | 2 +
drivers/firmware/arm_scmi/scmi_custom_dummy.c | 126 ++++++++++++++++++
3 files changed, 135 insertions(+)
create mode 100644 drivers/firmware/arm_scmi/scmi_custom_dummy.c
diff --git a/drivers/firmware/Kconfig b/drivers/firmware/Kconfig
index 75e2668a6490..d209df6fd3ee 100644
--- a/drivers/firmware/Kconfig
+++ b/drivers/firmware/Kconfig
@@ -48,6 +48,13 @@ config ARM_SCMI_POWER_DOMAIN
will be called scmi_pm_domain. Note this may needed early in boot
before rootfs may be available.
+config ARM_SCMI_CUSTOM_DUMMY
+ tristate "SCMI Custom Dummy driver"
+ depends on ARM_SCMI_PROTOCOL_CUSTOM || (COMPILE_TEST && OF)
+ default n
+ help
+ Custom Dummy driver
+
config ARM_SCPI_PROTOCOL
tristate "ARM System Control and Power Interface (SCPI) Message Protocol"
depends on ARM || ARM64 || COMPILE_TEST
diff --git a/drivers/firmware/arm_scmi/Makefile b/drivers/firmware/arm_scmi/Makefile
index 0a03b7432497..361ede03cdb5 100644
--- a/drivers/firmware/arm_scmi/Makefile
+++ b/drivers/firmware/arm_scmi/Makefile
@@ -12,3 +12,5 @@ obj-$(CONFIG_ARM_SCMI_PROTOCOL_CUSTOM) += scmi_custom.o
obj-$(CONFIG_ARM_SCMI_PROTOCOL) += scmi-module.o
obj-$(CONFIG_ARM_SCMI_POWER_DOMAIN) += scmi_pm_domain.o
+
+obj-$(CONFIG_ARM_SCMI_CUSTOM_DUMMY) += scmi_custom_dummy.o
diff --git a/drivers/firmware/arm_scmi/scmi_custom_dummy.c b/drivers/firmware/arm_scmi/scmi_custom_dummy.c
new file mode 100644
index 000000000000..28fd3595a690
--- /dev/null
+++ b/drivers/firmware/arm_scmi/scmi_custom_dummy.c
@@ -0,0 +1,126 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ *
+ * Copyright (C) 2018-2020 ARM Ltd.
+ */
+
+#include <linux/err.h>
+#include <linux/io.h>
+#include <linux/module.h>
+#include <linux/pm_domain.h>
+#include <linux/scmi_protocol.h>
+
+static const struct scmi_dummy_ops *dummy_ops;
+
+static int dummy_custom_perf_cb(struct notifier_block *nb,
+ unsigned long event, void *data)
+{
+ struct scmi_perf_level_report *er = data;
+
+ pr_info("%s()::%d - EVENT:[%ld] - TS:%lld DOMAIN_ID:%d AGENT_ID:%d LEVEL:%d\n",
+ __func__, __LINE__, event, er->timestamp, er->domain_id,
+ er->agent_id, er->performance_level);
+
+ return NOTIFY_OK;
+}
+
+static struct notifier_block dummy_custom_perf_nb = {
+ .notifier_call = dummy_custom_perf_cb,
+ .priority = 10,
+};
+
+static int custom_dummy_scream_cb(struct notifier_block *nb,
+ unsigned long event, void *data)
+{
+ struct scmi_dummy_scream_report *er = data;
+
+ pr_info("%s()::%d - EVENT:[%ld] - TS:%lld DOMAIN_ID:%d AGENT_ID:%d LEVEL:%d\n",
+ __func__, __LINE__, event, er->timestamp, er->domain_id,
+ er->agent_id, er->scream);
+
+ return NOTIFY_OK;
+}
+
+static struct notifier_block custom_dummy_nb = {
+ .notifier_call = custom_dummy_scream_cb,
+ .priority = 10,
+};
+
+static int scmi_dummy_probe(struct scmi_device *sdev)
+{
+ int num_domains;
+ struct device *dev = &sdev->dev;
+ const struct scmi_handle *handle = sdev->handle;
+ u32 src_id;
+
+ if (!handle)
+ return -ENODEV;
+
+ dummy_ops = handle->get_ops(handle, SCMI_PROTOCOL_CUSTOM_DUMMY);
+ if (IS_ERR(dummy_ops))
+ return PTR_ERR(dummy_ops);
+
+ num_domains = dummy_ops->num_domains_get(handle);
+ if (num_domains < 0) {
+ dev_err(dev, "number of domains not found\n");
+ return num_domains;
+ }
+
+ pr_info("Registering notify_callback as CUSTOM_DUMMY !!\n");
+
+ src_id = 0x02;
+ handle->notify_ops->register_event_notifier(handle,
+ SCMI_PROTOCOL_CUSTOM_DUMMY,
+ SCMI_EVENT_DUMMY_SCREAM,
+ &src_id, &custom_dummy_nb);
+
+ src_id = 0x01;
+ handle->notify_ops->register_event_notifier(handle,
+ SCMI_PROTOCOL_PERF,
+ SCMI_EVENT_PERFORMANCE_LEVEL_CHANGED,
+ &src_id,
+ &dummy_custom_perf_nb);
+
+ return 0;
+}
+
+static void scmi_dummy_remove(struct scmi_device *sdev)
+{
+ const struct scmi_handle *handle = sdev->handle;
+ u32 src_id;
+
+ src_id = 0x02;
+ handle->notify_ops->unregister_event_notifier(handle,
+ SCMI_PROTOCOL_CUSTOM_DUMMY,
+ SCMI_EVENT_DUMMY_SCREAM,
+ &src_id, &custom_dummy_nb);
+
+ src_id = 0x01;
+ handle->notify_ops->unregister_event_notifier(handle,
+ SCMI_PROTOCOL_PERF,
+ SCMI_EVENT_PERFORMANCE_LEVEL_CHANGED,
+ &src_id,
+ &dummy_custom_perf_nb);
+
+ handle->put_ops(handle, SCMI_PROTOCOL_CUSTOM_DUMMY);
+
+ return;
+}
+
+static const struct scmi_device_id scmi_id_table[] = {
+ { SCMI_PROTOCOL_CUSTOM_DUMMY, "custom_dummy" },
+ { },
+};
+MODULE_DEVICE_TABLE(scmi, scmi_id_table);
+
+static struct scmi_driver scmi_custom_dummy_driver = {
+ .name = "scmi-custom-dummy",
+ .probe = scmi_dummy_probe,
+ .remove = scmi_dummy_remove,
+ .id_table = scmi_id_table,
+};
+module_scmi_driver(scmi_custom_dummy_driver);
+
+MODULE_AUTHOR("DummyMaster");
+MODULE_DESCRIPTION("ARM SCMI Custom Dummy driver");
+MODULE_LICENSE("GPL v2");
--
2.17.1
next prev parent reply other threads:[~2020-10-14 15:07 UTC|newest]
Thread overview: 33+ messages / expand[flat|nested] mbox.gz Atom feed top
2020-10-14 15:05 [PATCH 00/11] SCMI vendor protocols and modularization Cristian Marussi
2020-10-14 15:05 ` [PATCH 01/11] firmware: arm_scmi: review protocol registration interface Cristian Marussi
2020-10-14 19:03 ` Florian Fainelli
2020-10-14 20:20 ` Sudeep Holla
2020-10-15 8:42 ` Cristian Marussi
2020-10-15 9:41 ` Vincent Guittot
2020-10-15 9:58 ` Cristian Marussi
2020-10-21 2:46 ` Thara Gopinath
2020-10-21 10:08 ` Cristian Marussi
2020-10-14 15:05 ` [PATCH 02/11] firmware: arm_scmi: hide protocols' private data Cristian Marussi
2020-10-14 19:19 ` Florian Fainelli
2020-10-15 8:52 ` Cristian Marussi
2020-10-14 15:05 ` [PATCH 03/11] firmware: arm_scmi: introduce common protocol interface Cristian Marussi
2020-10-21 2:47 ` Thara Gopinath
2020-10-21 10:27 ` Cristian Marussi
2020-10-26 13:07 ` Thara Gopinath
2020-10-28 21:04 ` Cristian Marussi
2020-10-14 15:05 ` [PATCH 04/11] firmware: arm_scmi: refactor events registration Cristian Marussi
2020-10-14 15:05 ` [PATCH 05/11] firmware: arm_scmi: make notify_priv really private Cristian Marussi
2020-10-14 15:05 ` [PATCH 06/11] firmware: arm_scmi: add support for protocol modularization Cristian Marussi
2020-10-21 2:47 ` Thara Gopinath
2020-10-21 10:30 ` Cristian Marussi
2020-10-14 15:05 ` [PATCH 07/11] [DEBUG] firmware: arm_scmi: add example custom protocol Cristian Marussi
2020-10-14 15:05 ` [PATCH 08/11] [DEBUG] arm64: dts: juno: add example custom protocol support Cristian Marussi
2020-10-14 15:05 ` Cristian Marussi [this message]
2020-10-14 15:55 ` [PATCH 09/11] [DEBUG] firmware: arm_scmi: add example SCMI driver for custom protocol Randy Dunlap
2020-10-14 16:44 ` Cristian Marussi
2020-10-14 15:05 ` [PATCH 10/11] [DEBUG] firmware: arm_scmi: add custom_dummy SCMI devname Cristian Marussi
2020-10-21 2:49 ` Thara Gopinath
2020-10-21 11:35 ` Cristian Marussi
2020-10-26 12:37 ` Thara Gopinath
2020-10-28 21:28 ` Cristian Marussi
2020-10-14 15:05 ` [PATCH 11/11] [DEBUG][HACK] firmware: arm_scmi: force implemented protocol 0x99 Cristian Marussi
Reply instructions:
You may reply publicly to this message via plain-text email
using any one of the following methods:
* Save the following mbox file, import it into your mail client,
and reply-to-all from there: mbox
Avoid top-posting and favor interleaved quoting:
https://en.wikipedia.org/wiki/Posting_style#Interleaved_style
* Reply using the --to, --cc, and --in-reply-to
switches of git-send-email(1):
git send-email \
--in-reply-to=20201014150545.44807-10-cristian.marussi@arm.com \
--to=cristian.marussi@arm.com \
--cc=Jonathan.Cameron@Huawei.com \
--cc=etienne.carriere@linaro.org \
--cc=f.fainelli@gmail.com \
--cc=james.quinlan@broadcom.com \
--cc=linux-arm-kernel@lists.infradead.org \
--cc=linux-kernel@vger.kernel.org \
--cc=lukasz.luba@arm.com \
--cc=souvik.chakravarty@arm.com \
--cc=sudeep.holla@arm.com \
--cc=thara.gopinath@linaro.org \
--cc=vincent.guittot@linaro.org \
/path/to/YOUR_REPLY
https://kernel.org/pub/software/scm/git/docs/git-send-email.html
* If your mail client supports setting the In-Reply-To header
via mailto: links, try the mailto: link
Be sure your reply has a Subject: header at the top and a blank line
before the message body.
This is a public inbox, see mirroring instructions
for how to clone and mirror all data and code used for this inbox;
as well as URLs for NNTP newsgroup(s).