115 static inline void spm_register_write(struct spm_driver_data *drv,  in spm_register_write()  argument
118 	if (drv->reg_data->reg_offset[reg])  in spm_register_write()
119 		writel_relaxed(val, drv->reg_base +  in spm_register_write()
120 				drv->reg_data->reg_offset[reg]);  in spm_register_write()
124 static inline void spm_register_write_sync(struct spm_driver_data *drv,  in spm_register_write_sync()  argument
129 	if (!drv->reg_data->reg_offset[reg])  in spm_register_write_sync()
133 		writel_relaxed(val, drv->reg_base +  in spm_register_write_sync()
134 				drv->reg_data->reg_offset[reg]);  in spm_register_write_sync()
135 		ret = readl_relaxed(drv->reg_base +  in spm_register_write_sync()
136 				drv->reg_data->reg_offset[reg]);  in spm_register_write_sync()
143 static inline u32 spm_register_read(struct spm_driver_data *drv,  in spm_register_read()  argument
146 	return readl_relaxed(drv->reg_base + drv->reg_data->reg_offset[reg]);  in spm_register_read()
149 static void spm_set_low_power_mode(struct spm_driver_data *drv,  in spm_set_low_power_mode()  argument
155 	start_index = drv->reg_data->start_index[mode];  in spm_set_low_power_mode()
157 	ctl_val = spm_register_read(drv, SPM_REG_SPM_CTL);  in spm_set_low_power_mode()
161 	spm_register_write_sync(drv, SPM_REG_SPM_CTL, ctl_val);  in spm_set_low_power_mode()
178 	struct spm_driver_data *drv = __this_cpu_read(cpu_spm_drv);  in qcom_cpu_spc()  local
180 	spm_set_low_power_mode(drv, PM_SLEEP_MODE_SPC);  in qcom_cpu_spc()
188 	spm_set_low_power_mode(drv, PM_SLEEP_MODE_STBY);  in qcom_cpu_spc()
284 	struct spm_driver_data *drv = NULL;  in spm_get_drv()  local
302 		drv = devm_kzalloc(&pdev->dev, sizeof(*drv), GFP_KERNEL);  in spm_get_drv()
303 		if (drv)  in spm_get_drv()
307 	return drv;  in spm_get_drv()
322 	struct spm_driver_data *drv;  in spm_dev_probe()  local
328 	drv = spm_get_drv(pdev, &cpu);  in spm_dev_probe()
329 	if (!drv)  in spm_dev_probe()
333 	drv->reg_base = devm_ioremap_resource(&pdev->dev, res);  in spm_dev_probe()
334 	if (IS_ERR(drv->reg_base))  in spm_dev_probe()
335 		return PTR_ERR(drv->reg_base);  in spm_dev_probe()
341 	drv->reg_data = match_id->data;  in spm_dev_probe()
344 	addr = drv->reg_base + drv->reg_data->reg_offset[SPM_REG_SEQ_ENTRY];  in spm_dev_probe()
345 	__iowrite32_copy(addr, drv->reg_data->seq,  in spm_dev_probe()
346 			ARRAY_SIZE(drv->reg_data->seq) / 4);  in spm_dev_probe()
354 	spm_register_write(drv, SPM_REG_CFG, drv->reg_data->spm_cfg);  in spm_dev_probe()
355 	spm_register_write(drv, SPM_REG_DLY, drv->reg_data->spm_dly);  in spm_dev_probe()
356 	spm_register_write(drv, SPM_REG_PMIC_DLY, drv->reg_data->pmic_dly);  in spm_dev_probe()
357 	spm_register_write(drv, SPM_REG_PMIC_DATA_0,  in spm_dev_probe()
358 				drv->reg_data->pmic_data[0]);  in spm_dev_probe()
359 	spm_register_write(drv, SPM_REG_PMIC_DATA_1,  in spm_dev_probe()
360 				drv->reg_data->pmic_data[1]);  in spm_dev_probe()
363 	spm_set_low_power_mode(drv, PM_SLEEP_MODE_STBY);  in spm_dev_probe()
365 	per_cpu(cpu_spm_drv, cpu) = drv;  in spm_dev_probe()