[mirror_ubuntu-jammy-kernel.git] / drivers / soc / qcom / rpmpd.c

// SPDX-License-Identifier: GPL-2.0
/* Copyright (c) 2017-2018, The Linux Foundation. All rights reserved. */

#include <linux/err.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/mutex.h>
#include <linux/pm_domain.h>
#include <linux/of.h>
#include <linux/of_device.h>
#include <linux/platform_device.h>
#include <linux/pm_opp.h>
#include <linux/soc/qcom/smd-rpm.h>

#include <dt-bindings/power/qcom-rpmpd.h>

#define domain_to_rpmpd(domain) container_of(domain, struct rpmpd, pd)

/* Resource types:
 * RPMPD_X is X encoded as a little-endian, lower-case, ASCII string */
#define RPMPD_SMPA 0x61706d73
#define RPMPD_LDOA 0x616f646c
#define RPMPD_SMPB 0x62706d73
#define RPMPD_LDOB 0x626f646c
#define RPMPD_RWCX 0x78637772
#define RPMPD_RWMX 0x786d7772
#define RPMPD_RWLC 0x636c7772
#define RPMPD_RWLM 0x6d6c7772
#define RPMPD_RWSC 0x63737772
#define RPMPD_RWSM 0x6d737772

/* Operation Keys */
#define KEY_CORNER		0x6e726f63 /* corn */
#define KEY_ENABLE		0x6e657773 /* swen */
#define KEY_FLOOR_CORNER	0x636676   /* vfc */
#define KEY_FLOOR_LEVEL		0x6c6676   /* vfl */
#define KEY_LEVEL		0x6c766c76 /* vlvl */

#define MAX_CORNER_RPMPD_STATE	6

#define DEFINE_RPMPD_PAIR(_platform, _name, _active, r_type, r_key,	\
			  r_id)						\
	static struct rpmpd _platform##_##_active;			\
	static struct rpmpd _platform##_##_name = {			\
		.pd = {	.name = #_name,	},				\
		.peer = &_platform##_##_active,				\
		.res_type = RPMPD_##r_type,				\
		.res_id = r_id,						\
		.key = KEY_##r_key,					\
	};								\
	static struct rpmpd _platform##_##_active = {			\
		.pd = { .name = #_active, },				\
		.peer = &_platform##_##_name,				\
		.active_only = true,					\
		.res_type = RPMPD_##r_type,				\
		.res_id = r_id,						\
		.key = KEY_##r_key,					\
	}

#define DEFINE_RPMPD_CORNER(_platform, _name, r_type, r_id)		\
	static struct rpmpd _platform##_##_name = {			\
		.pd = { .name = #_name, },				\
		.res_type = RPMPD_##r_type,				\
		.res_id = r_id,						\
		.key = KEY_CORNER,					\
	}

#define DEFINE_RPMPD_LEVEL(_platform, _name, r_type, r_id)		\
	static struct rpmpd _platform##_##_name = {			\
		.pd = { .name = #_name, },				\
		.res_type = RPMPD_##r_type,				\
		.res_id = r_id,						\
		.key = KEY_LEVEL,					\
	}

#define DEFINE_RPMPD_VFC(_platform, _name, r_type, r_id)		\
	static struct rpmpd _platform##_##_name = {			\
		.pd = { .name = #_name, },				\
		.res_type = RPMPD_##r_type,				\
		.res_id = r_id,						\
		.key = KEY_FLOOR_CORNER,				\
	}

#define DEFINE_RPMPD_VFL(_platform, _name, r_type, r_id)		\
	static struct rpmpd _platform##_##_name = {			\
		.pd = { .name = #_name, },				\
		.res_type = RPMPD_##r_type,				\
		.res_id = r_id,						\
		.key = KEY_FLOOR_LEVEL,					\
	}

struct rpmpd_req {
	__le32 key;
	__le32 nbytes;
	__le32 value;
};

struct rpmpd {
	struct generic_pm_domain pd;
	struct rpmpd *peer;
	const bool active_only;
	unsigned int corner;
	bool enabled;
	const char *res_name;
	const int res_type;
	const int res_id;
	struct qcom_smd_rpm *rpm;
	unsigned int max_state;
	__le32 key;
};

struct rpmpd_desc {
	struct rpmpd **rpmpds;
	size_t num_pds;
	unsigned int max_state;
};

static DEFINE_MUTEX(rpmpd_lock);

/* msm8939 RPM Power Domains */
DEFINE_RPMPD_PAIR(msm8939, vddmd, vddmd_ao, SMPA, CORNER, 1);
DEFINE_RPMPD_VFC(msm8939, vddmd_vfc, SMPA, 1);

DEFINE_RPMPD_PAIR(msm8939, vddcx, vddcx_ao, SMPA, CORNER, 2);
DEFINE_RPMPD_VFC(msm8939, vddcx_vfc, SMPA, 2);

DEFINE_RPMPD_PAIR(msm8939, vddmx, vddmx_ao, LDOA, CORNER, 3);

static struct rpmpd *msm8939_rpmpds[] = {
	[MSM8939_VDDMDCX] =	&msm8939_vddmd,
	[MSM8939_VDDMDCX_AO] =	&msm8939_vddmd_ao,
	[MSM8939_VDDMDCX_VFC] =	&msm8939_vddmd_vfc,
	[MSM8939_VDDCX] =	&msm8939_vddcx,
	[MSM8939_VDDCX_AO] =	&msm8939_vddcx_ao,
	[MSM8939_VDDCX_VFC] =	&msm8939_vddcx_vfc,
	[MSM8939_VDDMX] =	&msm8939_vddmx,
	[MSM8939_VDDMX_AO] =	&msm8939_vddmx_ao,
};

static const struct rpmpd_desc msm8939_desc = {
	.rpmpds = msm8939_rpmpds,
	.num_pds = ARRAY_SIZE(msm8939_rpmpds),
	.max_state = MAX_CORNER_RPMPD_STATE,
};

/* msm8916 RPM Power Domains */
DEFINE_RPMPD_PAIR(msm8916, vddcx, vddcx_ao, SMPA, CORNER, 1);
DEFINE_RPMPD_PAIR(msm8916, vddmx, vddmx_ao, LDOA, CORNER, 3);

DEFINE_RPMPD_VFC(msm8916, vddcx_vfc, SMPA, 1);

static struct rpmpd *msm8916_rpmpds[] = {
	[MSM8916_VDDCX] =	&msm8916_vddcx,
	[MSM8916_VDDCX_AO] =	&msm8916_vddcx_ao,
	[MSM8916_VDDCX_VFC] =	&msm8916_vddcx_vfc,
	[MSM8916_VDDMX] =	&msm8916_vddmx,
	[MSM8916_VDDMX_AO] =	&msm8916_vddmx_ao,
};

