568 lines · 13.3 KB · C
RawDownload
/* * phy.c -- USB phy handling * * Copyright (C) 2004-2013 Texas Instruments * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. */#include <linux/kernel.h>#include <linux/export.h>#include <linux/err.h>#include <linux/device.h>#include <linux/module.h>#include <linux/slab.h>#include <linux/of.h> #include <linux/usb/phy.h> static LIST_HEAD(phy_list);static LIST_HEAD(phy_bind_list);static DEFINE_SPINLOCK(phy_lock); struct phy_devm {	struct usb_phy *phy;	struct notifier_block *nb;}; static struct usb_phy *__usb_find_phy(struct list_head *list,	enum usb_phy_type type){	struct usb_phy  *phy = NULL; 	list_for_each_entry(phy, list, head) {		if (phy->type != type)			continue; 		return phy;	} 	return ERR_PTR(-ENODEV);} static struct usb_phy *__usb_find_phy_dev(struct device *dev,	struct list_head *list, u8 index){	struct usb_phy_bind *phy_bind = NULL; 	list_for_each_entry(phy_bind, list, list) {		if (!(strcmp(phy_bind->dev_name, dev_name(dev))) &&				phy_bind->index == index) {			if (phy_bind->phy)				return phy_bind->phy;			else				return ERR_PTR(-EPROBE_DEFER);		}	} 	return ERR_PTR(-ENODEV);} static struct usb_phy *__of_usb_find_phy(struct device_node *node){	struct usb_phy  *phy; 	if (!of_device_is_available(node))		return ERR_PTR(-ENODEV); 	list_for_each_entry(phy, &phy_list, head) {		if (node != phy->dev->of_node)			continue; 		return phy;	} 	return ERR_PTR(-EPROBE_DEFER);} static void devm_usb_phy_release(struct device *dev, void *res){	struct usb_phy *phy = *(struct usb_phy **)res; 	usb_put_phy(phy);} static void devm_usb_phy_release2(struct device *dev, void *_res){	struct phy_devm *res = _res; 	if (res->nb)		usb_unregister_notifier(res->phy, res->nb);	usb_put_phy(res->phy);} static int devm_usb_phy_match(struct device *dev, void *res, void *match_data){	struct usb_phy **phy = res; 	return *phy == match_data;} static int usb_add_extcon(struct usb_phy *x){	int ret; 	if (of_property_read_bool(x->dev->of_node, "extcon")) {		x->edev = extcon_get_edev_by_phandle(x->dev, 0);		if (IS_ERR(x->edev))			return PTR_ERR(x->edev); 		x->id_edev = extcon_get_edev_by_phandle(x->dev, 1);		if (IS_ERR(x->id_edev)) {			x->id_edev = NULL;			dev_info(x->dev, "No separate ID extcon device\n");		} 		if (x->vbus_nb.notifier_call) {			ret = devm_extcon_register_notifier(x->dev, x->edev,							    EXTCON_USB,							    &x->vbus_nb);			if (ret < 0) {				dev_err(x->dev,					"register VBUS notifier failed\n");				return ret;			}		} 		if (x->id_nb.notifier_call) {			struct extcon_dev *id_ext; 			if (x->id_edev)				id_ext = x->id_edev;			else				id_ext = x->edev; 			ret = devm_extcon_register_notifier(x->dev, id_ext,							    EXTCON_USB_HOST,							    &x->id_nb);			if (ret < 0) {				dev_err(x->dev,					"register ID notifier failed\n");				return ret;			}		}	} 	return 0;} /** * devm_usb_get_phy - find the USB PHY * @dev - device that requests this phy * @type - the type of the phy the controller requires * * Gets the phy using usb_get_phy(), and associates a device with it using * devres. On driver detach, release function is invoked on the devres data, * then, devres data is freed. * * For use by USB host and peripheral drivers. */struct usb_phy *devm_usb_get_phy(struct device *dev, enum usb_phy_type type){	struct usb_phy **ptr, *phy; 	ptr = devres_alloc(devm_usb_phy_release, sizeof(*ptr), GFP_KERNEL);	if (!ptr)		return ERR_PTR(-ENOMEM); 	phy = usb_get_phy(type);	if (!IS_ERR(phy)) {		*ptr = phy;		devres_add(dev, ptr);	} else		devres_free(ptr); 	return phy;}EXPORT_SYMBOL_GPL(devm_usb_get_phy); /** * usb_get_phy - find the USB PHY * @type - the type of the phy the controller requires * * Returns the phy driver, after getting a refcount to it; or * -ENODEV if there is no such phy.  The caller is responsible for * calling usb_put_phy() to release that count. * * For use by USB host and peripheral drivers. */struct usb_phy *usb_get_phy(enum usb_phy_type type){	struct usb_phy	*phy = NULL;	unsigned long	flags; 	spin_lock_irqsave(&phy_lock, flags); 	phy = __usb_find_phy(&phy_list, type);	if (IS_ERR(phy) || !try_module_get(phy->dev->driver->owner)) {		pr_debug("PHY: unable to find transceiver of type %s\n",			usb_phy_type_string(type));		if (!IS_ERR(phy))			phy = ERR_PTR(-ENODEV); 		goto err0;	} 	get_device(phy->dev); err0:	spin_unlock_irqrestore(&phy_lock, flags); 	return phy;}EXPORT_SYMBOL_GPL(usb_get_phy); /** * devm_usb_get_phy_by_node - find the USB PHY by device_node * @dev - device that requests this phy * @node - the device_node for the phy device. * @nb - a notifier_block to register with the phy. * * Returns the phy driver associated with the given device_node, * after getting a refcount to it, -ENODEV if there is no such phy or * -EPROBE_DEFER if the device is not yet loaded. While at that, it * also associates the device with * the phy using devres. On driver detach, release function is invoked * on the devres data, then, devres data is freed. * * For use by peripheral drivers for devices related to a phy, * such as a charger. */struct  usb_phy *devm_usb_get_phy_by_node(struct device *dev,					  struct device_node *node,					  struct notifier_block *nb){	struct usb_phy	*phy = ERR_PTR(-ENOMEM);	struct phy_devm	*ptr;	unsigned long	flags; 	ptr = devres_alloc(devm_usb_phy_release2, sizeof(*ptr), GFP_KERNEL);	if (!ptr) {		dev_dbg(dev, "failed to allocate memory for devres\n");		goto err0;	} 	spin_lock_irqsave(&phy_lock, flags); 	phy = __of_usb_find_phy(node);	if (IS_ERR(phy)) {		devres_free(ptr);		goto err1;	} 	if (!try_module_get(phy->dev->driver->owner)) {		phy = ERR_PTR(-ENODEV);		devres_free(ptr);		goto err1;	}	if (nb)		usb_register_notifier(phy, nb);	ptr->phy = phy;	ptr->nb = nb;	devres_add(dev, ptr); 	get_device(phy->dev); err1:	spin_unlock_irqrestore(&phy_lock, flags); err0: 	return phy;}EXPORT_SYMBOL_GPL(devm_usb_get_phy_by_node); /** * devm_usb_get_phy_by_phandle - find the USB PHY by phandle * @dev - device that requests this phy * @phandle - name of the property holding the phy phandle value * @index - the index of the phy * * Returns the phy driver associated with the given phandle value, * after getting a refcount to it, -ENODEV if there is no such phy or * -EPROBE_DEFER if there is a phandle to the phy, but the device is * not yet loaded. While at that, it also associates the device with * the phy using devres. On driver detach, release function is invoked * on the devres data, then, devres data is freed. * * For use by USB host and peripheral drivers. */struct usb_phy *devm_usb_get_phy_by_phandle(struct device *dev,	const char *phandle, u8 index){	struct device_node *node;	struct usb_phy	*phy; 	if (!dev->of_node) {		dev_dbg(dev, "device does not have a device node entry\n");		return ERR_PTR(-EINVAL);	} 	node = of_parse_phandle(dev->of_node, phandle, index);	if (!node) {		dev_dbg(dev, "failed to get %s phandle in %s node\n", phandle,			dev->of_node->full_name);		return ERR_PTR(-ENODEV);	}	phy = devm_usb_get_phy_by_node(dev, node, NULL);	of_node_put(node);	return phy;}EXPORT_SYMBOL_GPL(devm_usb_get_phy_by_phandle); /** * usb_get_phy_dev - find the USB PHY * @dev - device that requests this phy * @index - the index of the phy * * Returns the phy driver, after getting a refcount to it; or * -ENODEV if there is no such phy.  The caller is responsible for * calling usb_put_phy() to release that count. * * For use by USB host and peripheral drivers. */struct usb_phy *usb_get_phy_dev(struct device *dev, u8 index){	struct usb_phy	*phy = NULL;	unsigned long	flags; 	spin_lock_irqsave(&phy_lock, flags); 	phy = __usb_find_phy_dev(dev, &phy_bind_list, index);	if (IS_ERR(phy) || !try_module_get(phy->dev->driver->owner)) {		dev_dbg(dev, "unable to find transceiver\n");		if (!IS_ERR(phy))			phy = ERR_PTR(-ENODEV); 		goto err0;	} 	get_device(phy->dev); err0:	spin_unlock_irqrestore(&phy_lock, flags); 	return phy;}EXPORT_SYMBOL_GPL(usb_get_phy_dev); /** * devm_usb_get_phy_dev - find the USB PHY using device ptr and index * @dev - device that requests this phy * @index - the index of the phy * * Gets the phy using usb_get_phy_dev(), and associates a device with it using * devres. On driver detach, release function is invoked on the devres data, * then, devres data is freed. * * For use by USB host and peripheral drivers. */struct usb_phy *devm_usb_get_phy_dev(struct device *dev, u8 index){	struct usb_phy **ptr, *phy; 	ptr = devres_alloc(devm_usb_phy_release, sizeof(*ptr), GFP_KERNEL);	if (!ptr)		return NULL; 	phy = usb_get_phy_dev(dev, index);	if (!IS_ERR(phy)) {		*ptr = phy;		devres_add(dev, ptr);	} else		devres_free(ptr); 	return phy;}EXPORT_SYMBOL_GPL(devm_usb_get_phy_dev); /** * devm_usb_put_phy - release the USB PHY * @dev - device that wants to release this phy * @phy - the phy returned by devm_usb_get_phy() * * destroys the devres associated with this phy and invokes usb_put_phy * to release the phy. * * For use by USB host and peripheral drivers. */void devm_usb_put_phy(struct device *dev, struct usb_phy *phy){	int r; 	r = devres_destroy(dev, devm_usb_phy_release, devm_usb_phy_match, phy);	dev_WARN_ONCE(dev, r, "couldn't find PHY resource\n");}EXPORT_SYMBOL_GPL(devm_usb_put_phy); /** * usb_put_phy - release the USB PHY * @x: the phy returned by usb_get_phy() * * Releases a refcount the caller received from usb_get_phy(). * * For use by USB host and peripheral drivers. */void usb_put_phy(struct usb_phy *x){	if (x) {		struct module *owner = x->dev->driver->owner; 		put_device(x->dev);		module_put(owner);	}}EXPORT_SYMBOL_GPL(usb_put_phy); /** * usb_add_phy - declare the USB PHY * @x: the USB phy to be used; or NULL * @type - the type of this PHY * * This call is exclusively for use by phy drivers, which * coordinate the activities of drivers for host and peripheral * controllers, and in some cases for VBUS current regulation. */int usb_add_phy(struct usb_phy *x, enum usb_phy_type type){	int		ret = 0;	unsigned long	flags;	struct usb_phy	*phy; 	if (x->type != USB_PHY_TYPE_UNDEFINED) {		dev_err(x->dev, "not accepting initialized PHY %s\n", x->label);		return -EINVAL;	} 	ret = usb_add_extcon(x);	if (ret)		return ret; 	ATOMIC_INIT_NOTIFIER_HEAD(&x->notifier); 	spin_lock_irqsave(&phy_lock, flags); 	list_for_each_entry(phy, &phy_list, head) {		if (phy->type == type) {			ret = -EBUSY;			dev_err(x->dev, "transceiver type %s already exists\n",						usb_phy_type_string(type));			goto out;		}	} 	x->type = type;	list_add_tail(&x->head, &phy_list); out:	spin_unlock_irqrestore(&phy_lock, flags);	return ret;}EXPORT_SYMBOL_GPL(usb_add_phy); /** * usb_add_phy_dev - declare the USB PHY * @x: the USB phy to be used; or NULL * * This call is exclusively for use by phy drivers, which * coordinate the activities of drivers for host and peripheral * controllers, and in some cases for VBUS current regulation. */int usb_add_phy_dev(struct usb_phy *x){	struct usb_phy_bind *phy_bind;	unsigned long flags;	int ret; 	if (!x->dev) {		dev_err(x->dev, "no device provided for PHY\n");		return -EINVAL;	} 	ret = usb_add_extcon(x);	if (ret)		return ret; 	ATOMIC_INIT_NOTIFIER_HEAD(&x->notifier); 	spin_lock_irqsave(&phy_lock, flags);	list_for_each_entry(phy_bind, &phy_bind_list, list)		if (!(strcmp(phy_bind->phy_dev_name, dev_name(x->dev))))			phy_bind->phy = x; 	list_add_tail(&x->head, &phy_list); 	spin_unlock_irqrestore(&phy_lock, flags);	return 0;}EXPORT_SYMBOL_GPL(usb_add_phy_dev);

Lines 1–500 of 568.