Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3)  * This file contains all networking devres helpers.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6) #include <linux/device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7) #include <linux/etherdevice.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) #include <linux/netdevice.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) struct net_device_devres {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) 	struct net_device *ndev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) static void devm_free_netdev(struct device *dev, void *this)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) 	struct net_device_devres *res = this;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) 	free_netdev(res->ndev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) struct net_device *devm_alloc_etherdev_mqs(struct device *dev, int sizeof_priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 					   unsigned int txqs, unsigned int rxqs)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 	struct net_device_devres *dr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 	dr = devres_alloc(devm_free_netdev, sizeof(*dr), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 	if (!dr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 		return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 	dr->ndev = alloc_etherdev_mqs(sizeof_priv, txqs, rxqs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 	if (!dr->ndev) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 		devres_free(dr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 		return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 	devres_add(dev, dr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 	return dr->ndev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) EXPORT_SYMBOL(devm_alloc_etherdev_mqs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) static void devm_unregister_netdev(struct device *dev, void *this)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) 	struct net_device_devres *res = this;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 	unregister_netdev(res->ndev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) static int netdev_devres_match(struct device *dev, void *this, void *match_data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) 	struct net_device_devres *res = this;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) 	struct net_device *ndev = match_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) 	return ndev == res->ndev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58)  *	devm_register_netdev - resource managed variant of register_netdev()
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59)  *	@dev: managing device for this netdev - usually the parent device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60)  *	@ndev: device to register
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62)  *	This is a devres variant of register_netdev() for which the unregister
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63)  *	function will be call automatically when the managing device is
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64)  *	detached. Note: the net_device used must also be resource managed by
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65)  *	the same struct device.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) int devm_register_netdev(struct device *dev, struct net_device *ndev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) 	struct net_device_devres *dr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) 	/* struct net_device must itself be managed. For now a managed netdev
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) 	 * can only be allocated by devm_alloc_etherdev_mqs() so the check is
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) 	 * straightforward.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) 	if (WARN_ON(!devres_find(dev, devm_free_netdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) 				 netdev_devres_match, ndev)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) 	dr = devres_alloc(devm_unregister_netdev, sizeof(*dr), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) 	if (!dr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) 	ret = register_netdev(ndev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) 		devres_free(dr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) 		return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) 	dr->ndev = ndev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) 	devres_add(ndev->dev.parent, dr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) EXPORT_SYMBOL(devm_register_netdev);