static const struct rpmpd_desc msm8916_desc = {
	.rpmpds = msm8916_rpmpds,
	.num_pds = ARRAY_SIZE(msm8916_rpmpds),
	.max_state = MAX_CORNER_RPMPD_STATE,
};

/* msm8976 RPM Power Domains */
DEFINE_RPMPD_PAIR(msm8976, vddcx, vddcx_ao, SMPA, LEVEL, 2);
DEFINE_RPMPD_PAIR(msm8976, vddmx, vddmx_ao, SMPA, LEVEL, 6);

DEFINE_RPMPD_VFL(msm8976, vddcx_vfl, RWSC, 2);
DEFINE_RPMPD_VFL(msm8976, vddmx_vfl, RWSM, 6);

static struct rpmpd *msm8976_rpmpds[] = {
	[MSM8976_VDDCX] =	&msm8976_vddcx,
	[MSM8976_VDDCX_AO] =	&msm8976_vddcx_ao,
	[MSM8976_VDDCX_VFL] =	&msm8976_vddcx_vfl,
	[MSM8976_VDDMX] =	&msm8976_vddmx,
	[MSM8976_VDDMX_AO] =	&msm8976_vddmx_ao,
	[MSM8976_VDDMX_VFL] =	&msm8976_vddmx_vfl,
};

static const struct rpmpd_desc msm8976_desc = {
	.rpmpds = msm8976_rpmpds,
	.num_pds = ARRAY_SIZE(msm8976_rpmpds),
	.max_state = RPM_SMD_LEVEL_TURBO_HIGH,
};

/* msm8994 RPM Power domains */
DEFINE_RPMPD_PAIR(msm8994, vddcx, vddcx_ao, SMPA, CORNER, 1);
DEFINE_RPMPD_PAIR(msm8994, vddmx, vddmx_ao, SMPA, CORNER, 2);
/* Attention! *Some* 8994 boards with pm8004 may use SMPC here! */
DEFINE_RPMPD_CORNER(msm8994, vddgfx, SMPB, 2);

DEFINE_RPMPD_VFC(msm8994, vddcx_vfc, SMPA, 1);
DEFINE_RPMPD_VFC(msm8994, vddgfx_vfc, SMPB, 2);

static struct rpmpd *msm8994_rpmpds[] = {
	[MSM8994_VDDCX] =	&msm8994_vddcx,
	[MSM8994_VDDCX_AO] =	&msm8994_vddcx_ao,
	[MSM8994_VDDCX_VFC] =	&msm8994_vddcx_vfc,
	[MSM8994_VDDMX] =	&msm8994_vddmx,
	[MSM8994_VDDMX_AO] =	&msm8994_vddmx_ao,
	[MSM8994_VDDGFX] =	&msm8994_vddgfx,
	[MSM8994_VDDGFX_VFC] =	&msm8994_vddgfx_vfc,
};

static const struct rpmpd_desc msm8994_desc = {
	.rpmpds = msm8994_rpmpds,
	.num_pds = ARRAY_SIZE(msm8994_rpmpds),
	.max_state = MAX_CORNER_RPMPD_STATE,
};

/* msm8996 RPM Power domains */
DEFINE_RPMPD_PAIR(msm8996, vddcx, vddcx_ao, SMPA, CORNER, 1);
DEFINE_RPMPD_PAIR(msm8996, vddmx, vddmx_ao, SMPA, CORNER, 2);
DEFINE_RPMPD_CORNER(msm8996, vddsscx, LDOA, 26);

DEFINE_RPMPD_VFC(msm8996, vddcx_vfc, SMPA, 1);
DEFINE_RPMPD_VFC(msm8996, vddsscx_vfc, LDOA, 26);

static struct rpmpd *msm8996_rpmpds[] = {
	[MSM8996_VDDCX] =	&msm8996_vddcx,
	[MSM8996_VDDCX_AO] =	&msm8996_vddcx_ao,
	[MSM8996_VDDCX_VFC] =	&msm8996_vddcx_vfc,
	[MSM8996_VDDMX] =	&msm8996_vddmx,
	[MSM8996_VDDMX_AO] =	&msm8996_vddmx_ao,
	[MSM8996_VDDSSCX] =	&msm8996_vddsscx,
	[MSM8996_VDDSSCX_VFC] =	&msm8996_vddsscx_vfc,
};

static const struct rpmpd_desc msm8996_desc = {
	.rpmpds = msm8996_rpmpds,
	.num_pds = ARRAY_SIZE(msm8996_rpmpds),
	.max_state = MAX_CORNER_RPMPD_STATE,
};

/* msm8998 RPM Power domains */
DEFINE_RPMPD_PAIR(msm8998, vddcx, vddcx_ao, RWCX, LEVEL, 0);
DEFINE_RPMPD_VFL(msm8998, vddcx_vfl, RWCX, 0);

DEFINE_RPMPD_PAIR(msm8998, vddmx, vddmx_ao, RWMX, LEVEL, 0);
DEFINE_RPMPD_VFL(msm8998, vddmx_vfl, RWMX, 0);

DEFINE_RPMPD_LEVEL(msm8998, vdd_ssccx, RWSC, 0);
DEFINE_RPMPD_VFL(msm8998, vdd_ssccx_vfl, RWSC, 0);

DEFINE_RPMPD_LEVEL(msm8998, vdd_sscmx, RWSM, 0);
DEFINE_RPMPD_VFL(msm8998, vdd_sscmx_vfl, RWSM, 0);

static struct rpmpd *msm8998_rpmpds[] = {
	[MSM8998_VDDCX] =		&msm8998_vddcx,
	[MSM8998_VDDCX_AO] =		&msm8998_vddcx_ao,
	[MSM8998_VDDCX_VFL] =		&msm8998_vddcx_vfl,
	[MSM8998_VDDMX] =		&msm8998_vddmx,
	[MSM8998_VDDMX_AO] =		&msm8998_vddmx_ao,
	[MSM8998_VDDMX_VFL] =		&msm8998_vddmx_vfl,
	[MSM8998_SSCCX] =		&msm8998_vdd_ssccx,
	[MSM8998_SSCCX_VFL] =		&msm8998_vdd_ssccx_vfl,
	[MSM8998_SSCMX] =		&msm8998_vdd_sscmx,
	[MSM8998_SSCMX_VFL] =		&msm8998_vdd_sscmx_vfl,
};

