1 // SPDX-License-Identifier: GPL-2.0-only
3  * Copyright (c) 2011-2014, The Linux Foundation. All rights reserved.
22 #include <asm/proc-fns.h>
29 #define SPM_CTL_INDEX		0x7f
31 #define SPM_CTL_EN		BIT(0)
72 	[SPM_REG_CFG]		= 0x08,
73 	[SPM_REG_SPM_CTL]	= 0x30,
74 	[SPM_REG_DLY]		= 0x34,
75 	[SPM_REG_SEQ_ENTRY]	= 0x80,
81 	.spm_cfg = 0x1,
82 	.spm_dly = 0x3C102800,
83 	.seq = { 0x03, 0x0B, 0x0F, 0x00, 0x20, 0x80, 0x10, 0xE8, 0x5B, 0x03,
84 		0x3B, 0xE8, 0x5B, 0x82, 0x10, 0x0B, 0x30, 0x06, 0x26, 0x30,
85 		0x0F },
86 	.start_index[PM_SLEEP_MODE_STBY] = 0,
91 	[SPM_REG_CFG]		= 0x08,
92 	[SPM_REG_SPM_CTL]	= 0x20,
93 	[SPM_REG_PMIC_DLY]	= 0x24,
94 	[SPM_REG_PMIC_DATA_0]	= 0x28,
95 	[SPM_REG_PMIC_DATA_1]	= 0x2C,
96 	[SPM_REG_SEQ_ENTRY]	= 0x80,
102 	.spm_cfg = 0x1F,
103 	.pmic_dly = 0x02020004,
104 	.pmic_data[0] = 0x0084009C,
105 	.pmic_data[1] = 0x00A4001C,
106 	.seq = { 0x03, 0x0F, 0x00, 0x24, 0x54, 0x10, 0x09, 0x03, 0x01,
107 		0x10, 0x54, 0x30, 0x0C, 0x24, 0x30, 0x0F },
108 	.start_index[PM_SLEEP_MODE_STBY] = 0,
112 static inline void spm_register_write(struct spm_driver_data *drv,  in spm_register_write()  argument
115 	if (drv->reg_data->reg_offset[reg])  in spm_register_write()
116 		writel_relaxed(val, drv->reg_base +  in spm_register_write()
117 				drv->reg_data->reg_offset[reg]);  in spm_register_write()
121 static inline void spm_register_write_sync(struct spm_driver_data *drv,  in spm_register_write_sync()  argument
126 	if (!drv->reg_data->reg_offset[reg])  in spm_register_write_sync()
130 		writel_relaxed(val, drv->reg_base +  in spm_register_write_sync()
131 				drv->reg_data->reg_offset[reg]);  in spm_register_write_sync()
132 		ret = readl_relaxed(drv->reg_base +  in spm_register_write_sync()
133 				drv->reg_data->reg_offset[reg]);  in spm_register_write_sync()
140 static inline u32 spm_register_read(struct spm_driver_data *drv,  in spm_register_read()  argument
143 	return readl_relaxed(drv->reg_base + drv->reg_data->reg_offset[reg]);  in spm_register_read()
146 static void spm_set_low_power_mode(struct spm_driver_data *drv,  in spm_set_low_power_mode()  argument
152 	start_index = drv->reg_data->start_index[mode];  in spm_set_low_power_mode()
154 	ctl_val = spm_register_read(drv, SPM_REG_SPM_CTL);  in spm_set_low_power_mode()
158 	spm_register_write_sync(drv, SPM_REG_SPM_CTL, ctl_val);  in spm_set_low_power_mode()
169 	return -1;  in qcom_pm_collapse()
172 static int qcom_cpu_spc(struct spm_driver_data *drv)  in qcom_cpu_spc()  argument
176 	spm_set_low_power_mode(drv, PM_SLEEP_MODE_SPC);  in qcom_cpu_spc()
177 	ret = cpu_suspend(0, qcom_pm_collapse);  in qcom_cpu_spc()
184 	spm_set_low_power_mode(drv, PM_SLEEP_MODE_STBY);  in qcom_cpu_spc()
190 				struct cpuidle_driver *drv, int idx)  in spm_enter_idle_state()  argument
192 	struct spm_driver_data *data = container_of(drv, struct spm_driver_data,  in spm_enter_idle_state()
201 	.states[0] = {
212 	{ .compatible = "qcom,idle-state-spc", .data = spm_enter_idle_state },
216 static int spm_cpuidle_init(struct cpuidle_driver *drv, int cpu)  in spm_cpuidle_init()  argument
220 	memcpy(drv, &qcom_spm_idle_driver, sizeof(*drv));  in spm_cpuidle_init()
221 	drv->cpumask = (struct cpumask *)cpumask_of(cpu);  in spm_cpuidle_init()
224 	ret = dt_init_idle_driver(drv, qcom_idle_state_match, 1);  in spm_cpuidle_init()
225 	if (ret <= 0)  in spm_cpuidle_init()
226 		return ret ? : -ENODEV;  in spm_cpuidle_init()
229 	return qcom_scm_set_warm_boot_addr(cpu_resume_arm, drv->cpumask);  in spm_cpuidle_init()
235 	struct spm_driver_data *drv = NULL;  in spm_get_drv()  local
238 	bool found = 0;  in spm_get_drv()
244 		saw_node = of_parse_phandle(cpu_node, "qcom,saw", 0);  in spm_get_drv()
245 		found = (saw_node == pdev->dev.of_node);  in spm_get_drv()
253 		drv = devm_kzalloc(&pdev->dev, sizeof(*drv), GFP_KERNEL);  in spm_get_drv()
254 		if (drv)  in spm_get_drv()
258 	return drv;  in spm_get_drv()
262 	{ .compatible = "qcom,msm8974-saw2-v2.1-cpu",
264 	{ .compatible = "qcom,apq8084-saw2-v2.1-cpu",
266 	{ .compatible = "qcom,apq8064-saw2-v1.1-cpu",
273 	struct spm_driver_data *drv;  in spm_dev_probe()  local
280 		return -EPROBE_DEFER;  in spm_dev_probe()
282 	drv = spm_get_drv(pdev, &cpu);  in spm_dev_probe()
283 	if (!drv)  in spm_dev_probe()
284 		return -EINVAL;  in spm_dev_probe()
285 	platform_set_drvdata(pdev, drv);  in spm_dev_probe()
287 	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);  in spm_dev_probe()
288 	drv->reg_base = devm_ioremap_resource(&pdev->dev, res);  in spm_dev_probe()
289 	if (IS_ERR(drv->reg_base))  in spm_dev_probe()
290 		return PTR_ERR(drv->reg_base);  in spm_dev_probe()
292 	match_id = of_match_node(spm_match_table, pdev->dev.of_node);  in spm_dev_probe()
294 		return -ENODEV;  in spm_dev_probe()
296 	drv->reg_data = match_id->data;  in spm_dev_probe()
298 	ret = spm_cpuidle_init(&drv->cpuidle_driver, cpu);  in spm_dev_probe()
303 	addr = drv->reg_base + drv->reg_data->reg_offset[SPM_REG_SEQ_ENTRY];  in spm_dev_probe()
304 	__iowrite32_copy(addr, drv->reg_data->seq,  in spm_dev_probe()
305 			ARRAY_SIZE(drv->reg_data->seq) / 4);  in spm_dev_probe()
313 	spm_register_write(drv, SPM_REG_CFG, drv->reg_data->spm_cfg);  in spm_dev_probe()
314 	spm_register_write(drv, SPM_REG_DLY, drv->reg_data->spm_dly);  in spm_dev_probe()
315 	spm_register_write(drv, SPM_REG_PMIC_DLY, drv->reg_data->pmic_dly);  in spm_dev_probe()
316 	spm_register_write(drv, SPM_REG_PMIC_DATA_0,  in spm_dev_probe()
317 				drv->reg_data->pmic_data[0]);  in spm_dev_probe()
318 	spm_register_write(drv, SPM_REG_PMIC_DATA_1,  in spm_dev_probe()
319 				drv->reg_data->pmic_data[1]);  in spm_dev_probe()
322 	spm_set_low_power_mode(drv, PM_SLEEP_MODE_STBY);  in spm_dev_probe()
324 	return cpuidle_register(&drv->cpuidle_driver, NULL);  in spm_dev_probe()
329 	struct spm_driver_data *drv = platform_get_drvdata(pdev);  in spm_dev_remove()  local
331 	cpuidle_unregister(&drv->cpuidle_driver);  in spm_dev_remove()
332 	return 0;  in spm_dev_remove()