drivers/extcon/extcon-intel-cht-wc.c

117 static int cht_wc_extcon_get_id(struct cht_wc_extcon_data *ext, int pwrsrc_sts)
143 static int cht_wc_extcon_get_charger(struct cht_wc_extcon_data *ext,
152 		ret = regmap_read(ext->regmap, CHT_WC_USBSRC, &usbsrc);
154 			dev_err(ext->dev, "Error reading usbsrc: %d\n", ret);
169 				dev_warn(ext->dev, "Could not detect charger type\n");
171 				dev_warn(ext->dev, "Timeout detecting charger type\n");
181 		dev_warn(ext->dev,
184 		ext->usb_type = POWER_SUPPLY_USB_TYPE_SDP;
189 		ext->usb_type = POWER_SUPPLY_USB_TYPE_SDP;
192 		ext->usb_type = POWER_SUPPLY_USB_TYPE_CDP;
197 		ext->usb_type = POWER_SUPPLY_USB_TYPE_DCP;
200 		ext->usb_type = POWER_SUPPLY_USB_TYPE_ACA;
205 static void cht_wc_extcon_set_phymux(struct cht_wc_extcon_data *ext, u8 state)
209 	ret = regmap_write(ext->regmap, CHT_WC_PHYCTRL, state);
211 		dev_err(ext->dev, "Error writing phyctrl: %d\n", ret);
214 static void cht_wc_extcon_set_5v_boost(struct cht_wc_extcon_data *ext,
227 	ret = regmap_write(ext->regmap, CHT_WC_VBUS_GPIO_CTLO, val);
229 		dev_err(ext->dev, "Error writing Vbus GPIO CTLO: %d\n", ret);
232 static void cht_wc_extcon_set_otgmode(struct cht_wc_extcon_data *ext,
238 	ret = regmap_update_bits(ext->regmap, CHT_WC_CHGRCTRL1,
241 		dev_err(ext->dev, "Error updating CHGRCTRL1 reg: %d\n", ret);
243 	if (ext->vbus_boost && ext->vbus_boost_enabled != enable) {
245 			ret = regulator_enable(ext->vbus_boost);
247 			ret = regulator_disable(ext->vbus_boost);
250 			dev_err(ext->dev, "Error updating Vbus boost regulator: %d\n", ret);
252 			ext->vbus_boost_enabled = enable;
256 static void cht_wc_extcon_enable_charging(struct cht_wc_extcon_data *ext,
262 	ret = regmap_update_bits(ext->regmap, CHT_WC_CHGDISCTRL,
265 		dev_err(ext->dev, "Error updating CHGDISCTRL reg: %d\n", ret);
269 static void cht_wc_extcon_set_state(struct cht_wc_extcon_data *ext,
272 	extcon_set_state_sync(ext->edev, cable, state);
274 		extcon_set_state_sync(ext->edev, EXTCON_USB, state);
277 static void cht_wc_extcon_pwrsrc_event(struct cht_wc_extcon_data *ext)
282 	bool ignore_get_charger_errors = ext->usb_host;
285 	ext->usb_type = POWER_SUPPLY_USB_TYPE_UNKNOWN;
287 	ret = regmap_read(ext->regmap, CHT_WC_PWRSRC_STS, &pwrsrc_sts);
289 		dev_err(ext->dev, "Error reading pwrsrc status: %d\n", ret);
293 	id = cht_wc_extcon_get_id(ext, pwrsrc_sts);
295 		cht_wc_extcon_enable_charging(ext, false);
296 		cht_wc_extcon_set_otgmode(ext, true);
302 	cht_wc_extcon_set_otgmode(ext, false);
303 	cht_wc_extcon_enable_charging(ext, true);
308 		cht_wc_extcon_set_phymux(ext, MUX_SEL_PMIC);
312 	ret = cht_wc_extcon_get_charger(ext, ignore_get_charger_errors);
318 	cht_wc_extcon_set_phymux(ext, MUX_SEL_SOC);
321 	if (cable != ext->previous_cable) {
322 		cht_wc_extcon_set_state(ext, cable, true);
323 		cht_wc_extcon_set_state(ext, ext->previous_cable, false);
324 		ext->previous_cable = cable;
327 	ext->usb_host = ((id == INTEL_USB_ID_GND) || (id == INTEL_USB_RID_A));
328 	extcon_set_state_sync(ext->edev, EXTCON_USB_HOST, ext->usb_host);
330 	if (ext->usb_host)
337 	/* Note: this is a no-op when ext->role_sw is NULL */
338 	ret = usb_role_switch_set_role(ext->role_sw, role);
340 		dev_err(ext->dev, "Error setting USB-role: %d\n", ret);
342 	if (ext->psy)
343 		power_supply_changed(ext->psy);
348 	struct cht_wc_extcon_data *ext = data;
351 	ret = regmap_read(ext->regmap, CHT_WC_PWRSRC_IRQ, &irqs);
353 		dev_err(ext->dev, "Error reading irqs: %d\n", ret);
357 	cht_wc_extcon_pwrsrc_event(ext);
359 	ret = regmap_write(ext->regmap, CHT_WC_PWRSRC_IRQ, irqs);
361 		dev_err(ext->dev, "Error writing irqs: %d\n", ret);
368 static int cht_wc_extcon_sw_control(struct cht_wc_extcon_data *ext, bool enable)
373 	ret = regmap_update_bits(ext->regmap, CHT_WC_CHGDISCTRL,
376 		dev_err(ext->dev,
382 	ret = regmap_update_bits(ext->regmap, CHT_WC_CHGRCTRL0, mask, val);
384 		dev_err(ext->dev, "Error setting sw control: %d\n", ret);
389 static int cht_wc_extcon_find_role_sw(struct cht_wc_extcon_data *ext)
399 	ext->role_sw = usb_role_switch_find_by_fwnode(fwnode);
402 	return ext->role_sw ? 0 : -EPROBE_DEFER;
407 	struct cht_wc_extcon_data *ext = data;
409 	usb_role_switch_put(ext->role_sw);
413 static int cht_wc_extcon_get_role_sw_and_regulator(struct cht_wc_extcon_data *ext)
417 	ret = cht_wc_extcon_find_role_sw(ext);
421 	ret = devm_add_action_or_reset(ext->dev, cht_wc_extcon_put_role_sw, ext);
432 	ext->vbus_boost = devm_regulator_get_optional(ext->dev, "vbus");
433 	if (IS_ERR(ext->vbus_boost)) {
434 		ret = PTR_ERR(ext->vbus_boost);
438 		return dev_err_probe(ext->dev, ret, "getting Vbus regulator");
448 	struct cht_wc_extcon_data *ext = power_supply_get_drvdata(psy);
452 		val->intval = ext->usb_type;
455 		val->intval = ext->usb_type ? 1 : 0;
487 static int cht_wc_extcon_register_psy(struct cht_wc_extcon_data *ext)
489 	struct power_supply_config psy_cfg = { .drv_data = ext };
491 	ext->psy = devm_power_supply_register(ext->dev,
494 	return PTR_ERR_OR_ZERO(ext->psy);
500 	struct cht_wc_extcon_data *ext;
509 	ext = devm_kzalloc(&pdev->dev, sizeof(*ext), GFP_KERNEL);
510 	if (!ext)
513 	ext->dev = &pdev->dev;
514 	ext->regmap = pmic->regmap;
515 	ext->previous_cable = EXTCON_NONE;
518 	ext->edev = devm_extcon_dev_allocate(ext->dev, cht_wc_extcon_cables);
519 	if (IS_ERR(ext->edev))
520 		return PTR_ERR(ext->edev);
537 		cht_wc_extcon_set_5v_boost(ext, false);
542 		ret = cht_wc_extcon_get_role_sw_and_regulator(ext);
552 		ret = cht_wc_extcon_register_psy(ext);
557 		ret = cht_wc_extcon_get_role_sw_and_regulator(ext);
566 	ret = cht_wc_extcon_sw_control(ext, true);
571 	cht_wc_extcon_enable_charging(ext, false);
574 	ret = devm_extcon_dev_register(ext->dev, ext->edev);
576 		dev_err(ext->dev, "Error registering extcon device: %d\n", ret);
580 	ret = regmap_read(ext->regmap, CHT_WC_PWRSRC_STS, &pwrsrc_sts);
582 		dev_err(ext->dev, "Error reading pwrsrc status: %d\n", ret);
590 	id = cht_wc_extcon_get_id(ext, pwrsrc_sts);
592 		cht_wc_extcon_set_phymux(ext, MUX_SEL_PMIC);
595 	cht_wc_extcon_pwrsrc_event(ext);
597 	ret = devm_request_threaded_irq(ext->dev, irq, NULL, cht_wc_extcon_isr,
598 					IRQF_ONESHOT, pdev->name, ext);
600 		dev_err(ext->dev, "Error requesting interrupt: %d\n", ret);
605 	ret = regmap_write(ext->regmap, CHT_WC_PWRSRC_IRQ_MASK, mask);
607 		dev_err(ext->dev, "Error writing irq-mask: %d\n", ret);
611 	platform_set_drvdata(pdev, ext);
616 	cht_wc_extcon_sw_control(ext, false);
622 	struct cht_wc_extcon_data *ext = platform_get_drvdata(pdev);
624 	cht_wc_extcon_sw_control(ext, false);