122 static inline void spm_register_write(struct spm_driver_data *drv,  in spm_register_write()  argument
125 	if (drv->reg_data->reg_offset[reg])  in spm_register_write()
126 		writel_relaxed(val, drv->reg_base +  in spm_register_write()
127 				drv->reg_data->reg_offset[reg]);  in spm_register_write()
131 static inline void spm_register_write_sync(struct spm_driver_data *drv,  in spm_register_write_sync()  argument
136 	if (!drv->reg_data->reg_offset[reg])  in spm_register_write_sync()
140 		writel_relaxed(val, drv->reg_base +  in spm_register_write_sync()
141 				drv->reg_data->reg_offset[reg]);  in spm_register_write_sync()
142 		ret = readl_relaxed(drv->reg_base +  in spm_register_write_sync()
143 				drv->reg_data->reg_offset[reg]);  in spm_register_write_sync()
150 static inline u32 spm_register_read(struct spm_driver_data *drv,  in spm_register_read()  argument
153 	return readl_relaxed(drv->reg_base + drv->reg_data->reg_offset[reg]);  in spm_register_read()
156 static void spm_set_low_power_mode(struct spm_driver_data *drv,  in spm_set_low_power_mode()  argument
162 	start_index = drv->reg_data->start_index[mode];  in spm_set_low_power_mode()
164 	ctl_val = spm_register_read(drv, SPM_REG_SPM_CTL);  in spm_set_low_power_mode()
168 	spm_register_write_sync(drv, SPM_REG_SPM_CTL, ctl_val);  in spm_set_low_power_mode()
185 	struct spm_driver_data *drv = per_cpu(cpu_spm_drv, cpu);  in qcom_cpu_spc()  local
187 	spm_set_low_power_mode(drv, PM_SLEEP_MODE_SPC);  in qcom_cpu_spc()
195 	spm_set_low_power_mode(drv, PM_SLEEP_MODE_STBY);  in qcom_cpu_spc()
288 	struct spm_driver_data *drv = NULL;  in spm_get_drv()  local
306 		drv = devm_kzalloc(&pdev->dev, sizeof(*drv), GFP_KERNEL);  in spm_get_drv()
307 		if (drv)  in spm_get_drv()
311 	return drv;  in spm_get_drv()
326 	struct spm_driver_data *drv;  in spm_dev_probe()  local
332 	drv = spm_get_drv(pdev, &cpu);  in spm_dev_probe()
333 	if (!drv)  in spm_dev_probe()
337 	drv->reg_base = devm_ioremap_resource(&pdev->dev, res);  in spm_dev_probe()
338 	if (IS_ERR(drv->reg_base))  in spm_dev_probe()
339 		return PTR_ERR(drv->reg_base);  in spm_dev_probe()
345 	drv->reg_data = match_id->data;  in spm_dev_probe()
348 	addr = drv->reg_base + drv->reg_data->reg_offset[SPM_REG_SEQ_ENTRY];  in spm_dev_probe()
349 	__iowrite32_copy(addr, drv->reg_data->seq,  in spm_dev_probe()
350 			ARRAY_SIZE(drv->reg_data->seq) / 4);  in spm_dev_probe()
358 	spm_register_write(drv, SPM_REG_CFG, drv->reg_data->spm_cfg);  in spm_dev_probe()
359 	spm_register_write(drv, SPM_REG_DLY, drv->reg_data->spm_dly);  in spm_dev_probe()
360 	spm_register_write(drv, SPM_REG_PMIC_DLY, drv->reg_data->pmic_dly);  in spm_dev_probe()
361 	spm_register_write(drv, SPM_REG_PMIC_DATA_0,  in spm_dev_probe()
362 				drv->reg_data->pmic_data[0]);  in spm_dev_probe()
363 	spm_register_write(drv, SPM_REG_PMIC_DATA_1,  in spm_dev_probe()
364 				drv->reg_data->pmic_data[1]);  in spm_dev_probe()
367 	spm_set_low_power_mode(drv, PM_SLEEP_MODE_STBY);  in spm_dev_probe()
369 	per_cpu(cpu_spm_drv, cpu) = drv;  in spm_dev_probe()