123 static inline void spm_register_write(struct spm_driver_data *drv,  in spm_register_write()  argument
126 	if (drv->reg_data->reg_offset[reg])  in spm_register_write()
127 		writel_relaxed(val, drv->reg_base +  in spm_register_write()
128 				drv->reg_data->reg_offset[reg]);  in spm_register_write()
132 static inline void spm_register_write_sync(struct spm_driver_data *drv,  in spm_register_write_sync()  argument
137 	if (!drv->reg_data->reg_offset[reg])  in spm_register_write_sync()
141 		writel_relaxed(val, drv->reg_base +  in spm_register_write_sync()
142 				drv->reg_data->reg_offset[reg]);  in spm_register_write_sync()
143 		ret = readl_relaxed(drv->reg_base +  in spm_register_write_sync()
144 				drv->reg_data->reg_offset[reg]);  in spm_register_write_sync()
151 static inline u32 spm_register_read(struct spm_driver_data *drv,  in spm_register_read()  argument
154 	return readl_relaxed(drv->reg_base + drv->reg_data->reg_offset[reg]);  in spm_register_read()
157 static void spm_set_low_power_mode(struct spm_driver_data *drv,  in spm_set_low_power_mode()  argument
163 	start_index = drv->reg_data->start_index[mode];  in spm_set_low_power_mode()
165 	ctl_val = spm_register_read(drv, SPM_REG_SPM_CTL);  in spm_set_low_power_mode()
169 	spm_register_write_sync(drv, SPM_REG_SPM_CTL, ctl_val);  in spm_set_low_power_mode()
186 	struct spm_driver_data *drv = __this_cpu_read(cpu_spm_drv);  in qcom_cpu_spc()  local
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()
289 	struct spm_driver_data *drv = NULL;  in spm_get_drv()  local
307 		drv = devm_kzalloc(&pdev->dev, sizeof(*drv), GFP_KERNEL);  in spm_get_drv()
308 		if (drv)  in spm_get_drv()
312 	return drv;  in spm_get_drv()
327 	struct spm_driver_data *drv;  in spm_dev_probe()  local
333 	drv = spm_get_drv(pdev, &cpu);  in spm_dev_probe()
334 	if (!drv)  in spm_dev_probe()
338 	drv->reg_base = devm_ioremap_resource(&pdev->dev, res);  in spm_dev_probe()
339 	if (IS_ERR(drv->reg_base))  in spm_dev_probe()
340 		return PTR_ERR(drv->reg_base);  in spm_dev_probe()
346 	drv->reg_data = match_id->data;  in spm_dev_probe()
349 	addr = drv->reg_base + drv->reg_data->reg_offset[SPM_REG_SEQ_ENTRY];  in spm_dev_probe()
350 	__iowrite32_copy(addr, drv->reg_data->seq,  in spm_dev_probe()
351 			ARRAY_SIZE(drv->reg_data->seq) / 4);  in spm_dev_probe()
359 	spm_register_write(drv, SPM_REG_CFG, drv->reg_data->spm_cfg);  in spm_dev_probe()
360 	spm_register_write(drv, SPM_REG_DLY, drv->reg_data->spm_dly);  in spm_dev_probe()
361 	spm_register_write(drv, SPM_REG_PMIC_DLY, drv->reg_data->pmic_dly);  in spm_dev_probe()
362 	spm_register_write(drv, SPM_REG_PMIC_DATA_0,  in spm_dev_probe()
363 				drv->reg_data->pmic_data[0]);  in spm_dev_probe()
364 	spm_register_write(drv, SPM_REG_PMIC_DATA_1,  in spm_dev_probe()
365 				drv->reg_data->pmic_data[1]);  in spm_dev_probe()
368 	spm_set_low_power_mode(drv, PM_SLEEP_MODE_STBY);  in spm_dev_probe()
370 	per_cpu(cpu_spm_drv, cpu) = drv;  in spm_dev_probe()