lists.openwall.net   lists  /  announce  owl-users  owl-dev  john-users  john-dev  passwdqc-users  yescrypt  popa3d-users  /  oss-security  kernel-hardening  musl  sabotage  tlsify  passwords  /  crypt-dev  xvendor  /  Bugtraq  Full-Disclosure  linux-kernel  linux-netdev  linux-ext4  linux-hardening  linux-cve-announce  PHC 
Open Source and information security mailing list archives
 
Hash Suite: Windows password security audit tool. GUI, reports in PDF.
[<prev] [next>] [<thread-prev] [thread-next>] [day] [month] [year] [list]
Message-Id: <1387416526-7394-2-git-send-email-hauke@hauke-m.de>
Date:	Thu, 19 Dec 2013 02:28:38 +0100
From:	Hauke Mehrtens <hauke@...ke-m.de>
To:	davem@...emloft.net
Cc:	zambrano@...adcom.com, netdev@...r.kernel.org,
	f.fainelli@...il.com, Hauke Mehrtens <hauke@...ke-m.de>,
	Florian Fainelli <florian@...nwrt.org>,
	Vitaly Bordug <vbordug@...mvista.com>,
	Anton Vorontsov <avorontsov@...mvista.com>
Subject: [PATCH v2 1/9] fixed-phy: register fixed PHY as platform driver

This changes the fixed phy driver from registering the mdio bus when
the module gets loaded to registering it when a device was registered.
A phy has to get registered to this driver before it registered the
mdio bus, but this only worked when the phys are registered in some
arch code before the system booted completely. Now we want to do so
when the Ethernet driver gets initialized which could be happen every
time.

To make this driver work with such a case, convert it to a platform
driver which could be registered every time with the phys which should
be on the bus.

This was only tested on BCM47XX, but not on AR7 because I do not have
such a device.

Signed-off-by: Hauke Mehrtens <hauke@...ke-m.de>
CC: Florian Fainelli <florian@...nwrt.org>
CC: Vitaly Bordug <vbordug@...mvista.com>
CC: Anton Vorontsov <avorontsov@...mvista.com>
---
 arch/mips/ar7/platform.c  |   39 ++++++++++++++++++----
 drivers/net/phy/fixed.c   |   79 ++++++++++++++++++++++-----------------------
 include/linux/phy_fixed.h |   21 ++++++------
 3 files changed, 83 insertions(+), 56 deletions(-)

diff --git a/arch/mips/ar7/platform.c b/arch/mips/ar7/platform.c
index 7e2356f..26ea35a 100644
--- a/arch/mips/ar7/platform.c
+++ b/arch/mips/ar7/platform.c
@@ -251,10 +251,35 @@ static struct resource cpmac_high_res[] = {
 	},
 };
 