static const struct rpmpd_desc msm8998_desc = {
	.rpmpds = msm8998_rpmpds,
	.num_pds = ARRAY_SIZE(msm8998_rpmpds),
	.max_state = RPM_SMD_LEVEL_BINNING,
};

/* qcs404 RPM Power domains */
DEFINE_RPMPD_PAIR(qcs404, vddmx, vddmx_ao, RWMX, LEVEL, 0);
DEFINE_RPMPD_VFL(qcs404, vddmx_vfl, RWMX, 0);

DEFINE_RPMPD_LEVEL(qcs404, vdd_lpicx, RWLC, 0);
DEFINE_RPMPD_VFL(qcs404, vdd_lpicx_vfl, RWLC, 0);

DEFINE_RPMPD_LEVEL(qcs404, vdd_lpimx, RWLM, 0);
DEFINE_RPMPD_VFL(qcs404, vdd_lpimx_vfl, RWLM, 0);

static struct rpmpd *qcs404_rpmpds[] = {
	[QCS404_VDDMX] = &qcs404_vddmx,
	[QCS404_VDDMX_AO] = &qcs404_vddmx_ao,
	[QCS404_VDDMX_VFL] = &qcs404_vddmx_vfl,
	[QCS404_LPICX] = &qcs404_vdd_lpicx,
	[QCS404_LPICX_VFL] = &qcs404_vdd_lpicx_vfl,
	[QCS404_LPIMX] = &qcs404_vdd_lpimx,
	[QCS404_LPIMX_VFL] = &qcs404_vdd_lpimx_vfl,
};

static const struct rpmpd_desc qcs404_desc = {
	.rpmpds = qcs404_rpmpds,
	.num_pds = ARRAY_SIZE(qcs404_rpmpds),
	.max_state = RPM_SMD_LEVEL_BINNING,
};

/* sdm660 RPM Power domains */
DEFINE_RPMPD_PAIR(sdm660, vddcx, vddcx_ao, RWCX, LEVEL, 0);
DEFINE_RPMPD_VFL(sdm660, vddcx_vfl, RWCX, 0);

DEFINE_RPMPD_PAIR(sdm660, vddmx, vddmx_ao, RWMX, LEVEL, 0);
DEFINE_RPMPD_VFL(sdm660, vddmx_vfl, RWMX, 0);

DEFINE_RPMPD_LEVEL(sdm660, vdd_ssccx, RWLC, 0);
DEFINE_RPMPD_VFL(sdm660, vdd_ssccx_vfl, RWLC, 0);

DEFINE_RPMPD_LEVEL(sdm660, vdd_sscmx, RWLM, 0);
DEFINE_RPMPD_VFL(sdm660, vdd_sscmx_vfl, RWLM, 0);

static struct rpmpd *sdm660_rpmpds[] = {
	[SDM660_VDDCX] =		&sdm660_vddcx,
	[SDM660_VDDCX_AO] =		&sdm660_vddcx_ao,
	[SDM660_VDDCX_VFL] =		&sdm660_vddcx_vfl,
	[SDM660_VDDMX] =		&sdm660_vddmx,
	[SDM660_VDDMX_AO] =		&sdm660_vddmx_ao,
	[SDM660_VDDMX_VFL] =		&sdm660_vddmx_vfl,
	[SDM660_SSCCX] =		&sdm660_vdd_ssccx,
	[SDM660_SSCCX_VFL] =		&sdm660_vdd_ssccx_vfl,
	[SDM660_SSCMX] =		&sdm660_vdd_sscmx,
	[SDM660_SSCMX_VFL] =		&sdm660_vdd_sscmx_vfl,
};

static const struct rpmpd_desc sdm660_desc = {
	.rpmpds = sdm660_rpmpds,
	.num_pds = ARRAY_SIZE(sdm660_rpmpds),
	.max_state = RPM_SMD_LEVEL_TURBO,
};

static const struct of_device_id rpmpd_match_table[] = {
	{ .compatible = "qcom,msm8916-rpmpd", .data = &msm8916_desc },
	{ .compatible = "qcom,msm8939-rpmpd", .data = &msm8939_desc },
	{ .compatible = "qcom,msm8976-rpmpd", .data = &msm8976_desc },
	{ .compatible = "qcom,msm8994-rpmpd", .data = &msm8994_desc },
	{ .compatible = "qcom,msm8996-rpmpd", .data = &msm8996_desc },
	{ .compatible = "qcom,msm8998-rpmpd", .data = &msm8998_desc },
	{ .compatible = "qcom,qcs404-rpmpd", .data = &qcs404_desc },
	{ .compatible = "qcom,sdm660-rpmpd", .data = &sdm660_desc },
	{ }
};
MODULE_DEVICE_TABLE(of, rpmpd_match_table);

static int rpmpd_send_enable(struct rpmpd *pd, bool enable)
{
	struct rpmpd_req req = {
		.key = KEY_ENABLE,
		.nbytes = cpu_to_le32(sizeof(u32)),
		.value = cpu_to_le32(enable),
	};

	return qcom_rpm_smd_write(pd->rpm, QCOM_SMD_RPM_ACTIVE_STATE,
				  pd->res_type, pd->res_id, &req, sizeof(req));
}

static int rpmpd_send_corner(struct rpmpd *pd, int state, unsigned int corner)
{
	struct rpmpd_req req = {
		.key = pd->key,
		.nbytes = cpu_to_le32(sizeof(u32)),
		.value = cpu_to_le32(corner),
	};

	return qcom_rpm_smd_write(pd->rpm, state, pd->res_type, pd->res_id,
				  &req, sizeof(req));
};

static void to_active_sleep(struct rpmpd *pd, unsigned int corner,
			    unsigned int *active, unsigned int *sleep)
{
	*active = corner;

	if (pd->active_only)
		*sleep = 0;
	else
		*sleep = *active;
}

static int rpmpd_aggregate_corner(struct rpmpd *pd)
{
	int ret;
	struct rpmpd *peer = pd->peer;
	unsigned int active_corner, sleep_corner;
	unsigned int this_active_corner = 0, this_sleep_corner = 0;
	unsigned int peer_active_corner = 0, peer_sleep_corner = 0;

	to_active_sleep(pd, pd->corner, &this_active_corner, &this_sleep_corner);

	if (peer && peer->enabled)
		to_active_sleep(peer, peer->corner, &peer_active_corner,
				&peer_sleep_corner);

	active_corner = max(this_active_corner, peer_active_corner);

	ret = rpmpd_send_corner(pd, QCOM_SMD_RPM_ACTIVE_STATE, active_corner);
	if (ret)
		return ret;

	sleep_corner = max(this_sleep_corner, peer_sleep_corner);

	return rpmpd_send_corner(pd, QCOM_SMD_RPM_SLEEP_STATE, sleep_corner);
}

