Merge "defconfig: pineapple: enable QTI_DYNPF_SCMI"

arch/arm64/configs/vendor/pineapple_GKI.config

@@ -241,6 +241,7 @@ CONFIG_QTI_CRYPTO_COMMON=m
 # CONFIG_QTI_CRYPTO_TZ is not set
 CONFIG_QTI_DDR_COOLING_DEVICE=m
 CONFIG_QTI_DEVFREQ_CDEV=m
+CONFIG_QTI_DYNPF_SCMI=m
 CONFIG_QTI_GLINK_ADC=m
 CONFIG_QTI_HW_KEY_MANAGER=m
 CONFIG_QTI_IOMMU_SUPPORT=m

drivers/soc/qcom/dcvs/Kconfig

@@ -119,3 +119,15 @@ config QTI_CPUFREQ_STATS_SCMI_V2
 	  This driver is used to expose debugfs interface to communicate
 	  with cpucp for CPU freq stats based on SCMI consolidation protocol.
 	  It is intended to be used by clients to get CPU and L3 residency data.
+
+config QTI_DYNPF_SCMI
+	tristate "Qualcomm Technologies Inc. SCMI client driver for DYNPF"
+	depends on QTI_SCMI_VENDOR_PROTOCOL
+	default n
+	help
+	  Driver to expose DYNPF configuration APIs to userspace via sysfs.
+
+	  This driver gathers DYNPF configuration parameters from sysfs
+	  userspace and relays them to CPUCP via SCMI communication.
+	  It is intended to be used by clients familiar with modifying
+	  the DYNPF settings.

drivers/soc/qcom/dcvs/Makefile

@@ -12,3 +12,4 @@ obj-$(CONFIG_QTI_QCOM_SCMI_CLIENT)	+= qcom_scmi_client.o
 obj-$(CONFIG_QTI_C1DCVS_SCMI_V2)        += c1dcvs_scmi_v2.o
 obj-$(CONFIG_QTI_MPAM)	+= mpam.o
 obj-$(CONFIG_QTI_CPUFREQ_STATS_SCMI_V2)	+= cpufreq_stats_scmi_v2.o
+obj-$(CONFIG_QTI_DYNPF_SCMI)		+= dynpf_scmi.o

drivers/soc/qcom/dcvs/dynpf_scmi.c

