power: supply: charger-manager: Update extcon functions
In commit830ae44220("extcon: Remove the deprecated extcon functions") the function extcon_register_interest became a no-op returning an error, leading to non-functional behaviour in charger-manager. Additionally, a translation table is needed between the text representation of the extcon cable names and their IDs is needed. In order to retain DT compatibility, TA and CHARGE-DOWNSTREAM are added as they were present up until commit11eecf910b("extcon: Modify the id and name of external connector") Signed-off-by: Jonathan Bakker <xc-racer2@live.ca> Signed-off-by: Sebastian Reichel <sebastian.reichel@collabora.com>
This commit is contained in:
		
							parent
							
								
									9434e4530d
								
							
						
					
					
						commit
						c1f73028f7
					
				| @ -26,6 +26,29 @@ | ||||
| #include <linux/of.h> | ||||
| #include <linux/thermal.h> | ||||
| 
 | ||||
| static struct { | ||||
| 	const char *name; | ||||
| 	u64 extcon_type; | ||||
| } extcon_mapping[] = { | ||||
| 	/* Current textual representations */ | ||||
| 	{ "USB", EXTCON_USB }, | ||||
| 	{ "USB-HOST", EXTCON_USB_HOST }, | ||||
| 	{ "SDP", EXTCON_CHG_USB_SDP }, | ||||
| 	{ "DCP", EXTCON_CHG_USB_DCP }, | ||||
| 	{ "CDP", EXTCON_CHG_USB_CDP }, | ||||
| 	{ "ACA", EXTCON_CHG_USB_ACA }, | ||||
| 	{ "FAST-CHARGER", EXTCON_CHG_USB_FAST }, | ||||
| 	{ "SLOW-CHARGER", EXTCON_CHG_USB_SLOW }, | ||||
| 	{ "WPT", EXTCON_CHG_WPT }, | ||||
| 	{ "PD", EXTCON_CHG_USB_PD }, | ||||
| 	{ "DOCK", EXTCON_DOCK }, | ||||
| 	{ "JIG", EXTCON_JIG }, | ||||
| 	{ "MECHANICAL", EXTCON_MECHANICAL }, | ||||
| 	/* Deprecated textual representations */ | ||||
| 	{ "TA", EXTCON_CHG_USB_SDP }, | ||||
| 	{ "CHARGE-DOWNSTREAM", EXTCON_CHG_USB_CDP }, | ||||
| }; | ||||
| 
 | ||||
| /*
 | ||||
|  * Default temperature threshold for charging. | ||||
|  * Every temperature units are in tenth of centigrade. | ||||
| @ -950,7 +973,8 @@ static int charger_extcon_notifier(struct notifier_block *self, | ||||
| static int charger_extcon_init(struct charger_manager *cm, | ||||
| 		struct charger_cable *cable) | ||||
| { | ||||
| 	int ret; | ||||
| 	int ret, i; | ||||
| 	u64 extcon_type = EXTCON_NONE; | ||||
| 
 | ||||
| 	/*
 | ||||
| 	 * Charger manager use Extcon framework to identify | ||||
| @ -959,14 +983,39 @@ static int charger_extcon_init(struct charger_manager *cm, | ||||
| 	 */ | ||||
| 	INIT_WORK(&cable->wq, charger_extcon_work); | ||||
| 	cable->nb.notifier_call = charger_extcon_notifier; | ||||
| 	ret = extcon_register_interest(&cable->extcon_dev, | ||||
| 			cable->extcon_name, cable->name, &cable->nb); | ||||
| 	if (ret < 0) { | ||||
| 		pr_info("Cannot register extcon_dev for %s(cable: %s)\n", | ||||
| 
 | ||||
| 	cable->extcon_dev = extcon_get_extcon_dev(cable->extcon_name); | ||||
| 	if (IS_ERR_OR_NULL(cable->extcon_dev)) { | ||||
| 		pr_err("Cannot find extcon_dev for %s (cable: %s)\n", | ||||
| 			cable->extcon_name, cable->name); | ||||
| 		if (cable->extcon_dev == NULL) | ||||
| 			return -EPROBE_DEFER; | ||||
| 		else | ||||
| 			return PTR_ERR(cable->extcon_dev); | ||||
| 	} | ||||
| 
 | ||||
| 	return ret; | ||||
| 	for (i = 0; i < ARRAY_SIZE(extcon_mapping); i++) { | ||||
| 		if (!strcmp(cable->name, extcon_mapping[i].name)) { | ||||
| 			extcon_type = extcon_mapping[i].extcon_type; | ||||
| 			break; | ||||
| 		} | ||||
| 	} | ||||
| 	if (extcon_type == EXTCON_NONE) { | ||||
| 		pr_err("Cannot find cable for type %s", cable->name); | ||||
| 		return -EINVAL; | ||||
| 	} | ||||
| 
 | ||||
| 	cable->extcon_type = extcon_type; | ||||
| 
 | ||||
| 	ret = devm_extcon_register_notifier(cm->dev, cable->extcon_dev, | ||||
| 		cable->extcon_type, &cable->nb); | ||||
| 	if (ret < 0) { | ||||
| 		pr_err("Cannot register extcon_dev for %s (cable: %s)\n", | ||||
| 			cable->extcon_name, cable->name); | ||||
| 		return ret; | ||||
| 	} | ||||
| 
 | ||||
| 	return 0; | ||||
| } | ||||
| 
 | ||||
| /**
 | ||||
| @ -983,6 +1032,7 @@ static int charger_manager_register_extcon(struct charger_manager *cm) | ||||
| { | ||||
| 	struct charger_desc *desc = cm->desc; | ||||
| 	struct charger_regulator *charger; | ||||
| 	unsigned long event; | ||||
| 	int ret; | ||||
| 	int i; | ||||
| 	int j; | ||||
| @ -1010,6 +1060,11 @@ static int charger_manager_register_extcon(struct charger_manager *cm) | ||||
| 			} | ||||
| 			cable->charger = charger; | ||||
| 			cable->cm = cm; | ||||
| 
 | ||||
| 			event = extcon_get_state(cable->extcon_dev, | ||||
| 				cable->extcon_type); | ||||
| 			charger_extcon_notifier(&cable->nb, | ||||
| 				event, NULL); | ||||
| 		} | ||||
| 	} | ||||
| 
 | ||||
| @ -1370,7 +1425,6 @@ static int charger_manager_probe(struct platform_device *pdev) | ||||
| 	struct charger_desc *desc = cm_get_drv_data(pdev); | ||||
| 	struct charger_manager *cm; | ||||
| 	int ret, i = 0; | ||||
| 	int j = 0; | ||||
| 	union power_supply_propval val; | ||||
| 	struct power_supply *fuel_gauge; | ||||
| 	enum power_supply_property *properties; | ||||
| @ -1572,12 +1626,6 @@ err_reg_extcon: | ||||
| 		struct charger_regulator *charger; | ||||
| 
 | ||||
| 		charger = &desc->charger_regulators[i]; | ||||
| 		for (j = 0; j < charger->num_cables; j++) { | ||||
| 			struct charger_cable *cable = &charger->cables[j]; | ||||
| 			/* Remove notifier block if only edev exists */ | ||||
| 			if (cable->extcon_dev.edev) | ||||
| 				extcon_unregister_interest(&cable->extcon_dev); | ||||
| 		} | ||||
| 
 | ||||
