49 static int vctrl_calc_ctrl_voltage(struct vctrl_data *vctrl, int out_uV)  in vctrl_calc_ctrl_voltage()  argument
51 	struct vctrl_voltage_range *ctrl = &vctrl->vrange.ctrl;  in vctrl_calc_ctrl_voltage()
52 	struct vctrl_voltage_range *out = &vctrl->vrange.out;  in vctrl_calc_ctrl_voltage()
60 static int vctrl_calc_output_voltage(struct vctrl_data *vctrl, int ctrl_uV)  in vctrl_calc_output_voltage()  argument
62 	struct vctrl_voltage_range *ctrl = &vctrl->vrange.ctrl;  in vctrl_calc_output_voltage()
63 	struct vctrl_voltage_range *out = &vctrl->vrange.out;  in vctrl_calc_output_voltage()
84 	struct vctrl_data *vctrl = rdev_get_drvdata(rdev);  in vctrl_get_voltage()  local
85 	int ctrl_uV = regulator_get_voltage_rdev(vctrl->ctrl_reg->rdev);  in vctrl_get_voltage()
87 	return vctrl_calc_output_voltage(vctrl, ctrl_uV);  in vctrl_get_voltage()
94 	struct vctrl_data *vctrl = rdev_get_drvdata(rdev);  in vctrl_set_voltage()  local
95 	struct regulator *ctrl_reg = vctrl->ctrl_reg;  in vctrl_set_voltage()
97 	int uV = vctrl_calc_output_voltage(vctrl, orig_ctrl_uV);  in vctrl_set_voltage()
100 	if (req_min_uV >= uV || !vctrl->ovp_threshold)  in vctrl_set_voltage()
103 			vctrl_calc_ctrl_voltage(vctrl, req_min_uV),  in vctrl_set_voltage()
104 			vctrl_calc_ctrl_voltage(vctrl, req_max_uV),  in vctrl_set_voltage()
108 		int max_drop_uV = (uV * vctrl->ovp_threshold) / 100;  in vctrl_set_voltage()
118 		next_ctrl_uV = vctrl_calc_ctrl_voltage(vctrl, next_uV);  in vctrl_set_voltage()
127 		delay = DIV_ROUND_UP(uV - next_uV, vctrl->min_slew_down_rate);  in vctrl_set_voltage()
145 	struct vctrl_data *vctrl = rdev_get_drvdata(rdev);  in vctrl_get_voltage_sel()  local
147 	return vctrl->sel;  in vctrl_get_voltage_sel()
153 	struct vctrl_data *vctrl = rdev_get_drvdata(rdev);  in vctrl_set_voltage_sel()  local
154 	struct regulator *ctrl_reg = vctrl->ctrl_reg;  in vctrl_set_voltage_sel()
155 	unsigned int orig_sel = vctrl->sel;  in vctrl_set_voltage_sel()
161 	if (selector >= vctrl->sel || !vctrl->ovp_threshold) {  in vctrl_set_voltage_sel()
164 					    vctrl->vtable[selector].ctrl,  in vctrl_set_voltage_sel()
165 					    vctrl->vtable[selector].ctrl,  in vctrl_set_voltage_sel()
168 			vctrl->sel = selector;  in vctrl_set_voltage_sel()
173 	while (vctrl->sel != selector) {  in vctrl_set_voltage_sel()
177 		if (selector >= vctrl->vtable[vctrl->sel].ovp_min_sel)  in vctrl_set_voltage_sel()
180 			next_sel = vctrl->vtable[vctrl->sel].ovp_min_sel;  in vctrl_set_voltage_sel()
183 					    vctrl->vtable[next_sel].ctrl,  in vctrl_set_voltage_sel()
184 					    vctrl->vtable[next_sel].ctrl,  in vctrl_set_voltage_sel()
189 				vctrl->vtable[next_sel].ctrl);  in vctrl_set_voltage_sel()
192 		vctrl->sel = next_sel;  in vctrl_set_voltage_sel()
194 		delay = DIV_ROUND_UP(vctrl->vtable[vctrl->sel].out -  in vctrl_set_voltage_sel()
195 				     vctrl->vtable[next_sel].out,  in vctrl_set_voltage_sel()
196 				     vctrl->min_slew_down_rate);  in vctrl_set_voltage_sel()
203 	if (vctrl->sel != orig_sel) {  in vctrl_set_voltage_sel()
206 					   vctrl->vtable[orig_sel].ctrl,  in vctrl_set_voltage_sel()
207 					   vctrl->vtable[orig_sel].ctrl,  in vctrl_set_voltage_sel()
209 			vctrl->sel = orig_sel;  in vctrl_set_voltage_sel()
221 	struct vctrl_data *vctrl = rdev_get_drvdata(rdev);  in vctrl_list_voltage()  local
226 	return vctrl->vtable[selector].out;  in vctrl_list_voltage()
230 			  struct vctrl_data *vctrl)  in vctrl_parse_dt()  argument
237 	vctrl->ctrl_reg = devm_regulator_get(&pdev->dev, "ctrl");  in vctrl_parse_dt()
238 	if (IS_ERR(vctrl->ctrl_reg))  in vctrl_parse_dt()
239 		return PTR_ERR(vctrl->ctrl_reg);  in vctrl_parse_dt()
243 		vctrl->ovp_threshold = pval;  in vctrl_parse_dt()
244 		if (vctrl->ovp_threshold > 100) {  in vctrl_parse_dt()
247 				vctrl->ovp_threshold);  in vctrl_parse_dt()
254 		vctrl->min_slew_down_rate = pval;  in vctrl_parse_dt()
257 		if (vctrl->min_slew_down_rate == 0) {  in vctrl_parse_dt()
261 		} else if (vctrl->min_slew_down_rate > INT_MAX) {  in vctrl_parse_dt()
263 				vctrl->min_slew_down_rate);  in vctrl_parse_dt()
268 	if (vctrl->ovp_threshold && !vctrl->min_slew_down_rate) {  in vctrl_parse_dt()
280 	vctrl->vrange.out.min_uV = pval;  in vctrl_parse_dt()
288 	vctrl->vrange.out.max_uV = pval;  in vctrl_parse_dt()
304 	vctrl->vrange.ctrl.min_uV = vrange_ctrl[0];  in vctrl_parse_dt()
305 	vctrl->vrange.ctrl.max_uV = vrange_ctrl[1];  in vctrl_parse_dt()
320 	struct vctrl_data *vctrl = platform_get_drvdata(pdev);  in vctrl_init_vtable()  local
321 	struct regulator_desc *rdesc = &vctrl->desc;  in vctrl_init_vtable()
322 	struct regulator *ctrl_reg = vctrl->ctrl_reg;  in vctrl_init_vtable()
323 	struct vctrl_voltage_range *vrange_ctrl = &vctrl->vrange.ctrl;  in vctrl_init_vtable()
346 	vctrl->vtable = devm_kcalloc(&pdev->dev, rdesc->n_voltages,  in vctrl_init_vtable()
349 	if (!vctrl->vtable)  in vctrl_init_vtable()
360 		vctrl->vtable[idx_vt].ctrl = ctrl_uV;  in vctrl_init_vtable()
361 		vctrl->vtable[idx_vt].out =  in vctrl_init_vtable()
362 			vctrl_calc_output_voltage(vctrl, ctrl_uV);  in vctrl_init_vtable()
367 	sort(vctrl->vtable, rdesc->n_voltages,  in vctrl_init_vtable()
374 		int ovp_min_uV = (vctrl->vtable[i].out *  in vctrl_init_vtable()
375 				  (100 - vctrl->ovp_threshold)) / 100;  in vctrl_init_vtable()
378 			if (vctrl->vtable[j].out >= ovp_min_uV) {  in vctrl_init_vtable()
379 				vctrl->vtable[i].ovp_min_sel = j;  in vctrl_init_vtable()
386 				vctrl->vtable[i].out);  in vctrl_init_vtable()
388 			vctrl->vtable[i].ovp_min_sel = i - 1;  in vctrl_init_vtable()
397 	struct vctrl_data *vctrl = rdev_get_drvdata(rdev);  in vctrl_enable()  local
398 	int ret = regulator_enable(vctrl->ctrl_reg);  in vctrl_enable()
401 		vctrl->enabled = true;  in vctrl_enable()
408 	struct vctrl_data *vctrl = rdev_get_drvdata(rdev);  in vctrl_disable()  local
409 	int ret = regulator_disable(vctrl->ctrl_reg);  in vctrl_disable()
412 		vctrl->enabled = false;  in vctrl_disable()
419 	struct vctrl_data *vctrl = rdev_get_drvdata(rdev);  in vctrl_is_enabled()  local
421 	return vctrl->enabled;  in vctrl_is_enabled()
445 	struct vctrl_data *vctrl;  in vctrl_probe()  local
453 	vctrl = devm_kzalloc(&pdev->dev, sizeof(struct vctrl_data),  in vctrl_probe()
455 	if (!vctrl)  in vctrl_probe()
458 	platform_set_drvdata(pdev, vctrl);  in vctrl_probe()
460 	ret = vctrl_parse_dt(pdev, vctrl);  in vctrl_probe()
464 	vrange_ctrl = &vctrl->vrange.ctrl;  in vctrl_probe()
466 	rdesc = &vctrl->desc;  in vctrl_probe()
471 	if ((regulator_get_linear_step(vctrl->ctrl_reg) == 1) ||  in vctrl_probe()
472 	    (regulator_count_voltages(vctrl->ctrl_reg) == -EINVAL)) {  in vctrl_probe()
485 	cfg.driver_data = vctrl;  in vctrl_probe()
493 		ctrl_uV = regulator_get_voltage_rdev(vctrl->ctrl_reg->rdev);  in vctrl_probe()
501 			vctrl->sel = 0;  in vctrl_probe()
503 			vctrl->sel = rdesc->n_voltages - 1;  in vctrl_probe()
508 				if (ctrl_uV == vctrl->vtable[i].ctrl) {  in vctrl_probe()
509 					vctrl->sel = i;  in vctrl_probe()
516 	vctrl->rdev = devm_regulator_register(&pdev->dev, rdesc, &cfg);  in vctrl_probe()
517 	if (IS_ERR(vctrl->rdev)) {  in vctrl_probe()
518 		ret = PTR_ERR(vctrl->rdev);  in vctrl_probe()