static int rpmpd_power_on(struct generic_pm_domain *domain)
{
	int ret;
	struct rpmpd *pd = domain_to_rpmpd(domain);

	mutex_lock(&rpmpd_lock);

	ret = rpmpd_send_enable(pd, true);
	if (ret)
		goto out;

	pd->enabled = true;

	if (pd->corner)
		ret = rpmpd_aggregate_corner(pd);

out:
	mutex_unlock(&rpmpd_lock);

	return ret;
}

static int rpmpd_power_off(struct generic_pm_domain *domain)
{
	int ret;
	struct rpmpd *pd = domain_to_rpmpd(domain);

	mutex_lock(&rpmpd_lock);

	ret = rpmpd_send_enable(pd, false);
	if (!ret)
		pd->enabled = false;

	mutex_unlock(&rpmpd_lock);

	return ret;
}

static int rpmpd_set_performance(struct generic_pm_domain *domain,
				 unsigned int state)
{
	int ret = 0;
	struct rpmpd *pd = domain_to_rpmpd(domain);

	if (state > pd->max_state)
		state = pd->max_state;

	mutex_lock(&rpmpd_lock);

	pd->corner = state;

	/* Always send updates for vfc and vfl */
	if (!pd->enabled && pd->key != KEY_FLOOR_CORNER &&
	    pd->key != KEY_FLOOR_LEVEL)
		goto out;

	ret = rpmpd_aggregate_corner(pd);

out:
	mutex_unlock(&rpmpd_lock);

	return ret;
}

static unsigned int rpmpd_get_performance(struct generic_pm_domain *genpd,
					  struct dev_pm_opp *opp)
{
	return dev_pm_opp_get_level(opp);
}

static int rpmpd_probe(struct platform_device *pdev)
{
	int i;
	size_t num;
	struct genpd_onecell_data *data;
	struct qcom_smd_rpm *rpm;
	struct rpmpd **rpmpds;
	const struct rpmpd_desc *desc;

	rpm = dev_get_drvdata(pdev->dev.parent);
	if (!rpm) {
		dev_err(&pdev->dev, "Unable to retrieve handle to RPM\n");
		return -ENODEV;
	}

	desc = of_device_get_match_data(&pdev->dev);
	if (!desc)
		return -EINVAL;

	rpmpds = desc->rpmpds;
	num = desc->num_pds;

	data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
	if (!data)
		return -ENOMEM;

	data->domains = devm_kcalloc(&pdev->dev, num, sizeof(*data->domains),
				     GFP_KERNEL);
	data->num_domains = num;

	for (i = 0; i < num; i++) {
		if (!rpmpds[i]) {
			dev_warn(&pdev->dev, "rpmpds[] with empty entry at index=%d\n",
				 i);
			continue;
		}

		rpmpds[i]->rpm = rpm;
		rpmpds[i]->max_state = desc->max_state;
		rpmpds[i]->pd.power_off = rpmpd_power_off;
		rpmpds[i]->pd.power_on = rpmpd_power_on;
		rpmpds[i]->pd.set_performance_state = rpmpd_set_performance;
		rpmpds[i]->pd.opp_to_performance_state = rpmpd_get_performance;
		pm_genpd_init(&rpmpds[i]->pd, NULL, true);

		data->domains[i] = &rpmpds[i]->pd;
	}

	return of_genpd_add_provider_onecell(pdev->dev.of_node, data);
}

static struct platform_driver rpmpd_driver = {
	.driver = {
		.name = "qcom-rpmpd",
		.of_match_table = rpmpd_match_table,
		.suppress_bind_attrs = true,
	},
	.probe = rpmpd_probe,
};

static int __init rpmpd_init(void)
{
	return platform_driver_register(&rpmpd_driver);
}
core_initcall(rpmpd_init);

MODULE_DESCRIPTION("Qualcomm Technologies, Inc. RPM Power Domain Driver");
MODULE_LICENSE("GPL v2");
Commit	Line	Data
bbe3a66c RN	1	// SPDX-License-Identifier: GPL-2.0
	2	/* Copyright (c) 2017-2018, The Linux Foundation. All rights reserved. */
	3
	4	#include <linux/err.h>
	5	#include <linux/init.h>
	6	#include <linux/kernel.h>
f29808b2	7	#include <linux/module.h>
bbe3a66c RN	8	#include <linux/mutex.h>
bbe3a66c RN	9	#include <linux/pm_domain.h>
bbe3a66c RN	10	#include <linux/of.h>
	11	#include <linux/of_device.h>
	12	#include <linux/platform_device.h>
075d3db8	13	#include <linux/pm_opp.h>
bbe3a66c RN	14	#include <linux/soc/qcom/smd-rpm.h>
bbe3a66c RN	15
bbe3a66c RN	16	#include <dt-bindings/power/qcom-rpmpd.h>
	17
	18	#define domain_to_rpmpd(domain) container_of(domain, struct rpmpd, pd)
	19
1f010d1e BA	20	/* Resource types:
1f010d1e BA	21	* RPMPD_X is X encoded as a little-endian, lower-case, ASCII string */
bbe3a66c RN	22	#define RPMPD_SMPA 0x61706d73
bbe3a66c RN	23	#define RPMPD_LDOA 0x616f646c
43eb76a2 KD	24	#define RPMPD_SMPB 0x62706d73
43eb76a2 KD	25	#define RPMPD_LDOB 0x626f646c
02e03c89	26	#define RPMPD_RWCX 0x78637772
7dbed2a7 BA	27	#define RPMPD_RWMX 0x786d7772
	28	#define RPMPD_RWLC 0x636c7772
	29	#define RPMPD_RWLM 0x6d6c7772
02e03c89 SS	30	#define RPMPD_RWSC 0x63737772
02e03c89 SS	31	#define RPMPD_RWSM 0x6d737772
bbe3a66c RN	32
	33	/* Operation Keys */
	34	#define KEY_CORNER 0x6e726f63 /* corn */
	35	#define KEY_ENABLE 0x6e657773 /* swen */
	36	#define KEY_FLOOR_CORNER 0x636676 /* vfc */
