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
WARNING: multiple messages have this Message-ID (diff)
From: Cristian Marussi <cristian.marussi@arm.com> To: linux-kernel@vger.kernel.org, linux-arm-kernel@lists.infradead.org Cc: f.fainelli@gmail.com, vincent.guittot@linaro.org, sudeep.holla@arm.com, thara.gopinath@linaro.org, cristian.marussi@arm.com, james.quinlan@broadcom.com, Jonathan.Cameron@Huawei.com, souvik.chakravarty@arm.com, etienne.carriere@linaro.org, lukasz.luba@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 _______________________________________________ linux-arm-kernel mailing list linux-arm-kernel@lists.infradead.org http://lists.infradead.org/mailman/listinfo/linux-arm-kernel
next prev parent reply other threads:[~2020-10-14 15:07 UTC|newest] Thread overview: 66+ 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 ` Cristian Marussi 2020-10-14 15:05 ` [PATCH 01/11] firmware: arm_scmi: review protocol registration interface Cristian Marussi 2020-10-14 15:05 ` Cristian Marussi 2020-10-14 19:03 ` Florian Fainelli 2020-10-14 19:03 ` Florian Fainelli 2020-10-14 20:20 ` Sudeep Holla 2020-10-14 20:20 ` Sudeep Holla 2020-10-15 8:42 ` Cristian Marussi 2020-10-15 8:42 ` Cristian Marussi 2020-10-15 9:41 ` Vincent Guittot 2020-10-15 9:41 ` Vincent Guittot 2020-10-15 9:58 ` Cristian Marussi 2020-10-15 9:58 ` Cristian Marussi 2020-10-21 2:46 ` Thara Gopinath 2020-10-21 2:46 ` Thara Gopinath 2020-10-21 10:08 ` Cristian Marussi 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 15:05 ` Cristian Marussi 2020-10-14 19:19 ` Florian Fainelli 2020-10-14 19:19 ` Florian Fainelli 2020-10-15 8:52 ` Cristian Marussi 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-14 15:05 ` Cristian Marussi 2020-10-21 2:47 ` Thara Gopinath 2020-10-21 2:47 ` Thara Gopinath 2020-10-21 10:27 ` Cristian Marussi 2020-10-21 10:27 ` Cristian Marussi 2020-10-26 13:07 ` Thara Gopinath 2020-10-26 13:07 ` Thara Gopinath 2020-10-28 21:04 ` Cristian Marussi 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 ` 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 ` Cristian Marussi 2020-10-14 15:05 ` [PATCH 06/11] firmware: arm_scmi: add support for protocol modularization Cristian Marussi 2020-10-14 15:05 ` Cristian Marussi 2020-10-21 2:47 ` Thara Gopinath 2020-10-21 2:47 ` Thara Gopinath 2020-10-21 10:30 ` Cristian Marussi 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 ` 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 2020-10-14 15:05 ` Cristian Marussi [this message] 2020-10-14 15:05 ` [PATCH 09/11] [DEBUG] firmware: arm_scmi: add example SCMI driver for custom protocol Cristian Marussi 2020-10-14 15:55 ` Randy Dunlap 2020-10-14 15:55 ` Randy Dunlap 2020-10-14 16:44 ` Cristian Marussi 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-14 15:05 ` Cristian Marussi 2020-10-21 2:49 ` Thara Gopinath 2020-10-21 2:49 ` Thara Gopinath 2020-10-21 11:35 ` Cristian Marussi 2020-10-21 11:35 ` Cristian Marussi 2020-10-26 12:37 ` Thara Gopinath 2020-10-26 12:37 ` Thara Gopinath 2020-10-28 21:28 ` Cristian Marussi 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 2020-10-14 15:05 ` 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: linkBe sure your reply has a Subject: header at the top and a blank line before the message body.
This is an external index of several public inboxes, see mirroring instructions on how to clone and mirror all data and code used by this external index.