-static struct fixed_phy_status fixed_phy_status __initdata = {
-	.link		= 1,
-	.speed		= 100,
-	.duplex		= 1,
+static struct pdata_fixed_phy cpmac_phy_data = {
+	.name 		= "fixed-0",
+	.phys_num	= 1,
+	.phys		= {{
+		.phy_id	= 1,
+		.irq	= PHY_POLL,
+		.status = {
+			.link	= 1,
+			.speed	= 100,
+			.duplex	= 1,
+		},
+	},
+	{
+		.phy_id	= 1,
+		.irq	= PHY_POLL,
+		.status = {
+			.link	= 1,
+			.speed	= 100,
+			.duplex	= 1,
+		},
+	}},
+};
+
+static struct platform_device cpmac_phy = {
+	.id		= 0,
+	.name		= "fixed-phy",
+	.dev = {
+		.platform_data	= &cpmac_phy_data,
+	},
 };
 
 static struct plat_cpmac_data cpmac_low_data = {
@@ -683,7 +708,8 @@ static int __init ar7_register_devices(void)
 	}
 
 	if (ar7_has_high_cpmac()) {
-		res = fixed_phy_add(PHY_POLL, cpmac_high.id, &fixed_phy_status);
+		cpmac_phy_data.phys[1].phy_id = cpmac_high.id;
+		cpmac_phy_data.phys_num = 2;
 		if (!res) {
 			cpmac_get_mac(1, cpmac_high_data.dev_addr);
 
@@ -695,7 +721,8 @@ static int __init ar7_register_devices(void)
 	} else
 		cpmac_low_data.phy_mask = 0xffffffff;
 
-	res = fixed_phy_add(PHY_POLL, cpmac_low.id, &fixed_phy_status);
+	cpmac_phy_data.phys[0].phy_id = cpmac_low.id;
+	res = platform_device_register(&cpmac_phy);
 	if (!res) {
 		cpmac_get_mac(0, cpmac_low_data.dev_addr);
 		res = platform_device_register(&cpmac_low);
diff --git a/drivers/net/phy/fixed.c b/drivers/net/phy/fixed.c
index ba55adf..dd5154b 100644
--- a/drivers/net/phy/fixed.c
+++ b/drivers/net/phy/fixed.c
@@ -5,6 +5,7 @@
  *         Anton Vorontsov <avorontsov@...mvista.com>
  *
  * Copyright (c) 2006-2007 MontaVista Software, Inc.
+ * Copyright (C) 2013 Hauke Mehrtens <hauke@...ke-m.de>
  *
  * 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
@@ -39,11 +40,6 @@ struct fixed_phy {
 	struct list_head node;
 };
 
-static struct platform_device *pdev;
-static struct fixed_mdio_bus platform_fmb = {
-	.phys = LIST_HEAD_INIT(platform_fmb.phys),
-};
-
 static int fixed_phy_update_regs(struct fixed_phy *fp)
 {
 	u16 bmsr = BMSR_ANEGCAPABLE;
@@ -153,7 +149,7 @@ int fixed_phy_set_link_update(struct phy_device *phydev,
 			      int (*link_update)(struct net_device *,
 						 struct fixed_phy_status *))
 {
-	struct fixed_mdio_bus *fmb = &platform_fmb;
+	struct fixed_mdio_bus *fmb = phydev->bus->priv;
 	struct fixed_phy *fp;
 
 	if (!link_update || !phydev || !phydev->bus)
@@ -171,14 +167,14 @@ int fixed_phy_set_link_update(struct phy_device *phydev,
 }
 EXPORT_SYMBOL_GPL(fixed_phy_set_link_update);
 
-int fixed_phy_add(unsigned int irq, int phy_id,
-		  struct fixed_phy_status *status)
+static int fixed_phy_add(struct device *dev, struct fixed_mdio_bus *fmb,
+			 unsigned int irq, int phy_id,
+			 struct fixed_phy_status *status)
 {
 	int ret;
-	struct fixed_mdio_bus *fmb = &platform_fmb;
 	struct fixed_phy *fp;
 
-	fp = kzalloc(sizeof(*fp), GFP_KERNEL);
+	fp = devm_kzalloc(dev, sizeof(struct fixed_phy), GFP_KERNEL);
 	if (!fp)
 		return -ENOMEM;
 
@@ -191,36 +187,41 @@ int fixed_phy_add(unsigned int irq, int phy_id,
 
 	ret = fixed_phy_update_regs(fp);
 	if (ret)
-		goto err_regs;
+		return ret;
 
 	list_add_tail(&fp->node, &fmb->phys);
 
 	return 0;
-
-err_regs:
-	kfree(fp);
-	return ret;
 }
-EXPORT_SYMBOL_GPL(fixed_phy_add);
 
-static int __init fixed_mdio_bus_init(void)
+static int fixed_phy_probe(struct platform_device *pdev)
 {
-	struct fixed_mdio_bus *fmb = &platform_fmb;
+	struct pdata_fixed_phy *pdata = dev_get_platdata(&pdev->dev);
+	struct fixed_mdio_bus *fmb;
+	struct fixed_phy_conf *phy;
 	int ret;
+	int i;
 
-	pdev = platform_device_register_simple("Fixed MDIO bus", 0, NULL, 0);
-	if (IS_ERR(pdev)) {
-		ret = PTR_ERR(pdev);
-		goto err_pdev;
+	fmb = devm_kzalloc(&pdev->dev, sizeof(struct fixed_mdio_bus), GFP_KERNEL);
+	if (!fmb)
+		return -ENOMEM;
+	INIT_LIST_HEAD(&fmb->phys);
+	platform_set_drvdata(pdev, fmb);
+
+	for (i = 0; i < pdata->phys_num; i++) {
+		phy = &pdata->phys[i];
+		ret = fixed_phy_add(&pdev->dev, fmb, phy->irq, phy->phy_id,
+				    &phy->status);
+		if (ret < 0)
+			return ret;
 	}
 
 	fmb->mii_bus = mdiobus_alloc();
-	if (fmb->mii_bus == NULL) {
-		ret = -ENOMEM;
-		goto err_mdiobus_reg;
+	if (!fmb->mii_bus) {
+		return -ENOMEM;
 	}
 
-	snprintf(fmb->mii_bus->id, MII_BUS_ID_SIZE, "fixed-0");
+	snprintf(fmb->mii_bus->id, MII_BUS_ID_SIZE, pdata->name);
 	fmb->mii_bus->name = "Fixed MDIO Bus";
 	fmb->mii_bus->priv = fmb;
 	fmb->mii_bus->parent = &pdev->dev;
@@ -236,29 +237,27 @@ static int __init fixed_mdio_bus_init(void)
 
 err_mdiobus_alloc:
 	mdiobus_free(fmb->mii_bus);
-err_mdiobus_reg:
-	platform_device_unregister(pdev);
-err_pdev:
 	return ret;
 }
-module_init(fixed_mdio_bus_init);
 
-static void __exit fixed_mdio_bus_exit(void)
+static int fixed_phy_remove(struct platform_device *pdev)
 {
-	struct fixed_mdio_bus *fmb = &platform_fmb;
-	struct fixed_phy *fp, *tmp;
+	struct fixed_mdio_bus *fmb = platform_get_drvdata(pdev);
 
 	mdiobus_unregister(fmb->mii_bus);
 	mdiobus_free(fmb->mii_bus);
-	platform_device_unregister(pdev);
-
-	list_for_each_entry_safe(fp, tmp, &fmb->phys, node) {
-		list_del(&fp->node);
-		kfree(fp);
-	}
+	return 0;
 }
-module_exit(fixed_mdio_bus_exit);
 
+static struct platform_driver fixed_phy_driver = {
+	.probe = fixed_phy_probe,
+	.remove = fixed_phy_remove,
+	.driver = {
+		.name = "fixed-phy",
+	},
+};
+
+module_platform_driver(fixed_phy_driver);
 MODULE_DESCRIPTION("Fixed MDIO bus (MDIO bus emulation with fixed PHYs)");
 MODULE_AUTHOR("Vitaly Bordug");
 MODULE_LICENSE("GPL");
diff --git a/include/linux/phy_fixed.h b/include/linux/phy_fixed.h
index 509d8f5..f41140e 100644
--- a/include/linux/phy_fixed.h
+++ b/include/linux/phy_fixed.h
@@ -9,16 +9,17 @@ struct fixed_phy_status {
 	int asym_pause;
 };
 
-#ifdef CONFIG_FIXED_PHY
-extern int fixed_phy_add(unsigned int irq, int phy_id,
-			 struct fixed_phy_status *status);
-#else
-static inline int fixed_phy_add(unsigned int irq, int phy_id,
-				struct fixed_phy_status *status)
-{
-	return -ENODEV;
-}
-#endif /* CONFIG_FIXED_PHY */
+struct fixed_phy_conf {
+	int phy_id;
+	unsigned int irq;
+	struct fixed_phy_status status;
+};
+
+struct pdata_fixed_phy {
+	char *name;
+	unsigned int phys_num;
+	struct fixed_phy_conf phys[];
+};
 
 /*
  * This function issued only by fixed_phy-aware drivers, no need
-- 
1.7.10.4

--
To unsubscribe from this list: send the line "unsubscribe netdev" in
the body of a message to majordomo@...r.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Powered by blists - more mailing lists

Powered by Openwall GNU/*/Linux Powered by OpenVZ