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()
288 static void __init omap3_vc_init_pmic_signaling(struct voltagedomain *voltdm)  in omap3_vc_init_pmic_signaling()  argument
295 	vc.vd = voltdm;  in omap3_vc_init_pmic_signaling()
297 	val = voltdm->read(OMAP3_PRM_POLCTRL_OFFSET);  in omap3_vc_init_pmic_signaling()
304 		voltdm->write(val, OMAP3_PRM_POLCTRL_OFFSET);  in omap3_vc_init_pmic_signaling()
318 	val = voltdm->read(OMAP3_PRM_VOLTCTRL_OFFSET);  in omap3_vc_init_pmic_signaling()
323 		voltdm->write(val, OMAP3_PRM_VOLTCTRL_OFFSET);  in omap3_vc_init_pmic_signaling()
330 static void omap3_init_voltsetup1(struct voltagedomain *voltdm,  in omap3_init_voltsetup1()  argument
335 	val = (voltdm->vc_param->on - idle) / voltdm->pmic->slew_rate;  in omap3_init_voltsetup1()
336 	val *= voltdm->sys_clk.rate / 8 / 1000000 + 1;  in omap3_init_voltsetup1()
337 	val <<= __ffs(voltdm->vfsm->voltsetup_mask);  in omap3_init_voltsetup1()
338 	c->voltsetup1 &= ~voltdm->vfsm->voltsetup_mask;  in omap3_init_voltsetup1()
358 static void omap3_set_i2c_timings(struct voltagedomain *voltdm)  in omap3_set_i2c_timings()  argument
363 	omap3_init_voltsetup1(voltdm, c, voltdm->vc_param->off);  in omap3_set_i2c_timings()
366 	omap3_init_voltsetup1(voltdm, c, voltdm->vc_param->ret);  in omap3_set_i2c_timings()
384 static void omap3_set_off_timings(struct voltagedomain *voltdm)  in omap3_set_off_timings()  argument
409 	voltdm->write(clksetup, OMAP3_PRM_CLKSETUP_OFFSET);  in omap3_set_off_timings()
410 	voltdm->write(voltoffset, OMAP3_PRM_VOLTOFFSET_OFFSET);  in omap3_set_off_timings()
413 static void __init omap3_vc_init_channel(struct voltagedomain *voltdm)  in omap3_vc_init_channel()  argument
415 	omap3_vc_init_pmic_signaling(voltdm);  in omap3_vc_init_channel()
416 	omap3_set_off_timings(voltdm);  in omap3_vc_init_channel()
417 	omap3_set_i2c_timings(voltdm);  in omap3_vc_init_channel()
430 static u32 omap4_calc_volt_ramp(struct voltagedomain *voltdm, u32 voltage_diff)  in omap4_calc_volt_ramp()  argument
436 	time = voltage_diff / voltdm->pmic->slew_rate;  in omap4_calc_volt_ramp()
438 	cycles = voltdm->sys_clk.rate / 1000 * time / 1000;  in omap4_calc_volt_ramp()
466 			voltdm->name);  in omap4_calc_volt_ramp()
507 static void omap4_set_timings(struct voltagedomain *voltdm, bool off_mode)  in omap4_set_timings()  argument
515 		ramp = omap4_calc_volt_ramp(voltdm,  in omap4_set_timings()
516 			voltdm->vc_param->on - voltdm->vc_param->off);  in omap4_set_timings()
517 		offset = voltdm->vfsm->voltsetup_off_reg;  in omap4_set_timings()
519 		ramp = omap4_calc_volt_ramp(voltdm,  in omap4_set_timings()
520 			voltdm->vc_param->on - voltdm->vc_param->ret);  in omap4_set_timings()
521 		offset = voltdm->vfsm->voltsetup_reg;  in omap4_set_timings()
527 	val = voltdm->read(offset);  in omap4_set_timings()
533 	voltdm->write(val, offset);  in omap4_set_timings()
546 static void __init omap4_vc_init_channel(struct voltagedomain *voltdm)  in omap4_vc_init_channel()  argument
548 	omap4_set_timings(voltdm, true);  in omap4_vc_init_channel()
549 	omap4_set_timings(voltdm, false);  in omap4_vc_init_channel()
610 static void __init omap4_vc_i2c_timing_init(struct voltagedomain *voltdm)  in omap4_vc_i2c_timing_init()  argument
617 	if (!voltdm->pmic->i2c_high_speed) {  in omap4_vc_i2c_timing_init()
629 	capacitance += voltdm->pmic->i2c_pad_load;  in omap4_vc_i2c_timing_init()
638 	switch (voltdm->sys_clk.rate) {  in omap4_vc_i2c_timing_init()
656 			voltdm->sys_clk.rate);  in omap4_vc_i2c_timing_init()
672 	voltdm->write(val, OMAP4_PRM_VC_CFG_I2C_CLK_OFFSET);  in omap4_vc_i2c_timing_init()
690 static void __init omap_vc_i2c_init(struct voltagedomain *voltdm)  in omap_vc_i2c_init()  argument
692 	struct omap_vc_channel *vc = voltdm->vc;  in omap_vc_i2c_init()
698 		if (voltdm->pmic->i2c_high_speed != i2c_high_speed)  in omap_vc_i2c_init()
700 				__func__, voltdm->name, i2c_high_speed);  in omap_vc_i2c_init()
711 	i2c_high_speed = voltdm->pmic->i2c_high_speed;  in omap_vc_i2c_init()
713 		voltdm->rmw(vc->common->i2c_cfg_clear_mask,  in omap_vc_i2c_init()
717 	mcode = voltdm->pmic->i2c_mcode;  in omap_vc_i2c_init()
719 		voltdm->rmw(vc->common->i2c_mcode_mask,  in omap_vc_i2c_init()
724 		omap4_vc_i2c_timing_init(voltdm);  in omap_vc_i2c_init()
739 static u8 omap_vc_calc_vsel(struct voltagedomain *voltdm, u32 uvolt)  in omap_vc_calc_vsel()  argument
741 	if (voltdm->pmic->vddmin > uvolt)  in omap_vc_calc_vsel()
742 		uvolt = voltdm->pmic->vddmin;  in omap_vc_calc_vsel()
743 	if (voltdm->pmic->vddmax < uvolt) {  in omap_vc_calc_vsel()
745 			__func__, uvolt, voltdm->pmic->vddmax);  in omap_vc_calc_vsel()
747 		uvolt = voltdm->pmic->vddmax;  in omap_vc_calc_vsel()
750 	return voltdm->pmic->uv_to_vsel(uvolt);  in omap_vc_calc_vsel()
768 void __init omap_vc_init_channel(struct voltagedomain *voltdm)  in omap_vc_init_channel()  argument
770 	struct omap_vc_channel *vc = voltdm->vc;  in omap_vc_init_channel()
774 	if (!voltdm->pmic || !voltdm->pmic->uv_to_vsel) {  in omap_vc_init_channel()
775 		pr_err("%s: No PMIC info for vdd_%s\n", __func__, voltdm->name);  in omap_vc_init_channel()
779 	if (!voltdm->read || !voltdm->write) {  in omap_vc_init_channel()
781 			__func__, voltdm->name);  in omap_vc_init_channel()
792 	vc->i2c_slave_addr = voltdm->pmic->i2c_slave_addr;  in omap_vc_init_channel()
793 	vc->volt_reg_addr = voltdm->pmic->volt_reg_addr;  in omap_vc_init_channel()
794 	vc->cmd_reg_addr = voltdm->pmic->cmd_reg_addr;  in omap_vc_init_channel()
797 	voltdm->rmw(vc->smps_sa_mask,  in omap_vc_init_channel()
805 	voltdm->rmw(vc->smps_volra_mask,  in omap_vc_init_channel()
811 		voltdm->rmw(vc->smps_cmdra_mask,  in omap_vc_init_channel()
821 	on_vsel = omap_vc_calc_vsel(voltdm, voltdm->vc_param->on);  in omap_vc_init_channel()
822 	onlp_vsel = omap_vc_calc_vsel(voltdm, voltdm->vc_param->onlp);  in omap_vc_init_channel()
823 	ret_vsel = omap_vc_calc_vsel(voltdm, voltdm->vc_param->ret);  in omap_vc_init_channel()
824 	off_vsel = omap_vc_calc_vsel(voltdm, voltdm->vc_param->off);  in omap_vc_init_channel()
830 	voltdm->write(val, vc->cmdval_reg);  in omap_vc_init_channel()
834 	omap_vc_config_channel(voltdm);  in omap_vc_init_channel()
836 	omap_vc_i2c_init(voltdm);  in omap_vc_init_channel()
839 		omap3_vc_init_channel(voltdm);  in omap_vc_init_channel()
841 		omap4_vc_init_channel(voltdm);  in omap_vc_init_channel()