// SPDX-License-Identifier: GPL-2.0-only/* * drivers/extcon/extcon.c - External Connector (extcon) framework. * * Copyright (C) 2015 Samsung Electronics * Author: Chanwoo Choi <cw00.choi@samsung.com> * * Copyright (C) 2012 Samsung Electronics * Author: Donggeun Kim <dg77.kim@samsung.com> * Author: MyungJoo Ham <myungjoo.ham@samsung.com> * * based on android/drivers/switch/switch_class.c * Copyright (C) 2008 Google, Inc. * Author: Mike Lockwood <lockwood@android.com> */ #include <linux/module.h>#include <linux/types.h>#include <linux/init.h>#include <linux/device.h>#include <linux/fs.h>#include <linux/err.h>#include <linux/of.h>#include <linux/slab.h>#include <linux/sysfs.h> #include "extcon.h" #define SUPPORTED_CABLE_MAX	32 static const struct __extcon_info {	unsigned int type;	unsigned int id;	const char *name; } extcon_info[] = {	[EXTCON_NONE] = {		.type = EXTCON_TYPE_MISC,		.id = EXTCON_NONE,		.name = "NONE",	}, 	/* USB external connector */	[EXTCON_USB] = {		.type = EXTCON_TYPE_USB,		.id = EXTCON_USB,		.name = "USB",	},	[EXTCON_USB_HOST] = {		.type = EXTCON_TYPE_USB,		.id = EXTCON_USB_HOST,		.name = "USB-HOST",	}, 	/* Charging external connector */	[EXTCON_CHG_USB_SDP] = {		.type = EXTCON_TYPE_CHG | EXTCON_TYPE_USB,		.id = EXTCON_CHG_USB_SDP,		.name = "SDP",	},	[EXTCON_CHG_USB_DCP] = {		.type = EXTCON_TYPE_CHG | EXTCON_TYPE_USB,		.id = EXTCON_CHG_USB_DCP,		.name = "DCP",	},	[EXTCON_CHG_USB_CDP] = {		.type = EXTCON_TYPE_CHG | EXTCON_TYPE_USB,		.id = EXTCON_CHG_USB_CDP,		.name = "CDP",	},	[EXTCON_CHG_USB_ACA] = {		.type = EXTCON_TYPE_CHG | EXTCON_TYPE_USB,		.id = EXTCON_CHG_USB_ACA,		.name = "ACA",	},	[EXTCON_CHG_USB_FAST] = {		.type = EXTCON_TYPE_CHG | EXTCON_TYPE_USB,		.id = EXTCON_CHG_USB_FAST,		.name = "FAST-CHARGER",	},	[EXTCON_CHG_USB_SLOW] = {		.type = EXTCON_TYPE_CHG | EXTCON_TYPE_USB,		.id = EXTCON_CHG_USB_SLOW,		.name = "SLOW-CHARGER",	},	[EXTCON_CHG_WPT] = {		.type = EXTCON_TYPE_CHG,		.id = EXTCON_CHG_WPT,		.name = "WPT",	},	[EXTCON_CHG_USB_PD] = {		.type = EXTCON_TYPE_CHG | EXTCON_TYPE_USB,		.id = EXTCON_CHG_USB_PD,		.name = "PD",	}, 	/* Jack external connector */	[EXTCON_JACK_MICROPHONE] = {		.type = EXTCON_TYPE_JACK,		.id = EXTCON_JACK_MICROPHONE,		.name = "MICROPHONE",	},	[EXTCON_JACK_HEADPHONE] = {		.type = EXTCON_TYPE_JACK,		.id = EXTCON_JACK_HEADPHONE,		.name = "HEADPHONE",	},	[EXTCON_JACK_LINE_IN] = {		.type = EXTCON_TYPE_JACK,		.id = EXTCON_JACK_LINE_IN,		.name = "LINE-IN",	},	[EXTCON_JACK_LINE_OUT] = {		.type = EXTCON_TYPE_JACK,		.id = EXTCON_JACK_LINE_OUT,		.name = "LINE-OUT",	},	[EXTCON_JACK_VIDEO_IN] = {		.type = EXTCON_TYPE_JACK,		.id = EXTCON_JACK_VIDEO_IN,		.name = "VIDEO-IN",	},	[EXTCON_JACK_VIDEO_OUT] = {		.type = EXTCON_TYPE_JACK,		.id = EXTCON_JACK_VIDEO_OUT,		.name = "VIDEO-OUT",	},	[EXTCON_JACK_SPDIF_IN] = {		.type = EXTCON_TYPE_JACK,		.id = EXTCON_JACK_SPDIF_IN,		.name = "SPDIF-IN",	},	[EXTCON_JACK_SPDIF_OUT] = {		.type = EXTCON_TYPE_JACK,		.id = EXTCON_JACK_SPDIF_OUT,		.name = "SPDIF-OUT",	}, 	/* Display external connector */	[EXTCON_DISP_HDMI] = {		.type = EXTCON_TYPE_DISP,		.id = EXTCON_DISP_HDMI,		.name = "HDMI",	},	[EXTCON_DISP_MHL] = {		.type = EXTCON_TYPE_DISP,		.id = EXTCON_DISP_MHL,		.name = "MHL",	},	[EXTCON_DISP_DVI] = {		.type = EXTCON_TYPE_DISP,		.id = EXTCON_DISP_DVI,		.name = "DVI",	},	[EXTCON_DISP_VGA] = {		.type = EXTCON_TYPE_DISP,		.id = EXTCON_DISP_VGA,		.name = "VGA",	},	[EXTCON_DISP_DP] = {		.type = EXTCON_TYPE_DISP | EXTCON_TYPE_USB,		.id = EXTCON_DISP_DP,		.name = "DP",	},	[EXTCON_DISP_HMD] = {		.type = EXTCON_TYPE_DISP | EXTCON_TYPE_USB,		.id = EXTCON_DISP_HMD,		.name = "HMD",	}, 	/* Miscellaneous external connector */	[EXTCON_DOCK] = {		.type = EXTCON_TYPE_MISC,		.id = EXTCON_DOCK,		.name = "DOCK",	},	[EXTCON_JIG] = {		.type = EXTCON_TYPE_MISC,		.id = EXTCON_JIG,		.name = "JIG",	},	[EXTCON_MECHANICAL] = {		.type = EXTCON_TYPE_MISC,		.id = EXTCON_MECHANICAL,		.name = "MECHANICAL",	}, 	{ /* sentinel */ }}; /** * struct extcon_cable - An internal data for an external connector. * @edev:		the extcon device * @cable_index:	the index of this cable in the edev * @attr_g:		the attribute group for the cable * @attr_name:		"name" sysfs entry * @attr_state:		"state" sysfs entry * @attrs:		the array pointing to attr_name and attr_state for attr_g */struct extcon_cable {	struct extcon_dev *edev;	int cable_index; 	struct attribute_group attr_g;	struct device_attribute attr_name;	struct device_attribute attr_state; 	struct attribute *attrs[3]; /* to be fed to attr_g.attrs */ 	union extcon_property_value usb_propval[EXTCON_PROP_USB_CNT];	union extcon_property_value chg_propval[EXTCON_PROP_CHG_CNT];	union extcon_property_value jack_propval[EXTCON_PROP_JACK_CNT];	union extcon_property_value disp_propval[EXTCON_PROP_DISP_CNT]; 	unsigned long usb_bits[BITS_TO_LONGS(EXTCON_PROP_USB_CNT)];	unsigned long chg_bits[BITS_TO_LONGS(EXTCON_PROP_CHG_CNT)];	unsigned long jack_bits[BITS_TO_LONGS(EXTCON_PROP_JACK_CNT)];	unsigned long disp_bits[BITS_TO_LONGS(EXTCON_PROP_DISP_CNT)];}; static struct class *extcon_class; static LIST_HEAD(extcon_dev_list);static DEFINE_MUTEX(extcon_dev_list_lock); static int check_mutually_exclusive(struct extcon_dev *edev, u32 new_state){	int i = 0; 	if (!edev->mutually_exclusive)		return 0; 	for (i = 0; edev->mutually_exclusive[i]; i++) {		int weight;		u32 correspondants = new_state & edev->mutually_exclusive[i]; 		/* calculate the total number of bits set */		weight = hweight32(correspondants);		if (weight > 1)			return i + 1;	} 	return 0;} static int find_cable_index_by_id(struct extcon_dev *edev, const unsigned int id){	int i; 	/* Find the the index of extcon cable in edev->supported_cable */	for (i = 0; i < edev->max_supported; i++) {		if (edev->supported_cable[i] == id)			return i;	} 	return -EINVAL;} static int get_extcon_type(unsigned int prop){	switch (prop) {	case EXTCON_PROP_USB_MIN ... EXTCON_PROP_USB_MAX:		return EXTCON_TYPE_USB;	case EXTCON_PROP_CHG_MIN ... EXTCON_PROP_CHG_MAX:		return EXTCON_TYPE_CHG;	case EXTCON_PROP_JACK_MIN ... EXTCON_PROP_JACK_MAX:		return EXTCON_TYPE_JACK;	case EXTCON_PROP_DISP_MIN ... EXTCON_PROP_DISP_MAX:		return EXTCON_TYPE_DISP;	default:		return -EINVAL;	}} static bool is_extcon_attached(struct extcon_dev *edev, unsigned int index){	return !!(edev->state & BIT(index));} static bool is_extcon_changed(struct extcon_dev *edev, int index,				bool new_state){	int state = !!(edev->state & BIT(index));	return (state != new_state);} static bool is_extcon_property_supported(unsigned int id, unsigned int prop){	int type; 	/* Check whether the property is supported or not. */	type = get_extcon_type(prop);	if (type < 0)		return false; 	/* Check whether a specific extcon id supports the property or not. */	return !!(extcon_info[id].type & type);} static int is_extcon_property_capability(struct extcon_dev *edev,				unsigned int id, int index,unsigned int prop){	struct extcon_cable *cable;	int type, ret; 	/* Check whether the property is supported or not. */	type = get_extcon_type(prop);	if (type < 0)		return type; 	cable = &edev->cables[index]; 	switch (type) {	case EXTCON_TYPE_USB:		ret = test_bit(prop - EXTCON_PROP_USB_MIN, cable->usb_bits);		break;	case EXTCON_TYPE_CHG:		ret = test_bit(prop - EXTCON_PROP_CHG_MIN, cable->chg_bits);		break;	case EXTCON_TYPE_JACK:		ret = test_bit(prop - EXTCON_PROP_JACK_MIN, cable->jack_bits);		break;	case EXTCON_TYPE_DISP:		ret = test_bit(prop - EXTCON_PROP_DISP_MIN, cable->disp_bits);		break;	default:		ret = -EINVAL;	} 	return ret;} static void init_property(struct extcon_dev *edev, unsigned int id, int index){	unsigned int type = extcon_info[id].type;	struct extcon_cable *cable = &edev->cables[index]; 	if (EXTCON_TYPE_USB & type)		memset(cable->usb_propval, 0, sizeof(cable->usb_propval));	if (EXTCON_TYPE_CHG & type)		memset(cable->chg_propval, 0, sizeof(cable->chg_propval));	if (EXTCON_TYPE_JACK & type)		memset(cable->jack_propval, 0, sizeof(cable->jack_propval));	if (EXTCON_TYPE_DISP & type)		memset(cable->disp_propval, 0, sizeof(cable->disp_propval));} static ssize_t state_show(struct device *dev, struct device_attribute *attr,			  char *buf){	int i, count = 0;	struct extcon_dev *edev = dev_get_drvdata(dev); 	if (edev->max_supported == 0)		return sprintf(buf, "%u\n", edev->state); 	for (i = 0; i < edev->max_supported; i++) {		count += sprintf(buf + count, "%s=%d\n",				extcon_info[edev->supported_cable[i]].name,				 !!(edev->state & BIT(i)));	} 	return count;}static DEVICE_ATTR_RO(state); static ssize_t name_show(struct device *dev, struct device_attribute *attr,		char *buf){	struct extcon_dev *edev = dev_get_drvdata(dev); 	return sprintf(buf, "%s\n", edev->name);}static DEVICE_ATTR_RO(name); static ssize_t cable_name_show(struct device *dev,			       struct device_attribute *attr, char *buf){	struct extcon_cable *cable = container_of(attr, struct extcon_cable,						  attr_name);	int i = cable->cable_index; 	return sprintf(buf, "%s\n",			extcon_info[cable->edev->supported_cable[i]].name);} static ssize_t cable_state_show(struct device *dev,				struct device_attribute *attr, char *buf){	struct extcon_cable *cable = container_of(attr, struct extcon_cable,						  attr_state); 	int i = cable->cable_index; 	return sprintf(buf, "%d\n",		extcon_get_state(cable->edev, cable->edev->supported_cable[i]));} /** * extcon_sync() - Synchronize the state for an external connector. * @edev:	the extcon device * * Note that this function send a notification in order to synchronize * the state and property of an external connector. * * Returns 0 if success or error number if fail. */int extcon_sync(struct extcon_dev *edev, unsigned int id){	char name_buf[120];	char state_buf[120];	char *prop_buf;	char *envp[3];	int env_offset = 0;	int length;	int index;	int state;	unsigned long flags; 	if (!edev)		return -EINVAL; 	index = find_cable_index_by_id(edev, id);	if (index < 0)		return index; 	spin_lock_irqsave(&edev->lock, flags);	state = !!(edev->state & BIT(index));	spin_unlock_irqrestore(&edev->lock, flags); 	/*	 * Call functions in a raw notifier chain for the specific one	 * external connector.	 */	raw_notifier_call_chain(&edev->nh[index], state, edev); 	/*	 * Call functions in a raw notifier chain for the all supported	 * external connectors.	 */	raw_notifier_call_chain(&edev->nh_all, state, edev); 	spin_lock_irqsave(&edev->lock, flags);	/* This could be in interrupt handler */	prop_buf = (char *)get_zeroed_page(GFP_ATOMIC);	if (!prop_buf) {		/* Unlock early before uevent */		spin_unlock_irqrestore(&edev->lock, flags); 		dev_err(&edev->dev, "out of memory in extcon_set_state\n");		kobject_uevent(&edev->dev.kobj, KOBJ_CHANGE); 		return -ENOMEM;	} 	length = name_show(&edev->dev, NULL, prop_buf);	if (length > 0) {		if (prop_buf[length - 1] == '\n')			prop_buf[length - 1] = 0;		snprintf(name_buf, sizeof(name_buf), "NAME=%s", prop_buf);		envp[env_offset++] = name_buf;	} 	length = state_show(&edev->dev, NULL, prop_buf);	if (length > 0) {		if (prop_buf[length - 1] == '\n')			prop_buf[length - 1] = 0;		snprintf(state_buf, sizeof(state_buf), "STATE=%s", prop_buf);		envp[env_offset++] = state_buf;	}	envp[env_offset] = NULL; 	/* Unlock early before uevent */	spin_unlock_irqrestore(&edev->lock, flags);	kobject_uevent_env(&edev->dev.kobj, KOBJ_CHANGE, envp);	free_page((unsigned long)prop_buf); 	return 0;}EXPORT_SYMBOL_GPL(extcon_sync); /** * extcon_get_state() - Get the state of an external connector. * @edev:	the extcon device * @id:		the unique id indicating an external connector * * Returns 0 if success or error number if fail. */int extcon_get_state(struct extcon_dev *edev, const unsigned int id){	int index, state;	unsigned long flags; 	if (!edev)		return -EINVAL; 	index = find_cable_index_by_id(edev, id);	if (index < 0)		return index; 

Lines 1–500 of 1427. Load more