124 static inline void spm_register_write(struct spm_driver_data *drv,  in spm_register_write()  argument
127 	if (drv->reg_data->reg_offset[reg])  in spm_register_write()
128 		writel_relaxed(val, drv->reg_base +  in spm_register_write()
129 				drv->reg_data->reg_offset[reg]);  in spm_register_write()
133 static inline void spm_register_write_sync(struct spm_driver_data *drv,  in spm_register_write_sync()  argument
138 	if (!drv->reg_data->reg_offset[reg])  in spm_register_write_sync()
142 		writel_relaxed(val, drv->reg_base +  in spm_register_write_sync()
143 				drv->reg_data->reg_offset[reg]);  in spm_register_write_sync()
144 		ret = readl_relaxed(drv->reg_base +  in spm_register_write_sync()
145 				drv->reg_data->reg_offset[reg]);  in spm_register_write_sync()
152 static inline u32 spm_register_read(struct spm_driver_data *drv,  in spm_register_read()  argument
155 	return readl_relaxed(drv->reg_base + drv->reg_data->reg_offset[reg]);  in spm_register_read()
158 static void spm_set_low_power_mode(struct spm_driver_data *drv,  in spm_set_low_power_mode()  argument
164 	start_index = drv->reg_data->start_index[mode];  in spm_set_low_power_mode()
166 	ctl_val = spm_register_read(drv, SPM_REG_SPM_CTL);  in spm_set_low_power_mode()
170 	spm_register_write_sync(drv, SPM_REG_SPM_CTL, ctl_val);  in spm_set_low_power_mode()
184 static int qcom_cpu_spc(struct spm_driver_data *drv)  in qcom_cpu_spc()  argument
188 	spm_set_low_power_mode(drv, PM_SLEEP_MODE_SPC);  in qcom_cpu_spc()
196 	spm_set_low_power_mode(drv, PM_SLEEP_MODE_STBY);  in qcom_cpu_spc()
202 				struct cpuidle_driver *drv, int idx)  in spm_enter_idle_state()  argument
204 	struct spm_driver_data *data = container_of(drv, struct spm_driver_data,  in spm_enter_idle_state()
228 static int spm_cpuidle_init(struct cpuidle_driver *drv, int cpu)  in spm_cpuidle_init()  argument
232 	memcpy(drv, &qcom_spm_idle_driver, sizeof(*drv));  in spm_cpuidle_init()
233 	drv->cpumask = (struct cpumask *)cpumask_of(cpu);  in spm_cpuidle_init()
236 	ret = dt_init_idle_driver(drv, qcom_idle_state_match, 1);  in spm_cpuidle_init()
241 	return qcom_scm_set_warm_boot_addr(cpu_resume_arm, drv->cpumask);  in spm_cpuidle_init()
247 	struct spm_driver_data *drv = NULL;  in spm_get_drv()  local
265 		drv = devm_kzalloc(&pdev->dev, sizeof(*drv), GFP_KERNEL);  in spm_get_drv()
266 		if (drv)  in spm_get_drv()
270 	return drv;  in spm_get_drv()
287 	struct spm_driver_data *drv;  in spm_dev_probe()  local
296 	drv = spm_get_drv(pdev, &cpu);  in spm_dev_probe()
297 	if (!drv)  in spm_dev_probe()
299 	platform_set_drvdata(pdev, drv);  in spm_dev_probe()
302 	drv->reg_base = devm_ioremap_resource(&pdev->dev, res);  in spm_dev_probe()
303 	if (IS_ERR(drv->reg_base))  in spm_dev_probe()
304 		return PTR_ERR(drv->reg_base);  in spm_dev_probe()
310 	drv->reg_data = match_id->data;  in spm_dev_probe()
312 	ret = spm_cpuidle_init(&drv->cpuidle_driver, cpu);  in spm_dev_probe()
317 	addr = drv->reg_base + drv->reg_data->reg_offset[SPM_REG_SEQ_ENTRY];  in spm_dev_probe()
318 	__iowrite32_copy(addr, drv->reg_data->seq,  in spm_dev_probe()
319 			ARRAY_SIZE(drv->reg_data->seq) / 4);  in spm_dev_probe()
327 	spm_register_write(drv, SPM_REG_CFG, drv->reg_data->spm_cfg);  in spm_dev_probe()
328 	spm_register_write(drv, SPM_REG_DLY, drv->reg_data->spm_dly);  in spm_dev_probe()
329 	spm_register_write(drv, SPM_REG_PMIC_DLY, drv->reg_data->pmic_dly);  in spm_dev_probe()
330 	spm_register_write(drv, SPM_REG_PMIC_DATA_0,  in spm_dev_probe()
331 				drv->reg_data->pmic_data[0]);  in spm_dev_probe()
332 	spm_register_write(drv, SPM_REG_PMIC_DATA_1,  in spm_dev_probe()
333 				drv->reg_data->pmic_data[1]);  in spm_dev_probe()
336 	spm_set_low_power_mode(drv, PM_SLEEP_MODE_STBY);  in spm_dev_probe()
338 	return cpuidle_register(&drv->cpuidle_driver, NULL);  in spm_dev_probe()
343 	struct spm_driver_data *drv = platform_get_drvdata(pdev);  in spm_dev_remove()  local
345 	cpuidle_unregister(&drv->cpuidle_driver);  in spm_dev_remove()