2 * drivers/net/phy/mdio_bus.c
8 * Copyright (c) 2004 Freescale Semiconductor, Inc.
10 * This program is free software; you can redistribute it and/or modify it
11 * under the terms of the GNU General Public License as published by the
12 * Free Software Foundation; either version 2 of the License, or (at your
13 * option) any later version.
16 #include <linux/kernel.h>
17 #include <linux/sched.h>
18 #include <linux/string.h>
19 #include <linux/errno.h>
20 #include <linux/unistd.h>
21 #include <linux/slab.h>
22 #include <linux/interrupt.h>
23 #include <linux/init.h>
24 #include <linux/delay.h>
25 #include <linux/netdevice.h>
26 #include <linux/etherdevice.h>
27 #include <linux/skbuff.h>
28 #include <linux/spinlock.h>
30 #include <linux/module.h>
31 #include <linux/mii.h>
32 #include <linux/ethtool.h>
33 #include <linux/phy.h>
37 #include <asm/uaccess.h>
41 * description: Called by a bus driver to bring up all the PHYs
42 * on a given bus, and attach them to the bus
44 int mdiobus_register(struct mii_bus
*bus
)
49 spin_lock_init(&bus
->mdio_lock
);
51 if (NULL
== bus
|| NULL
== bus
->name
||
59 for (i
= 0; i
< PHY_MAX_ADDR
; i
++) {
60 struct phy_device
*phydev
;
62 if (bus
->phy_mask
& (1 << i
)) {
63 bus
->phy_map
[i
] = NULL
;
67 phydev
= get_phy_device(bus
, i
);
70 return PTR_ERR(phydev
);
72 /* There's a PHY at this address
79 * And, we need to register it */
81 phydev
->irq
= bus
->irq
[i
];
83 phydev
->dev
.parent
= bus
->dev
;
84 phydev
->dev
.bus
= &mdio_bus_type
;
85 snprintf(phydev
->dev
.bus_id
, BUS_ID_SIZE
, PHY_ID_FMT
, bus
->id
, i
);
89 err
= device_register(&phydev
->dev
);
92 printk(KERN_ERR
"phy %d failed to register\n",
96 bus
->phy_map
[i
] = phydev
;
99 pr_info("%s: probed\n", bus
->name
);
103 EXPORT_SYMBOL(mdiobus_register
);
105 void mdiobus_unregister(struct mii_bus
*bus
)
109 for (i
= 0; i
< PHY_MAX_ADDR
; i
++) {
110 if (bus
->phy_map
[i
]) {
111 device_unregister(&bus
->phy_map
[i
]->dev
);
112 kfree(bus
->phy_map
[i
]);
116 EXPORT_SYMBOL(mdiobus_unregister
);
120 * description: Given a PHY device, and a PHY driver, return 1 if
121 * the driver supports the device. Otherwise, return 0
123 static int mdio_bus_match(struct device
*dev
, struct device_driver
*drv
)
125 struct phy_device
*phydev
= to_phy_device(dev
);
126 struct phy_driver
*phydrv
= to_phy_driver(drv
);
128 return (phydrv
->phy_id
== (phydev
->phy_id
& phydrv
->phy_id_mask
));
131 /* Suspend and resume. Copied from platform_suspend and
134 static int mdio_bus_suspend(struct device
* dev
, pm_message_t state
)
137 struct device_driver
*drv
= dev
->driver
;
139 if (drv
&& drv
->suspend
)
140 ret
= drv
->suspend(dev
, state
);
145 static int mdio_bus_resume(struct device
* dev
)
148 struct device_driver
*drv
= dev
->driver
;
150 if (drv
&& drv
->resume
)
151 ret
= drv
->resume(dev
);
156 struct bus_type mdio_bus_type
= {
158 .match
= mdio_bus_match
,
159 .suspend
= mdio_bus_suspend
,
160 .resume
= mdio_bus_resume
,
162 EXPORT_SYMBOL(mdio_bus_type
);
164 int __init
mdio_bus_init(void)
166 return bus_register(&mdio_bus_type
);
169 void mdio_bus_exit(void)
171 bus_unregister(&mdio_bus_type
);