1 /*-
2 * Copyright (c) 2011-2012 Stefan Bethke.
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
13 *
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24 * SUCH DAMAGE.
25 */
26
27 #include <sys/param.h>
28 #include <sys/bus.h>
29 #include <sys/systm.h>
30 #include <sys/module.h>
31
32 #include <dev/mdio/mdio.h>
33
34 #include "mdio_if.h"
35
36 static void
mdio_identify(driver_t * driver,device_t parent)37 mdio_identify(driver_t *driver, device_t parent)
38 {
39
40 if (device_find_child(parent, mdio_driver.name, -1) == NULL)
41 BUS_ADD_CHILD(parent, 0, mdio_driver.name, DEVICE_UNIT_ANY);
42 }
43
44 static int
mdio_probe(device_t dev)45 mdio_probe(device_t dev)
46 {
47
48 device_set_desc(dev, "MDIO");
49
50 return (BUS_PROBE_SPECIFIC);
51 }
52
53 static int
mdio_attach(device_t dev)54 mdio_attach(device_t dev)
55 {
56
57 bus_identify_children(dev);
58 bus_enumerate_hinted_children(dev);
59 bus_attach_children(dev);
60 return (0);
61 }
62
63 static int
mdio_readreg(device_t dev,int phy,int reg)64 mdio_readreg(device_t dev, int phy, int reg)
65 {
66
67 return (MDIO_READREG(device_get_parent(dev), phy, reg));
68 }
69
70 static int
mdio_writereg(device_t dev,int phy,int reg,int val)71 mdio_writereg(device_t dev, int phy, int reg, int val)
72 {
73
74 return (MDIO_WRITEREG(device_get_parent(dev), phy, reg, val));
75 }
76
77 static int
mdio_readextreg(device_t dev,int phy,int devad,int reg)78 mdio_readextreg(device_t dev, int phy, int devad, int reg)
79 {
80
81 return (MDIO_READEXTREG(device_get_parent(dev), phy, devad, reg));
82 }
83
84 static int
mdio_writeextreg(device_t dev,int phy,int devad,int reg,int val)85 mdio_writeextreg(device_t dev, int phy, int devad, int reg,
86 int val)
87 {
88
89 return (MDIO_WRITEEXTREG(device_get_parent(dev), phy, devad, reg, val));
90 }
91
92 static void
mdio_hinted_child(device_t dev,const char * name,int unit)93 mdio_hinted_child(device_t dev, const char *name, int unit)
94 {
95
96 device_add_child(dev, name, unit);
97 }
98
99 static device_method_t mdio_methods[] = {
100 /* device interface */
101 DEVMETHOD(device_identify, mdio_identify),
102 DEVMETHOD(device_probe, mdio_probe),
103 DEVMETHOD(device_attach, mdio_attach),
104 DEVMETHOD(device_detach, bus_generic_detach),
105 DEVMETHOD(device_shutdown, bus_generic_shutdown),
106
107 /* bus interface */
108 DEVMETHOD(bus_add_child, device_add_child_ordered),
109 DEVMETHOD(bus_hinted_child, mdio_hinted_child),
110
111 /* MDIO access */
112 DEVMETHOD(mdio_readreg, mdio_readreg),
113 DEVMETHOD(mdio_writereg, mdio_writereg),
114 DEVMETHOD(mdio_readextreg, mdio_readextreg),
115 DEVMETHOD(mdio_writeextreg, mdio_writeextreg),
116
117 DEVMETHOD_END
118 };
119
120 driver_t mdio_driver = {
121 "mdio",
122 mdio_methods,
123 0
124 };
125
126 MODULE_VERSION(mdio, 1);
127