7dbed2a7 BA	37	#define KEY_FLOOR_LEVEL 0x6c6676 /* vfl */
7dbed2a7 BA	38	#define KEY_LEVEL 0x6c766c76 /* vlvl */
bbe3a66c	39
043323da	40	#define MAX_CORNER_RPMPD_STATE 6
075d3db8	41
1f010d1e BA	42	#define DEFINE_RPMPD_PAIR(_platform, _name, _active, r_type, r_key, \
1f010d1e BA	43	r_id) \
bbe3a66c RN	44	static struct rpmpd _platform##_##_active; \
	45	static struct rpmpd _platform##_##_name = { \
	46	.pd = { .name = #_name, }, \
	47	.peer = &_platform##_##_active, \
1f010d1e	48	.res_type = RPMPD_##r_type, \
bbe3a66c	49	.res_id = r_id, \
1f010d1e	50	.key = KEY_##r_key, \
bbe3a66c RN	51	}; \
	52	static struct rpmpd _platform##_##_active = { \
	53	.pd = { .name = #_active, }, \
	54	.peer = &_platform##_##_name, \
	55	.active_only = true, \
1f010d1e	56	.res_type = RPMPD_##r_type, \
bbe3a66c	57	.res_id = r_id, \
1f010d1e	58	.key = KEY_##r_key, \
bbe3a66c RN	59	}
bbe3a66c RN	60
1f010d1e	61	#define DEFINE_RPMPD_CORNER(_platform, _name, r_type, r_id) \
bbe3a66c RN	62	static struct rpmpd _platform##_##_name = { \
bbe3a66c RN	63	.pd = { .name = #_name, }, \
1f010d1e	64	.res_type = RPMPD_##r_type, \
bbe3a66c RN	65	.res_id = r_id, \
	66	.key = KEY_CORNER, \
	67	}
	68
7dbed2a7 BA	69	#define DEFINE_RPMPD_LEVEL(_platform, _name, r_type, r_id) \
	70	static struct rpmpd _platform##_##_name = { \
	71	.pd = { .name = #_name, }, \
	72	.res_type = RPMPD_##r_type, \
	73	.res_id = r_id, \
	74	.key = KEY_LEVEL, \
	75	}
	76
1f010d1e	77	#define DEFINE_RPMPD_VFC(_platform, _name, r_type, r_id) \
bbe3a66c RN	78	static struct rpmpd _platform##_##_name = { \
bbe3a66c RN	79	.pd = { .name = #_name, }, \
1f010d1e	80	.res_type = RPMPD_##r_type, \
bbe3a66c RN	81	.res_id = r_id, \
	82	.key = KEY_FLOOR_CORNER, \
	83	}
	84
7dbed2a7 BA	85	#define DEFINE_RPMPD_VFL(_platform, _name, r_type, r_id) \
	86	static struct rpmpd _platform##_##_name = { \
	87	.pd = { .name = #_name, }, \
	88	.res_type = RPMPD_##r_type, \
	89	.res_id = r_id, \
	90	.key = KEY_FLOOR_LEVEL, \
	91	}
	92
bbe3a66c RN	93	struct rpmpd_req {
	94	__le32 key;
	95	__le32 nbytes;
	96	__le32 value;
	97	};
	98
	99	struct rpmpd {
	100	struct generic_pm_domain pd;
	101	struct rpmpd *peer;
	102	const bool active_only;
	103	unsigned int corner;
	104	bool enabled;
	105	const char *res_name;
	106	const int res_type;
	107	const int res_id;
	108	struct qcom_smd_rpm *rpm;
fe546c54	109	unsigned int max_state;
bbe3a66c RN	110	__le32 key;
	111	};
	112
	113	struct rpmpd_desc {
	114	struct rpmpd **rpmpds;
	115	size_t num_pds;
fe546c54	116	unsigned int max_state;
bbe3a66c RN	117	};
	118
	119	static DEFINE_MUTEX(rpmpd_lock);
	120
b5a3bf66 JN	121	/* msm8939 RPM Power Domains */
	122	DEFINE_RPMPD_PAIR(msm8939, vddmd, vddmd_ao, SMPA, CORNER, 1);
	123	DEFINE_RPMPD_VFC(msm8939, vddmd_vfc, SMPA, 1);
	124
	125	DEFINE_RPMPD_PAIR(msm8939, vddcx, vddcx_ao, SMPA, CORNER, 2);
	126	DEFINE_RPMPD_VFC(msm8939, vddcx_vfc, SMPA, 2);
	127
	128	DEFINE_RPMPD_PAIR(msm8939, vddmx, vddmx_ao, LDOA, CORNER, 3);
	129
	130	static struct rpmpd *msm8939_rpmpds[] = {
	131	[MSM8939_VDDMDCX] = &msm8939_vddmd,
	132	[MSM8939_VDDMDCX_AO] = &msm8939_vddmd_ao,
	133	[MSM8939_VDDMDCX_VFC] = &msm8939_vddmd_vfc,
	134	[MSM8939_VDDCX] = &msm8939_vddcx,
	135	[MSM8939_VDDCX_AO] = &msm8939_vddcx_ao,
	136	[MSM8939_VDDCX_VFC] = &msm8939_vddcx_vfc,
	137	[MSM8939_VDDMX] = &msm8939_vddmx,
	138	[MSM8939_VDDMX_AO] = &msm8939_vddmx_ao,
	139	};
	140
	141	static const struct rpmpd_desc msm8939_desc = {
	142	.rpmpds = msm8939_rpmpds,
	143	.num_pds = ARRAY_SIZE(msm8939_rpmpds),
	144	.max_state = MAX_CORNER_RPMPD_STATE,
	145	};
	146
84314cf7 SG	147	/* msm8916 RPM Power Domains */
	148	DEFINE_RPMPD_PAIR(msm8916, vddcx, vddcx_ao, SMPA, CORNER, 1);
	149	DEFINE_RPMPD_PAIR(msm8916, vddmx, vddmx_ao, LDOA, CORNER, 3);
	150
	151	DEFINE_RPMPD_VFC(msm8916, vddcx_vfc, SMPA, 1);
	152
	153	static struct rpmpd *msm8916_rpmpds[] = {
	154	[MSM8916_VDDCX] = &msm8916_vddcx,
	155	[MSM8916_VDDCX_AO] = &msm8916_vddcx_ao,
	156	[MSM8916_VDDCX_VFC] = &msm8916_vddcx_vfc,
	157	[MSM8916_VDDMX] = &msm8916_vddmx,
	158	[MSM8916_VDDMX_AO] = &msm8916_vddmx_ao,
	159	};
	160
	161	static const struct rpmpd_desc msm8916_desc = {
	162	.rpmpds = msm8916_rpmpds,
	163	.num_pds = ARRAY_SIZE(msm8916_rpmpds),
	164	.max_state = MAX_CORNER_RPMPD_STATE,
	165	};
	166
