| 
									
										
										
										
											2020-05-23 15:27:08 +02:00
										 |  |  | // SPDX-License-Identifier: GPL-2.0-or-later
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This file contains all networking devres helpers. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #include <linux/device.h>
 | 
					
						
							|  |  |  | #include <linux/etherdevice.h>
 | 
					
						
							|  |  |  | #include <linux/netdevice.h>
 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2020-05-23 15:27:09 +02:00
										 |  |  | struct net_device_devres { | 
					
						
							|  |  |  | 	struct net_device *ndev; | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static void devm_free_netdev(struct device *dev, void *this) | 
					
						
							| 
									
										
										
										
											2020-05-23 15:27:08 +02:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2020-05-23 15:27:09 +02:00
										 |  |  | 	struct net_device_devres *res = this; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	free_netdev(res->ndev); | 
					
						
							| 
									
										
										
										
											2020-05-23 15:27:08 +02:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | struct net_device *devm_alloc_etherdev_mqs(struct device *dev, int sizeof_priv, | 
					
						
							|  |  |  | 					   unsigned int txqs, unsigned int rxqs) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2020-05-23 15:27:09 +02:00
										 |  |  | 	struct net_device_devres *dr; | 
					
						
							| 
									
										
										
										
											2020-05-23 15:27:08 +02:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	dr = devres_alloc(devm_free_netdev, sizeof(*dr), GFP_KERNEL); | 
					
						
							|  |  |  | 	if (!dr) | 
					
						
							|  |  |  | 		return NULL; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2020-05-23 15:27:09 +02:00
										 |  |  | 	dr->ndev = alloc_etherdev_mqs(sizeof_priv, txqs, rxqs); | 
					
						
							|  |  |  | 	if (!dr->ndev) { | 
					
						
							| 
									
										
										
										
											2020-05-23 15:27:08 +02:00
										 |  |  | 		devres_free(dr); | 
					
						
							|  |  |  | 		return NULL; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	devres_add(dev, dr); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2020-05-23 15:27:09 +02:00
										 |  |  | 	return dr->ndev; | 
					
						
							| 
									
										
										
										
											2020-05-23 15:27:08 +02:00
										 |  |  | } | 
					
						
							|  |  |  | EXPORT_SYMBOL(devm_alloc_etherdev_mqs); | 
					
						
							| 
									
										
										
										
											2020-05-23 15:27:10 +02:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2020-06-29 14:03:39 +02:00
										 |  |  | static void devm_unregister_netdev(struct device *dev, void *this) | 
					
						
							| 
									
										
										
										
											2020-05-23 15:27:10 +02:00
										 |  |  | { | 
					
						
							|  |  |  | 	struct net_device_devres *res = this; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	unregister_netdev(res->ndev); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static int netdev_devres_match(struct device *dev, void *this, void *match_data) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct net_device_devres *res = this; | 
					
						
							|  |  |  | 	struct net_device *ndev = match_data; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return ndev == res->ndev; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /**
 | 
					
						
							|  |  |  |  *	devm_register_netdev - resource managed variant of register_netdev() | 
					
						
							|  |  |  |  *	@dev: managing device for this netdev - usually the parent device | 
					
						
							|  |  |  |  *	@ndev: device to register | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  *	This is a devres variant of register_netdev() for which the unregister | 
					
						
							|  |  |  |  *	function will be call automatically when the managing device is | 
					
						
							|  |  |  |  *	detached. Note: the net_device used must also be resource managed by | 
					
						
							|  |  |  |  *	the same struct device. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | int devm_register_netdev(struct device *dev, struct net_device *ndev) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct net_device_devres *dr; | 
					
						
							|  |  |  | 	int ret; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* struct net_device must itself be managed. For now a managed netdev
 | 
					
						
							|  |  |  | 	 * can only be allocated by devm_alloc_etherdev_mqs() so the check is | 
					
						
							|  |  |  | 	 * straightforward. | 
					
						
							|  |  |  | 	 */ | 
					
						
							|  |  |  | 	if (WARN_ON(!devres_find(dev, devm_free_netdev, | 
					
						
							|  |  |  | 				 netdev_devres_match, ndev))) | 
					
						
							|  |  |  | 		return -EINVAL; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2020-06-29 14:03:39 +02:00
										 |  |  | 	dr = devres_alloc(devm_unregister_netdev, sizeof(*dr), GFP_KERNEL); | 
					
						
							| 
									
										
										
										
											2020-05-23 15:27:10 +02:00
										 |  |  | 	if (!dr) | 
					
						
							|  |  |  | 		return -ENOMEM; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	ret = register_netdev(ndev); | 
					
						
							|  |  |  | 	if (ret) { | 
					
						
							|  |  |  | 		devres_free(dr); | 
					
						
							|  |  |  | 		return ret; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	dr->ndev = ndev; | 
					
						
							|  |  |  | 	devres_add(ndev->dev.parent, dr); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | EXPORT_SYMBOL(devm_register_netdev); |