94 static int omap_vc_config_channel(struct voltagedomain *voltdm)  in omap_vc_config_channel()  argument
96 	struct omap_vc_channel *vc = voltdm->vc;  in omap_vc_config_channel()
105 	voltdm->rmw(CFG_CHANNEL_MASK << vc->cfg_channel_sa_shift,  in omap_vc_config_channel()
113 int omap_vc_pre_scale(struct voltagedomain *voltdm,  in omap_vc_pre_scale()  argument
117 	struct omap_vc_channel *vc = voltdm->vc;  in omap_vc_pre_scale()
121 	if (!voltdm->pmic) {  in omap_vc_pre_scale()
123 			__func__, voltdm->name);  in omap_vc_pre_scale()
127 	if (!voltdm->pmic->uv_to_vsel) {  in omap_vc_pre_scale()
129 		       __func__, voltdm->name);  in omap_vc_pre_scale()
133 	if (!voltdm->read || !voltdm->write) {  in omap_vc_pre_scale()
135 			__func__, voltdm->name);  in omap_vc_pre_scale()
139 	*target_vsel = voltdm->pmic->uv_to_vsel(target_volt);  in omap_vc_pre_scale()
140 	*current_vsel = voltdm->pmic->uv_to_vsel(voltdm->nominal_volt);  in omap_vc_pre_scale()
143 	vc_cmdval = voltdm->read(vc->cmdval_reg);  in omap_vc_pre_scale()
146 	voltdm->write(vc_cmdval, vc->cmdval_reg);  in omap_vc_pre_scale()
148 	voltdm->vc_param->on = target_volt;  in omap_vc_pre_scale()
150 	omap_vp_update_errorgain(voltdm, target_volt);  in omap_vc_pre_scale()
155 void omap_vc_post_scale(struct voltagedomain *voltdm,  in omap_vc_post_scale()  argument
163 	smps_delay = ((smps_steps * voltdm->pmic->step_size) /  in omap_vc_post_scale()
164 			voltdm->pmic->slew_rate) + 2;  in omap_vc_post_scale()
169 int omap_vc_bypass_scale(struct voltagedomain *voltdm,  in omap_vc_bypass_scale()  argument
172 	struct omap_vc_channel *vc = voltdm->vc;  in omap_vc_bypass_scale()
178 	ret = omap_vc_pre_scale(voltdm, target_volt, &target_vsel, &current_vsel);  in omap_vc_bypass_scale()
188 	voltdm->write(vc_bypass_value, vc_bypass_val_reg);  in omap_vc_bypass_scale()
189 	voltdm->write(vc_bypass_value | vc_valid, vc_bypass_val_reg);  in omap_vc_bypass_scale()
191 	vc_bypass_value = voltdm->read(vc_bypass_val_reg);  in omap_vc_bypass_scale()
210 		vc_bypass_value = voltdm->read(vc_bypass_val_reg);  in omap_vc_bypass_scale()
213 	omap_vc_post_scale(voltdm, target_volt, target_vsel, current_vsel);  in omap_vc_bypass_scale()
292 static void __init omap3_vc_init_pmic_signaling(struct voltagedomain *voltdm)  in omap3_vc_init_pmic_signaling()  argument
299 	vc.vd = voltdm;  in omap3_vc_init_pmic_signaling()
301 	val = voltdm->read(OMAP3_PRM_POLCTRL_OFFSET);  in omap3_vc_init_pmic_signaling()
308 		voltdm->write(val, OMAP3_PRM_POLCTRL_OFFSET);  in omap3_vc_init_pmic_signaling()
322 	val = voltdm->read(OMAP3_PRM_VOLTCTRL_OFFSET);  in omap3_vc_init_pmic_signaling()
327 		voltdm->write(val, OMAP3_PRM_VOLTCTRL_OFFSET);  in omap3_vc_init_pmic_signaling()
334 static void omap3_init_voltsetup1(struct voltagedomain *voltdm,  in omap3_init_voltsetup1()  argument
339 	val = (voltdm->vc_param->on - idle) / voltdm->pmic->slew_rate;  in omap3_init_voltsetup1()
340 	val *= voltdm->sys_clk.rate / 8 / 1000000 + 1;  in omap3_init_voltsetup1()
341 	val <<= __ffs(voltdm->vfsm->voltsetup_mask);  in omap3_init_voltsetup1()
342 	c->voltsetup1 &= ~voltdm->vfsm->voltsetup_mask;  in omap3_init_voltsetup1()
362 static void omap3_set_i2c_timings(struct voltagedomain *voltdm)  in omap3_set_i2c_timings()  argument
367 	omap3_init_voltsetup1(voltdm, c, voltdm->vc_param->off);  in omap3_set_i2c_timings()
370 	omap3_init_voltsetup1(voltdm, c, voltdm->vc_param->ret);  in omap3_set_i2c_timings()
388 static void omap3_set_off_timings(struct voltagedomain *voltdm)  in omap3_set_off_timings()  argument
413 	voltdm->write(clksetup, OMAP3_PRM_CLKSETUP_OFFSET);  in omap3_set_off_timings()
414 	voltdm->write(voltoffset, OMAP3_PRM_VOLTOFFSET_OFFSET);  in omap3_set_off_timings()
417 static void __init omap3_vc_init_channel(struct voltagedomain *voltdm)  in omap3_vc_init_channel()  argument
419 	omap3_vc_init_pmic_signaling(voltdm);  in omap3_vc_init_channel()
420 	omap3_set_off_timings(voltdm);  in omap3_vc_init_channel()
421 	omap3_set_i2c_timings(voltdm);  in omap3_vc_init_channel()
434 static u32 omap4_calc_volt_ramp(struct voltagedomain *voltdm, u32 voltage_diff)  in omap4_calc_volt_ramp()  argument
440 	time = voltage_diff / voltdm->pmic->slew_rate;  in omap4_calc_volt_ramp()
442 	cycles = voltdm->sys_clk.rate / 1000 * time / 1000;  in omap4_calc_volt_ramp()
470 			voltdm->name);  in omap4_calc_volt_ramp()
511 static void omap4_set_timings(struct voltagedomain *voltdm, bool off_mode)  in omap4_set_timings()  argument
519 		ramp = omap4_calc_volt_ramp(voltdm,  in omap4_set_timings()
520 			voltdm->vc_param->on - voltdm->vc_param->off);  in omap4_set_timings()
521 		offset = voltdm->vfsm->voltsetup_off_reg;  in omap4_set_timings()
523 		ramp = omap4_calc_volt_ramp(voltdm,  in omap4_set_timings()
524 			voltdm->vc_param->on - voltdm->vc_param->ret);  in omap4_set_timings()
525 		offset = voltdm->vfsm->voltsetup_reg;  in omap4_set_timings()
531 	val = voltdm->read(offset);  in omap4_set_timings()
537 	voltdm->write(val, offset);  in omap4_set_timings()
550 static void __init omap4_vc_init_channel(struct voltagedomain *voltdm)  in omap4_vc_init_channel()  argument
552 	omap4_set_timings(voltdm, true);  in omap4_vc_init_channel()
553 	omap4_set_timings(voltdm, false);  in omap4_vc_init_channel()
614 static void __init omap4_vc_i2c_timing_init(struct voltagedomain *voltdm)  in omap4_vc_i2c_timing_init()  argument
621 	if (!voltdm->pmic->i2c_high_speed) {  in omap4_vc_i2c_timing_init()
633 	capacitance += voltdm->pmic->i2c_pad_load;  in omap4_vc_i2c_timing_init()
642 	switch (voltdm->sys_clk.rate) {  in omap4_vc_i2c_timing_init()
660 			voltdm->sys_clk.rate);  in omap4_vc_i2c_timing_init()
676 	voltdm->write(val, OMAP4_PRM_VC_CFG_I2C_CLK_OFFSET);  in omap4_vc_i2c_timing_init()
694 static void __init omap_vc_i2c_init(struct voltagedomain *voltdm)  in omap_vc_i2c_init()  argument
696 	struct omap_vc_channel *vc = voltdm->vc;  in omap_vc_i2c_init()
702 		if (voltdm->pmic->i2c_high_speed != i2c_high_speed)  in omap_vc_i2c_init()
704 				__func__, voltdm->name, i2c_high_speed);  in omap_vc_i2c_init()
715 	i2c_high_speed = voltdm->pmic->i2c_high_speed;  in omap_vc_i2c_init()
717 		voltdm->rmw(vc->common->i2c_cfg_clear_mask,  in omap_vc_i2c_init()
721 	mcode = voltdm->pmic->i2c_mcode;  in omap_vc_i2c_init()
723 		voltdm->rmw(vc->common->i2c_mcode_mask,  in omap_vc_i2c_init()
728 		omap4_vc_i2c_timing_init(voltdm);  in omap_vc_i2c_init()
743 static u8 omap_vc_calc_vsel(struct voltagedomain *voltdm, u32 uvolt)  in omap_vc_calc_vsel()  argument
745 	if (voltdm->pmic->vddmin > uvolt)  in omap_vc_calc_vsel()
746 		uvolt = voltdm->pmic->vddmin;  in omap_vc_calc_vsel()
747 	if (voltdm->pmic->vddmax < uvolt) {  in omap_vc_calc_vsel()
749 			__func__, uvolt, voltdm->pmic->vddmax);  in omap_vc_calc_vsel()
751 		uvolt = voltdm->pmic->vddmax;  in omap_vc_calc_vsel()
754 	return voltdm->pmic->uv_to_vsel(uvolt);  in omap_vc_calc_vsel()
772 void __init omap_vc_init_channel(struct voltagedomain *voltdm)  in omap_vc_init_channel()  argument
774 	struct omap_vc_channel *vc = voltdm->vc;  in omap_vc_init_channel()
778 	if (!voltdm->pmic || !voltdm->pmic->uv_to_vsel) {  in omap_vc_init_channel()
779 		pr_err("%s: No PMIC info for vdd_%s\n", __func__, voltdm->name);  in omap_vc_init_channel()
783 	if (!voltdm->read || !voltdm->write) {  in omap_vc_init_channel()
785 			__func__, voltdm->name);  in omap_vc_init_channel()
796 	vc->i2c_slave_addr = voltdm->pmic->i2c_slave_addr;  in omap_vc_init_channel()
797 	vc->volt_reg_addr = voltdm->pmic->volt_reg_addr;  in omap_vc_init_channel()
798 	vc->cmd_reg_addr = voltdm->pmic->cmd_reg_addr;  in omap_vc_init_channel()
801 	voltdm->rmw(vc->smps_sa_mask,  in omap_vc_init_channel()
809 	voltdm->rmw(vc->smps_volra_mask,  in omap_vc_init_channel()
815 		voltdm->rmw(vc->smps_cmdra_mask,  in omap_vc_init_channel()
825 	on_vsel = omap_vc_calc_vsel(voltdm, voltdm->vc_param->on);  in omap_vc_init_channel()
826 	onlp_vsel = omap_vc_calc_vsel(voltdm, voltdm->vc_param->onlp);  in omap_vc_init_channel()
827 	ret_vsel = omap_vc_calc_vsel(voltdm, voltdm->vc_param->ret);  in omap_vc_init_channel()
828 	off_vsel = omap_vc_calc_vsel(voltdm, voltdm->vc_param->off);  in omap_vc_init_channel()
834 	voltdm->write(val, vc->cmdval_reg);  in omap_vc_init_channel()
838 	omap_vc_config_channel(voltdm);  in omap_vc_init_channel()
840 	omap_vc_i2c_init(voltdm);  in omap_vc_init_channel()
843 		omap3_vc_init_channel(voltdm);  in omap_vc_init_channel()
845 		omap4_vc_init_channel(voltdm);  in omap_vc_init_channel()