b1d52244 ADR	167	/* msm8976 RPM Power Domains */
	168	DEFINE_RPMPD_PAIR(msm8976, vddcx, vddcx_ao, SMPA, LEVEL, 2);
	169	DEFINE_RPMPD_PAIR(msm8976, vddmx, vddmx_ao, SMPA, LEVEL, 6);
	170
	171	DEFINE_RPMPD_VFL(msm8976, vddcx_vfl, RWSC, 2);
	172	DEFINE_RPMPD_VFL(msm8976, vddmx_vfl, RWSM, 6);
	173
	174	static struct rpmpd *msm8976_rpmpds[] = {
	175	[MSM8976_VDDCX] = &msm8976_vddcx,
	176	[MSM8976_VDDCX_AO] = &msm8976_vddcx_ao,
	177	[MSM8976_VDDCX_VFL] = &msm8976_vddcx_vfl,
	178	[MSM8976_VDDMX] = &msm8976_vddmx,
	179	[MSM8976_VDDMX_AO] = &msm8976_vddmx_ao,
	180	[MSM8976_VDDMX_VFL] = &msm8976_vddmx_vfl,
	181	};
	182
	183	static const struct rpmpd_desc msm8976_desc = {
	184	.rpmpds = msm8976_rpmpds,
	185	.num_pds = ARRAY_SIZE(msm8976_rpmpds),
	186	.max_state = RPM_SMD_LEVEL_TURBO_HIGH,
	187	};
	188
43eb76a2 KD	189	/* msm8994 RPM Power domains */
	190	DEFINE_RPMPD_PAIR(msm8994, vddcx, vddcx_ao, SMPA, CORNER, 1);
	191	DEFINE_RPMPD_PAIR(msm8994, vddmx, vddmx_ao, SMPA, CORNER, 2);
	192	/* Attention! Some 8994 boards with pm8004 may use SMPC here! */
	193	DEFINE_RPMPD_CORNER(msm8994, vddgfx, SMPB, 2);
	194
	195	DEFINE_RPMPD_VFC(msm8994, vddcx_vfc, SMPA, 1);
	196	DEFINE_RPMPD_VFC(msm8994, vddgfx_vfc, SMPB, 2);
	197
	198	static struct rpmpd *msm8994_rpmpds[] = {
	199	[MSM8994_VDDCX] = &msm8994_vddcx,
	200	[MSM8994_VDDCX_AO] = &msm8994_vddcx_ao,
	201	[MSM8994_VDDCX_VFC] = &msm8994_vddcx_vfc,
	202	[MSM8994_VDDMX] = &msm8994_vddmx,
	203	[MSM8994_VDDMX_AO] = &msm8994_vddmx_ao,
	204	[MSM8994_VDDGFX] = &msm8994_vddgfx,
	205	[MSM8994_VDDGFX_VFC] = &msm8994_vddgfx_vfc,
	206	};
	207
	208	static const struct rpmpd_desc msm8994_desc = {
	209	.rpmpds = msm8994_rpmpds,
	210	.num_pds = ARRAY_SIZE(msm8994_rpmpds),
	211	.max_state = MAX_CORNER_RPMPD_STATE,
	212	};
	213
bbe3a66c	214	/* msm8996 RPM Power domains */
1f010d1e BA	215	DEFINE_RPMPD_PAIR(msm8996, vddcx, vddcx_ao, SMPA, CORNER, 1);
	216	DEFINE_RPMPD_PAIR(msm8996, vddmx, vddmx_ao, SMPA, CORNER, 2);
	217	DEFINE_RPMPD_CORNER(msm8996, vddsscx, LDOA, 26);
bbe3a66c	218
1f010d1e BA	219	DEFINE_RPMPD_VFC(msm8996, vddcx_vfc, SMPA, 1);
1f010d1e BA	220	DEFINE_RPMPD_VFC(msm8996, vddsscx_vfc, LDOA, 26);
bbe3a66c RN	221
	222	static struct rpmpd *msm8996_rpmpds[] = {
	223	[MSM8996_VDDCX] = &msm8996_vddcx,
	224	[MSM8996_VDDCX_AO] = &msm8996_vddcx_ao,
	225	[MSM8996_VDDCX_VFC] = &msm8996_vddcx_vfc,
	226	[MSM8996_VDDMX] = &msm8996_vddmx,
	227	[MSM8996_VDDMX_AO] = &msm8996_vddmx_ao,
	228	[MSM8996_VDDSSCX] = &msm8996_vddsscx,
	229	[MSM8996_VDDSSCX_VFC] = &msm8996_vddsscx_vfc,
	230	};
	231
	232	static const struct rpmpd_desc msm8996_desc = {
	233	.rpmpds = msm8996_rpmpds,
	234	.num_pds = ARRAY_SIZE(msm8996_rpmpds),
043323da	235	.max_state = MAX_CORNER_RPMPD_STATE,
bbe3a66c RN	236	};
bbe3a66c RN	237
02e03c89 SS	238	/* msm8998 RPM Power domains */
	239	DEFINE_RPMPD_PAIR(msm8998, vddcx, vddcx_ao, RWCX, LEVEL, 0);
	240	DEFINE_RPMPD_VFL(msm8998, vddcx_vfl, RWCX, 0);
	241
	242	DEFINE_RPMPD_PAIR(msm8998, vddmx, vddmx_ao, RWMX, LEVEL, 0);
	243	DEFINE_RPMPD_VFL(msm8998, vddmx_vfl, RWMX, 0);
	244
	245	DEFINE_RPMPD_LEVEL(msm8998, vdd_ssccx, RWSC, 0);
	246	DEFINE_RPMPD_VFL(msm8998, vdd_ssccx_vfl, RWSC, 0);
	247
	248	DEFINE_RPMPD_LEVEL(msm8998, vdd_sscmx, RWSM, 0);
	249	DEFINE_RPMPD_VFL(msm8998, vdd_sscmx_vfl, RWSM, 0);
	250
	251	static struct rpmpd *msm8998_rpmpds[] = {
	252	[MSM8998_VDDCX] = &msm8998_vddcx,
	253	[MSM8998_VDDCX_AO] = &msm8998_vddcx_ao,
	254	[MSM8998_VDDCX_VFL] = &msm8998_vddcx_vfl,
	255	[MSM8998_VDDMX] = &msm8998_vddmx,
	256	[MSM8998_VDDMX_AO] = &msm8998_vddmx_ao,
	257	[MSM8998_VDDMX_VFL] = &msm8998_vddmx_vfl,
	258	[MSM8998_SSCCX] = &msm8998_vdd_ssccx,
	259	[MSM8998_SSCCX_VFL] = &msm8998_vdd_ssccx_vfl,
	260	[MSM8998_SSCMX] = &msm8998_vdd_sscmx,
	261	[MSM8998_SSCMX_VFL] = &msm8998_vdd_sscmx_vfl,
	262	};
	263
	264	static const struct rpmpd_desc msm8998_desc = {
	265	.rpmpds = msm8998_rpmpds,
	266	.num_pds = ARRAY_SIZE(msm8998_rpmpds),
	267	.max_state = RPM_SMD_LEVEL_BINNING,
	268	};
	269