| 		regulator_put(desc->charger_regulators[i].consumer); | ||||
| 	} | ||||
| @ -1592,7 +1640,6 @@ static int charger_manager_remove(struct platform_device *pdev) | ||||
| 	struct charger_manager *cm = platform_get_drvdata(pdev); | ||||
| 	struct charger_desc *desc = cm->desc; | ||||
| 	int i = 0; | ||||
| 	int j = 0; | ||||
| 
 | ||||
| 	/* Remove from the list */ | ||||
| 	mutex_lock(&cm_list_mtx); | ||||
| @ -1602,15 +1649,6 @@ static int charger_manager_remove(struct platform_device *pdev) | ||||
| 	cancel_work_sync(&setup_polling); | ||||
| 	cancel_delayed_work_sync(&cm_monitor_work); | ||||
| 
 | ||||
| 	for (i = 0 ; i < desc->num_charger_regulators ; i++) { | ||||
| 		struct charger_regulator *charger | ||||
| 				= &desc->charger_regulators[i]; | ||||
| 		for (j = 0 ; j < charger->num_cables ; j++) { | ||||
| 			struct charger_cable *cable = &charger->cables[j]; | ||||
| 			extcon_unregister_interest(&cable->extcon_dev); | ||||
| 		} | ||||
| 	} | ||||
| 
 | ||||
| 	for (i = 0 ; i < desc->num_charger_regulators ; i++) | ||||
| 		regulator_put(desc->charger_regulators[i].consumer); | ||||
| 
 | ||||
|  | ||||
| @ -40,7 +40,7 @@ enum cm_batt_temp { | ||||
| /**
 | ||||
|  * struct charger_cable | ||||
|  * @extcon_name: the name of extcon device. | ||||
|  * @name: the name of charger cable(external connector). | ||||
|  * @name: the name of the cable connector | ||||
|  * @extcon_dev: the extcon device. | ||||
|  * @wq: the workqueue to control charger according to the state of | ||||
|  *	charger cable. If charger cable is attached, enable charger. | ||||
| @ -56,9 +56,10 @@ enum cm_batt_temp { | ||||
| struct charger_cable { | ||||
| 	const char *extcon_name; | ||||
| 	const char *name; | ||||
| 	struct extcon_dev *extcon_dev; | ||||
| 	u64 extcon_type; | ||||
| 
 | ||||
| 	/* The charger-manager use Extcon framework */ | ||||
| 	struct extcon_specific_cable_nb extcon_dev; | ||||
| 	struct work_struct wq; | ||||
| 	struct notifier_block nb; | ||||
| 
 | ||||
|  | ||||
		Loading…
	
		Reference in New Issue
	
	Block a user