256 static inline void spm_register_write(struct spm_driver_data *drv,  in spm_register_write()  argument
259 	if (drv->reg_data->reg_offset[reg])  in spm_register_write()
260 		writel_relaxed(val, drv->reg_base +  in spm_register_write()
261 				drv->reg_data->reg_offset[reg]);  in spm_register_write()
265 static inline void spm_register_write_sync(struct spm_driver_data *drv,  in spm_register_write_sync()  argument
270 	if (!drv->reg_data->reg_offset[reg])  in spm_register_write_sync()
274 		writel_relaxed(val, drv->reg_base +  in spm_register_write_sync()
275 				drv->reg_data->reg_offset[reg]);  in spm_register_write_sync()
276 		ret = readl_relaxed(drv->reg_base +  in spm_register_write_sync()
277 				drv->reg_data->reg_offset[reg]);  in spm_register_write_sync()
284 static inline u32 spm_register_read(struct spm_driver_data *drv,  in spm_register_read()  argument
287 	return readl_relaxed(drv->reg_base + drv->reg_data->reg_offset[reg]);  in spm_register_read()
290 void spm_set_low_power_mode(struct spm_driver_data *drv,  in spm_set_low_power_mode()  argument
296 	start_index = drv->reg_data->start_index[mode];  in spm_set_low_power_mode()
298 	ctl_val = spm_register_read(drv, SPM_REG_SPM_CTL);  in spm_set_low_power_mode()
302 	spm_register_write_sync(drv, SPM_REG_SPM_CTL, ctl_val);  in spm_set_low_power_mode()
307 	struct spm_driver_data *drv = rdev_get_drvdata(rdev);  in spm_set_voltage_sel()  local
309 	drv->volt_sel = selector;  in spm_set_voltage_sel()
312 	return smp_call_function_single(drv->reg_cpu, drv->reg_data->set_vdd, drv, true);  in spm_set_voltage_sel()
317 	struct spm_driver_data *drv = rdev_get_drvdata(rdev);  in spm_get_voltage_sel()  local
319 	return drv->volt_sel;  in spm_get_voltage_sel()
331 	struct spm_driver_data *drv = data;  in smp_set_vdd_v1_1()  local
336 	volt_sel = drv->volt_sel;  in smp_set_vdd_v1_1()
339 	avs_ctl = spm_register_read(drv, SPM_REG_AVS_CTL);  in smp_set_vdd_v1_1()
340 	vctl = spm_register_read(drv, SPM_REG_VCTL);  in smp_set_vdd_v1_1()
341 	data0 = spm_register_read(drv, SPM_REG_PMIC_DATA_0);  in smp_set_vdd_v1_1()
342 	data1 = spm_register_read(drv, SPM_REG_PMIC_DATA_1);  in smp_set_vdd_v1_1()
349 		spm_register_write(drv, SPM_REG_AVS_CTL, avs_ctl);  in smp_set_vdd_v1_1()
353 	spm_register_write(drv, SPM_REG_RST, 1);  in smp_set_vdd_v1_1()
360 	spm_register_write(drv, SPM_REG_VCTL, vctl);  in smp_set_vdd_v1_1()
361 	spm_register_write(drv, SPM_REG_PMIC_DATA_0, data0);  in smp_set_vdd_v1_1()
362 	spm_register_write(drv, SPM_REG_PMIC_DATA_1, data1);  in smp_set_vdd_v1_1()
367 				     drv, SPM_REG_STS1)) {  in smp_set_vdd_v1_1()
368 		dev_err_ratelimited(drv->dev, "timeout setting the voltage (%x %x)!\n", sts, vlevel);  in smp_set_vdd_v1_1()
378 		spm_register_write(drv, SPM_REG_AVS_CTL, avs_ctl);  in smp_set_vdd_v1_1()
384 		spm_register_write(drv, SPM_REG_AVS_CTL, avs_ctl);  in smp_set_vdd_v1_1()
414 static int spm_register_regulator(struct device *dev, struct spm_driver_data *drv)  in spm_register_regulator()  argument
418 		.driver_data = drv,  in spm_register_regulator()
425 	if (!drv->reg_data->set_vdd)  in spm_register_regulator()
438 	rdesc->linear_ranges = drv->reg_data->range;  in spm_register_regulator()
441 	rdesc->ramp_delay = drv->reg_data->ramp_delay;  in spm_register_regulator()
447 	drv->reg_cpu = ret;  in spm_register_regulator()
448 	dev_dbg(dev, "SAW2 bound to CPU %d\n", drv->reg_cpu);  in spm_register_regulator()
454 	drv->volt_sel = DIV_ROUND_UP(drv->reg_data->init_uV - rdesc->min_uV,  in spm_register_regulator()
456 	ret = linear_range_get_selector_high(drv->reg_data->range,  in spm_register_regulator()
457 					     drv->reg_data->init_uV,  in spm_register_regulator()
458 					     &drv->volt_sel,  in spm_register_regulator()
466 	smp_call_function_single(drv->reg_cpu, drv->reg_data->set_vdd, drv, true);  in spm_register_regulator()
511 	struct spm_driver_data *drv;  in spm_dev_probe()  local
514 	drv = devm_kzalloc(&pdev->dev, sizeof(*drv), GFP_KERNEL);  in spm_dev_probe()
515 	if (!drv)  in spm_dev_probe()
518 	drv->reg_base = devm_platform_ioremap_resource(pdev, 0);  in spm_dev_probe()
519 	if (IS_ERR(drv->reg_base))  in spm_dev_probe()
520 		return PTR_ERR(drv->reg_base);  in spm_dev_probe()
526 	drv->reg_data = match_id->data;  in spm_dev_probe()
527 	drv->dev = &pdev->dev;  in spm_dev_probe()
528 	platform_set_drvdata(pdev, drv);  in spm_dev_probe()
531 	addr = drv->reg_base + drv->reg_data->reg_offset[SPM_REG_SEQ_ENTRY];  in spm_dev_probe()
532 	__iowrite32_copy(addr, drv->reg_data->seq,  in spm_dev_probe()
533 			ARRAY_SIZE(drv->reg_data->seq) / 4);  in spm_dev_probe()
541 	spm_register_write(drv, SPM_REG_AVS_CTL, drv->reg_data->avs_ctl);  in spm_dev_probe()
542 	spm_register_write(drv, SPM_REG_AVS_LIMIT, drv->reg_data->avs_limit);  in spm_dev_probe()
543 	spm_register_write(drv, SPM_REG_CFG, drv->reg_data->spm_cfg);  in spm_dev_probe()
544 	spm_register_write(drv, SPM_REG_DLY, drv->reg_data->spm_dly);  in spm_dev_probe()
545 	spm_register_write(drv, SPM_REG_PMIC_DLY, drv->reg_data->pmic_dly);  in spm_dev_probe()
546 	spm_register_write(drv, SPM_REG_PMIC_DATA_0,  in spm_dev_probe()
547 				drv->reg_data->pmic_data[0]);  in spm_dev_probe()
548 	spm_register_write(drv, SPM_REG_PMIC_DATA_1,  in spm_dev_probe()
549 				drv->reg_data->pmic_data[1]);  in spm_dev_probe()
552 	if (drv->reg_data->reg_offset[SPM_REG_SPM_CTL])  in spm_dev_probe()
553 		spm_set_low_power_mode(drv, PM_SLEEP_MODE_STBY);  in spm_dev_probe()
556 		return spm_register_regulator(&pdev->dev, drv);  in spm_dev_probe()