7dbed2a7 BA	270	/* qcs404 RPM Power domains */
	271	DEFINE_RPMPD_PAIR(qcs404, vddmx, vddmx_ao, RWMX, LEVEL, 0);
	272	DEFINE_RPMPD_VFL(qcs404, vddmx_vfl, RWMX, 0);
	273
	274	DEFINE_RPMPD_LEVEL(qcs404, vdd_lpicx, RWLC, 0);
	275	DEFINE_RPMPD_VFL(qcs404, vdd_lpicx_vfl, RWLC, 0);
	276
	277	DEFINE_RPMPD_LEVEL(qcs404, vdd_lpimx, RWLM, 0);
	278	DEFINE_RPMPD_VFL(qcs404, vdd_lpimx_vfl, RWLM, 0);
	279
	280	static struct rpmpd *qcs404_rpmpds[] = {
	281	[QCS404_VDDMX] = &qcs404_vddmx,
	282	[QCS404_VDDMX_AO] = &qcs404_vddmx_ao,
	283	[QCS404_VDDMX_VFL] = &qcs404_vddmx_vfl,
	284	[QCS404_LPICX] = &qcs404_vdd_lpicx,
	285	[QCS404_LPICX_VFL] = &qcs404_vdd_lpicx_vfl,
	286	[QCS404_LPIMX] = &qcs404_vdd_lpimx,
	287	[QCS404_LPIMX_VFL] = &qcs404_vdd_lpimx_vfl,
	288	};
	289
	290	static const struct rpmpd_desc qcs404_desc = {
	291	.rpmpds = qcs404_rpmpds,
	292	.num_pds = ARRAY_SIZE(qcs404_rpmpds),
	293	.max_state = RPM_SMD_LEVEL_BINNING,
	294	};
	295
5fd7fb43 KD	296	/* sdm660 RPM Power domains */
	297	DEFINE_RPMPD_PAIR(sdm660, vddcx, vddcx_ao, RWCX, LEVEL, 0);
	298	DEFINE_RPMPD_VFL(sdm660, vddcx_vfl, RWCX, 0);
	299
	300	DEFINE_RPMPD_PAIR(sdm660, vddmx, vddmx_ao, RWMX, LEVEL, 0);
	301	DEFINE_RPMPD_VFL(sdm660, vddmx_vfl, RWMX, 0);
	302
	303	DEFINE_RPMPD_LEVEL(sdm660, vdd_ssccx, RWLC, 0);
	304	DEFINE_RPMPD_VFL(sdm660, vdd_ssccx_vfl, RWLC, 0);
	305
	306	DEFINE_RPMPD_LEVEL(sdm660, vdd_sscmx, RWLM, 0);
	307	DEFINE_RPMPD_VFL(sdm660, vdd_sscmx_vfl, RWLM, 0);
	308
	309	static struct rpmpd *sdm660_rpmpds[] = {
	310	[SDM660_VDDCX] = &sdm660_vddcx,
	311	[SDM660_VDDCX_AO] = &sdm660_vddcx_ao,
	312	[SDM660_VDDCX_VFL] = &sdm660_vddcx_vfl,
	313	[SDM660_VDDMX] = &sdm660_vddmx,
	314	[SDM660_VDDMX_AO] = &sdm660_vddmx_ao,
	315	[SDM660_VDDMX_VFL] = &sdm660_vddmx_vfl,
	316	[SDM660_SSCCX] = &sdm660_vdd_ssccx,
	317	[SDM660_SSCCX_VFL] = &sdm660_vdd_ssccx_vfl,
	318	[SDM660_SSCMX] = &sdm660_vdd_sscmx,
	319	[SDM660_SSCMX_VFL] = &sdm660_vdd_sscmx_vfl,
	320	};
	321
	322	static const struct rpmpd_desc sdm660_desc = {
	323	.rpmpds = sdm660_rpmpds,
	324	.num_pds = ARRAY_SIZE(sdm660_rpmpds),
	325	.max_state = RPM_SMD_LEVEL_TURBO,
	326	};
	327