@@ -0,0 +1,158 @@
+// SPDX-License-Identifier: GPL-2.0-only
+/*
+ * Copyright (c) 2023 Qualcomm Innovation Center, Inc. All rights reserved.
+ */
+
+#include <linux/scmi_protocol.h>
+#include <linux/qcom_scmi_vendor.h>
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/init.h>
+#include <linux/err.h>
+#include <linux/errno.h>
+#include <linux/of.h>
+#include <linux/platform_device.h>
+#include <linux/cpu.h>
+#include <linux/slab.h>
+
+static struct kobject dynpf_kobj;
+static struct scmi_protocol_handle *ph;
+static const struct qcom_scmi_vendor_ops *ops;
+#define DYNPF_ALGO_STR	0x53434d495f444750 /* "SCMI_DGP" */
+static struct scmi_device *sdev;
+
+struct qcom_dynpf_attr {
+	struct attribute		attr;
+	ssize_t (*show)(struct kobject *kobj, struct attribute *attr,
+			char *buf);
+	ssize_t (*store)(struct kobject *kobj, struct attribute *attr,
+			const char *buf, size_t count);
+};
+
+enum dynpf_param_ids {
+	PARAM_ENABLE_DYNPF = 1,
+};
+
+#define to_dynpf_attr(_attr) \
+	container_of(_attr, struct qcom_dynpf_attr, attr)
+#define DYNPF_ATTR_RW(_name)						\
+static struct qcom_dynpf_attr _name =					\
+__ATTR(_name, 0644, show_##_name, store_##_name)			\
+
+static ssize_t store_enable_dynpf(struct kobject *kobj,
+				  struct attribute *attr, const char *buf,
+				  size_t count)
+{
+	u32 val;
+	int ret;
+
+	ret = kstrtouint(buf, 10, &val);
+	if (ret < 0)
+		return ret;
+
+	ret = ops->set_param(ph, &val, DYNPF_ALGO_STR, PARAM_ENABLE_DYNPF,
+				sizeof(u32));
+
+	return ((ret < 0) ? ret : count);
+}
+
+static ssize_t show_enable_dynpf(struct kobject *kobj,
+				 struct attribute *attr, char *buf)
+{
+	u32 val;
+	int ret;
+
+	ret = ops->get_param(ph, &val, DYNPF_ALGO_STR, PARAM_ENABLE_DYNPF, 0,
+				sizeof(u32));
+	if (ret < 0)
+		return ret;
+
+	return scnprintf(buf, PAGE_SIZE, "%lu\n", le32_to_cpu(val));
+}
+
+DYNPF_ATTR_RW(enable_dynpf);
+
+static struct attribute *dynpf_settings_attrs[] = {
+	&enable_dynpf.attr,
+	NULL,
+};
+ATTRIBUTE_GROUPS(dynpf_settings);
+
+static ssize_t attr_show(struct kobject *kobj, struct attribute *attr,
+			 char *buf)
+{
+	struct qcom_dynpf_attr *dynpf_attr = to_dynpf_attr(attr);
+	ssize_t ret = -EIO;
+
+	if (dynpf_attr->show)
+		ret = dynpf_attr->show(kobj, attr, buf);
+
+	return ret;
+}
+
+static ssize_t attr_store(struct kobject *kobj, struct attribute *attr,
+			  const char *buf, size_t count)
+{
+	struct qcom_dynpf_attr *dynpf_attr = to_dynpf_attr(attr);
+	ssize_t ret = -EIO;
+
+	if (dynpf_attr->store)
+		ret = dynpf_attr->store(kobj, attr, buf, count);
+
+	return ret;
+}
+
+static const struct sysfs_ops dynpf_sysfs_ops = {
+	.show	= attr_show,
+	.store	= attr_store,
+};
+static struct kobj_type dynpf_settings_ktype = {
+	.sysfs_ops		= &dynpf_sysfs_ops,
+	.default_groups		= dynpf_settings_groups,
+};
+
+static int qcom_dynpf_probe(struct platform_device *pdev)
+{
+	int ret;
+
+	sdev = get_qcom_scmi_device();
+	if (IS_ERR(sdev)) {
+		ret = PTR_ERR(sdev);
+		if (ret != -EPROBE_DEFER)
+			dev_err(&pdev->dev, "Error getting scmi_dev ret = %d\n", ret);
+		return ret;
+	}
+	ops = sdev->handle->devm_protocol_get(sdev, QCOM_SCMI_VENDOR_PROTOCOL, &ph);
+	if (IS_ERR(ops)) {
+		ret = PTR_ERR(ops);
+		ops = NULL;
+		return ret;
+	}
+
+	ret = kobject_init_and_add(&dynpf_kobj, &dynpf_settings_ktype,
+				   &cpu_subsys.dev_root->kobj, "dynpf");
+	if (ret < 0) {
+		dev_err(&pdev->dev, "failed to init dynpf kobj: %d\n", ret);
+		kobject_put(&dynpf_kobj);
+	}
+
+	return 0;
+}
+
+static const struct of_device_id dynpf_table[] = {
+	{.compatible = "qcom,dynpf"},
+	{},
+};
+
+static struct platform_driver dynpf_driver = {
+	.driver = {
+		.name = "qcom-dynpf",
+		.of_match_table = dynpf_table,
+	},
+	.probe = qcom_dynpf_probe,
+};
+
+module_platform_driver(dynpf_driver);
+MODULE_SOFTDEP("pre: qcom_scmi_client");
+MODULE_DESCRIPTION("Qcom DYNPF SCMI driver");
+MODULE_LICENSE("GPL");

pineapple.bzl

@@ -147,6 +147,7 @@ def define_pineapple():
         "drivers/soc/qcom/dcvs/c1dcvs_scmi_v2.ko",
         "drivers/soc/qcom/dcvs/cpufreq_stats_scmi_v2.ko",
         "drivers/soc/qcom/dcvs/dcvs_fp.ko",
+        "drivers/soc/qcom/dcvs/dynpf_scmi.ko",
         "drivers/soc/qcom/dcvs/memlat.ko",
         "drivers/soc/qcom/dcvs/mpam.ko",
         "drivers/soc/qcom/dcvs/qcom-dcvs.ko",