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, -1);
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_generic_probe(dev);
58 bus_enumerate_hinted_children(dev);
59 return (bus_generic_attach(dev));
60 }
61
62 static int
mdio_detach(device_t dev)63 mdio_detach(device_t dev)
64 {
65
66 bus_generic_detach(dev);
67 return (0);
68 }
69
70 static int
mdio_readreg(device_t dev,int phy,int reg)71 mdio_readreg(device_t dev, int phy, int reg)
72 {
73
74 return (MDIO_READREG(device_get_parent(dev), phy, reg));
75 }
76
77 static int
mdio_writereg(device_t dev,int phy,int reg,int val)78 mdio_writereg(device_t dev, int phy, int reg, int val)
79 {
80
81 return (MDIO_WRITEREG(device_get_parent(dev), phy, reg, val));
82 }
83
84 static int
mdio_readextreg(device_t dev,int phy,int devad,int reg)85 mdio_readextreg(device_t dev, int phy, int devad, int reg)
86 {
87
88 return (MDIO_READEXTREG(device_get_parent(dev), phy, devad, reg));
89 }
90
91 static int
mdio_writeextreg(device_t dev,int phy,int devad,int reg,int val)92 mdio_writeextreg(device_t dev, int phy, int devad, int reg,
93 int val)
94 {
95
96 return (MDIO_WRITEEXTREG(device_get_parent(dev), phy, devad, reg, val));
97 }
98
99 static void
mdio_hinted_child(device_t dev,const char * name,int unit)100 mdio_hinted_child(device_t dev, const char *name, int unit)
101 {
102
103 device_add_child(dev, name, unit);
104 }
105
106 static device_method_t mdio_methods[] = {
107 /* device interface */
108 DEVMETHOD(device_identify, mdio_identify),
109 DEVMETHOD(device_probe, mdio_probe),
110 DEVMETHOD(device_attach, mdio_attach),
111 DEVMETHOD(device_detach, mdio_detach),
112 DEVMETHOD(device_shutdown, bus_generic_shutdown),
113
114 /* bus interface */
115 DEVMETHOD(bus_add_child, device_add_child_ordered),
116 DEVMETHOD(bus_hinted_child, mdio_hinted_child),
117
118 /* MDIO access */
119 DEVMETHOD(mdio_readreg, mdio_readreg),
120 DEVMETHOD(mdio_writereg, mdio_writereg),
121 DEVMETHOD(mdio_readextreg, mdio_readextreg),
122 DEVMETHOD(mdio_writeextreg, mdio_writeextreg),
123
124 DEVMETHOD_END
125 };
126
127 driver_t mdio_driver = {
128 "mdio",
129 mdio_methods,
130 0
131 };
132
133 MODULE_VERSION(mdio, 1);
134