bbe3a66c	328	static const struct of_device_id rpmpd_match_table[] = {
84314cf7	329	{ .compatible = "qcom,msm8916-rpmpd", .data = &msm8916_desc },
b5a3bf66	330	{ .compatible = "qcom,msm8939-rpmpd", .data = &msm8939_desc },
b1d52244	331	{ .compatible = "qcom,msm8976-rpmpd", .data = &msm8976_desc },
43eb76a2	332	{ .compatible = "qcom,msm8994-rpmpd", .data = &msm8994_desc },
bbe3a66c	333	{ .compatible = "qcom,msm8996-rpmpd", .data = &msm8996_desc },
02e03c89	334	{ .compatible = "qcom,msm8998-rpmpd", .data = &msm8998_desc },
7dbed2a7	335	{ .compatible = "qcom,qcs404-rpmpd", .data = &qcs404_desc },
5fd7fb43	336	{ .compatible = "qcom,sdm660-rpmpd", .data = &sdm660_desc },
bbe3a66c RN	337	{ }
bbe3a66c RN	338	};
f29808b2	339	MODULE_DEVICE_TABLE(of, rpmpd_match_table);
bbe3a66c RN	340
	341	static int rpmpd_send_enable(struct rpmpd *pd, bool enable)
	342	{
	343	struct rpmpd_req req = {
	344	.key = KEY_ENABLE,
	345	.nbytes = cpu_to_le32(sizeof(u32)),
	346	.value = cpu_to_le32(enable),
	347	};
	348
41c5bb76 BA	349	return qcom_rpm_smd_write(pd->rpm, QCOM_SMD_RPM_ACTIVE_STATE,
41c5bb76 BA	350	pd->res_type, pd->res_id, &req, sizeof(req));
bbe3a66c RN	351	}
	352
	353	static int rpmpd_send_corner(struct rpmpd *pd, int state, unsigned int corner)
	354	{
	355	struct rpmpd_req req = {
	356	.key = pd->key,
	357	.nbytes = cpu_to_le32(sizeof(u32)),
	358	.value = cpu_to_le32(corner),
	359	};
	360
	361	return qcom_rpm_smd_write(pd->rpm, state, pd->res_type, pd->res_id,
	362	&req, sizeof(req));
	363	};
	364
	365	static void to_active_sleep(struct rpmpd *pd, unsigned int corner,
	366	unsigned int active, unsigned int sleep)
	367	{
	368	*active = corner;
	369
	370	if (pd->active_only)
	371	*sleep = 0;
	372	else
	373	sleep = active;
	374	}
	375
	376	static int rpmpd_aggregate_corner(struct rpmpd *pd)
	377	{
	378	int ret;
	379	struct rpmpd *peer = pd->peer;
	380	unsigned int active_corner, sleep_corner;
	381	unsigned int this_active_corner = 0, this_sleep_corner = 0;
	382	unsigned int peer_active_corner = 0, peer_sleep_corner = 0;
	383
	384	to_active_sleep(pd, pd->corner, &this_active_corner, &this_sleep_corner);
	385
	386	if (peer && peer->enabled)
	387	to_active_sleep(peer, peer->corner, &peer_active_corner,
	388	&peer_sleep_corner);
	389
	390	active_corner = max(this_active_corner, peer_active_corner);
	391
41c5bb76	392	ret = rpmpd_send_corner(pd, QCOM_SMD_RPM_ACTIVE_STATE, active_corner);
bbe3a66c RN	393	if (ret)
	394	return ret;
	395
	396	sleep_corner = max(this_sleep_corner, peer_sleep_corner);
	397
41c5bb76	398	return rpmpd_send_corner(pd, QCOM_SMD_RPM_SLEEP_STATE, sleep_corner);
bbe3a66c RN	399	}
	400
	401	static int rpmpd_power_on(struct generic_pm_domain *domain)
	402	{
	403	int ret;
	404	struct rpmpd *pd = domain_to_rpmpd(domain);
	405
	406	mutex_lock(&rpmpd_lock);
	407
	408	ret = rpmpd_send_enable(pd, true);
	409	if (ret)
	410	goto out;
	411
	412	pd->enabled = true;
	413
	414	if (pd->corner)
	415	ret = rpmpd_aggregate_corner(pd);
	416
	417	out:
	418	mutex_unlock(&rpmpd_lock);
	419
	420	return ret;
	421	}
	422
	423	static int rpmpd_power_off(struct generic_pm_domain *domain)
	424	{
	425	int ret;
	426	struct rpmpd *pd = domain_to_rpmpd(domain);
	427
	428	mutex_lock(&rpmpd_lock);
	429
	430	ret = rpmpd_send_enable(pd, false);
	431	if (!ret)
	432	pd->enabled = false;
	433
	434	mutex_unlock(&rpmpd_lock);
	435
	436	return ret;
	437	}
	438
075d3db8 RN	439	static int rpmpd_set_performance(struct generic_pm_domain *domain,
	440	unsigned int state)
	441	{
	442	int ret = 0;
	443	struct rpmpd *pd = domain_to_rpmpd(domain);
	444
fe546c54 SS	445	if (state > pd->max_state)
fe546c54 SS	446	state = pd->max_state;
075d3db8 RN	447
	448	mutex_lock(&rpmpd_lock);
	449
	450	pd->corner = state;
	451
7dbed2a7 BA	452	/* Always send updates for vfc and vfl */
	453	if (!pd->enabled && pd->key != KEY_FLOOR_CORNER &&
	454	pd->key != KEY_FLOOR_LEVEL)
075d3db8 RN	455	goto out;
	456
	457	ret = rpmpd_aggregate_corner(pd);
	458
	459	out:
	460	mutex_unlock(&rpmpd_lock);
	461
	462	return ret;
	463	}
	464
	465	static unsigned int rpmpd_get_performance(struct generic_pm_domain *genpd,
	466	struct dev_pm_opp *opp)
	467	{
	468	return dev_pm_opp_get_level(opp);
	469	}
	470
bbe3a66c RN	471	static int rpmpd_probe(struct platform_device *pdev)
	472	{
	473	int i;
	474	size_t num;
	475	struct genpd_onecell_data *data;
	476	struct qcom_smd_rpm *rpm;
	477	struct rpmpd **rpmpds;
	478	const struct rpmpd_desc *desc;
	479
	480	rpm = dev_get_drvdata(pdev->dev.parent);
	481	if (!rpm) {
	482	dev_err(&pdev->dev, "Unable to retrieve handle to RPM\n");
	483	return -ENODEV;
	484	}
	485
	486	desc = of_device_get_match_data(&pdev->dev);
	487	if (!desc)
	488	return -EINVAL;
	489
	490	rpmpds = desc->rpmpds;
	491	num = desc->num_pds;
	492
	493	data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
	494	if (!data)
	495	return -ENOMEM;
	496
	497	data->domains = devm_kcalloc(&pdev->dev, num, sizeof(*data->domains),
	498	GFP_KERNEL);
	499	data->num_domains = num;
	500
	501	for (i = 0; i < num; i++) {
	502	if (!rpmpds[i]) {
	503	dev_warn(&pdev->dev, "rpmpds[] with empty entry at index=%d\n",
	504	i);
	505	continue;
	506	}
	507
	508	rpmpds[i]->rpm = rpm;
fe546c54	509	rpmpds[i]->max_state = desc->max_state;
bbe3a66c RN	510	rpmpds[i]->pd.power_off = rpmpd_power_off;
bbe3a66c RN	511	rpmpds[i]->pd.power_on = rpmpd_power_on;
075d3db8 RN	512	rpmpds[i]->pd.set_performance_state = rpmpd_set_performance;
075d3db8 RN	513	rpmpds[i]->pd.opp_to_performance_state = rpmpd_get_performance;
bbe3a66c RN	514	pm_genpd_init(&rpmpds[i]->pd, NULL, true);
	515
	516	data->domains[i] = &rpmpds[i]->pd;
	517	}
	518
	519	return of_genpd_add_provider_onecell(pdev->dev.of_node, data);
	520	}
	521
	522	static struct platform_driver rpmpd_driver = {
	523	.driver = {
	524	.name = "qcom-rpmpd",
	525	.of_match_table = rpmpd_match_table,
	526	.suppress_bind_attrs = true,
	527	},
	528	.probe = rpmpd_probe,
	529	};
	530
	531	static int __init rpmpd_init(void)
	532	{
	533	return platform_driver_register(&rpmpd_driver);
	534	}
	535	core_initcall(rpmpd_init);
f29808b2 JS	536
	537	MODULE_DESCRIPTION("Qualcomm Technologies, Inc. RPM Power Domain Driver");
	538	MODULE_LICENSE("GPL v2");