192 static inline void spm_register_write(struct spm_driver_data *drv,  in spm_register_write()  argument
195 	if (drv->reg_data->reg_offset[reg])  in spm_register_write()
196 		writel_relaxed(val, drv->reg_base +  in spm_register_write()
197 				drv->reg_data->reg_offset[reg]);  in spm_register_write()
201 static inline void spm_register_write_sync(struct spm_driver_data *drv,  in spm_register_write_sync()  argument
206 	if (!drv->reg_data->reg_offset[reg])  in spm_register_write_sync()
210 		writel_relaxed(val, drv->reg_base +  in spm_register_write_sync()
211 				drv->reg_data->reg_offset[reg]);  in spm_register_write_sync()
212 		ret = readl_relaxed(drv->reg_base +  in spm_register_write_sync()
213 				drv->reg_data->reg_offset[reg]);  in spm_register_write_sync()
220 static inline u32 spm_register_read(struct spm_driver_data *drv,  in spm_register_read()  argument
223 	return readl_relaxed(drv->reg_base + drv->reg_data->reg_offset[reg]);  in spm_register_read()
226 void spm_set_low_power_mode(struct spm_driver_data *drv,  in spm_set_low_power_mode()  argument
232 	start_index = drv->reg_data->start_index[mode];  in spm_set_low_power_mode()
234 	ctl_val = spm_register_read(drv, SPM_REG_SPM_CTL);  in spm_set_low_power_mode()
238 	spm_register_write_sync(drv, SPM_REG_SPM_CTL, ctl_val);  in spm_set_low_power_mode()
275 	struct spm_driver_data *drv;  in spm_dev_probe()  local
278 	drv = devm_kzalloc(&pdev->dev, sizeof(*drv), GFP_KERNEL);  in spm_dev_probe()
279 	if (!drv)  in spm_dev_probe()
282 	drv->reg_base = devm_platform_ioremap_resource(pdev, 0);  in spm_dev_probe()
283 	if (IS_ERR(drv->reg_base))  in spm_dev_probe()
284 		return PTR_ERR(drv->reg_base);  in spm_dev_probe()
290 	drv->reg_data = match_id->data;  in spm_dev_probe()
291 	platform_set_drvdata(pdev, drv);  in spm_dev_probe()
294 	addr = drv->reg_base + drv->reg_data->reg_offset[SPM_REG_SEQ_ENTRY];  in spm_dev_probe()
295 	__iowrite32_copy(addr, drv->reg_data->seq,  in spm_dev_probe()
296 			ARRAY_SIZE(drv->reg_data->seq) / 4);  in spm_dev_probe()
304 	spm_register_write(drv, SPM_REG_AVS_CTL, drv->reg_data->avs_ctl);  in spm_dev_probe()
305 	spm_register_write(drv, SPM_REG_AVS_LIMIT, drv->reg_data->avs_limit);  in spm_dev_probe()
306 	spm_register_write(drv, SPM_REG_CFG, drv->reg_data->spm_cfg);  in spm_dev_probe()
307 	spm_register_write(drv, SPM_REG_DLY, drv->reg_data->spm_dly);  in spm_dev_probe()
308 	spm_register_write(drv, SPM_REG_PMIC_DLY, drv->reg_data->pmic_dly);  in spm_dev_probe()
309 	spm_register_write(drv, SPM_REG_PMIC_DATA_0,  in spm_dev_probe()
310 				drv->reg_data->pmic_data[0]);  in spm_dev_probe()
311 	spm_register_write(drv, SPM_REG_PMIC_DATA_1,  in spm_dev_probe()
312 				drv->reg_data->pmic_data[1]);  in spm_dev_probe()
315 	if (drv->reg_data->reg_offset[SPM_REG_SPM_CTL])  in spm_dev_probe()
316 		spm_set_low_power_mode(drv, PM_SLEEP_MODE_STBY);  in spm_dev_probe()