]> CyberLeo.Net >> Repos - FreeBSD/FreeBSD.git/blob - sys/dev/bhnd/bcma/bcma_bhndb.c
MFhead @ r305013
[FreeBSD/FreeBSD.git] / sys / dev / bhnd / bcma / bcma_bhndb.c
1 /*-
2  * Copyright (c) 2015 Landon Fuller <landon@landonf.org>
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  *    without modification.
11  * 2. Redistributions in binary form must reproduce at minimum a disclaimer
12  *    similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any
13  *    redistribution must be conditioned upon including a substantially
14  *    similar Disclaimer requirement for further binary redistribution.
15  *
16  * NO WARRANTY
17  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
18  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
19  * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY
20  * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL
21  * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY,
22  * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
23  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
24  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
25  * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
26  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
27  * THE POSSIBILITY OF SUCH DAMAGES.
28  */
29
30 #include <sys/cdefs.h>
31 __FBSDID("$FreeBSD$");
32
33 #include <sys/param.h>
34 #include <sys/kernel.h>
35 #include <sys/bus.h>
36 #include <sys/module.h>
37
38 #include <dev/bhnd/bhnd_ids.h>
39 #include <dev/bhnd/bhndb/bhndbvar.h>
40 #include <dev/bhnd/bhndb/bhndb_hwdata.h>
41
42 #include "bcmavar.h"
43
44 #include "bcma_eromreg.h"
45 #include "bcma_eromvar.h"
46
47 /*
48  * Supports attachment of bcma(4) bus devices via a bhndb bridge.
49  */
50
51 static int
52 bcma_bhndb_probe(device_t dev)
53 {
54         const struct bhnd_chipid        *cid;
55         int                              error;
56
57         /* Defer to default probe implementation */
58         if ((error = bcma_probe(dev)) > 0)
59                 return (error);
60
61         /* Check bus type */
62         cid = BHNDB_GET_CHIPID(device_get_parent(dev), dev);
63         if (cid->chip_type != BHND_CHIPTYPE_BCMA)
64                 return (ENXIO);
65
66         /* Set device description */
67         bhnd_set_default_bus_desc(dev, cid);
68
69         return (error);
70 }
71
72 static int
73 bcma_bhndb_attach(device_t dev)
74 {
75         struct bcma_softc               *sc;
76         const struct bhnd_chipid        *cid;
77         struct resource                 *erom_res;
78         int                              error;
79         int                              rid;
80
81         sc = device_get_softc(dev);
82
83         /* Map the EROM resource and enumerate our children. */
84         cid = BHNDB_GET_CHIPID(device_get_parent(dev), dev);
85         rid = 0;
86         erom_res = bus_alloc_resource(dev, SYS_RES_MEMORY, &rid, cid->enum_addr,
87                 cid->enum_addr + BCMA_EROM_TABLE_SIZE, BCMA_EROM_TABLE_SIZE,
88                 RF_ACTIVE);
89         if (erom_res == NULL) {
90                 device_printf(dev, "failed to allocate EROM resource\n");
91                 return (ENXIO);
92         }
93
94         error = bcma_add_children(dev, erom_res, BCMA_EROM_TABLE_START);
95
96         /* Clean up */
97         bus_release_resource(dev, SYS_RES_MEMORY, rid, erom_res);
98         if (error)
99                 return (error);
100
101         /* Initialize full bridge configuration */
102         error = BHNDB_INIT_FULL_CONFIG(device_get_parent(dev), dev,
103             bhndb_bcma_priority_table);
104         if (error)
105                 return (error);
106
107         /* Ask our parent bridge to find the corresponding bridge core */
108         sc->hostb_dev = BHNDB_FIND_HOSTB_DEVICE(device_get_parent(dev), dev);
109
110         /* Call our superclass' implementation */
111         return (bcma_attach(dev));
112 }
113
114 static int
115 bcma_bhndb_suspend_child(device_t dev, device_t child)
116 {
117         struct bcma_devinfo     *dinfo;
118         int                      error;
119
120         if (device_get_parent(child) != dev)
121                 BUS_SUSPEND_CHILD(device_get_parent(dev), child);
122         
123         if (device_is_suspended(child))
124                 return (EBUSY);
125
126         dinfo = device_get_ivars(child);
127
128         /* Suspend the child */
129         if ((error = bhnd_generic_br_suspend_child(dev, child)))
130                 return (error);
131
132         /* Suspend child's agent resource  */
133         if (dinfo->res_agent != NULL)
134                 BHNDB_SUSPEND_RESOURCE(device_get_parent(dev), dev,
135                     SYS_RES_MEMORY, dinfo->res_agent->res);
136         
137         return (0);
138 }
139
140 static int
141 bcma_bhndb_resume_child(device_t dev, device_t child)
142 {
143         struct bcma_devinfo     *dinfo;
144         int                      error;
145
146         if (device_get_parent(child) != dev)
147                 BUS_SUSPEND_CHILD(device_get_parent(dev), child);
148
149         if (!device_is_suspended(child))
150                 return (EBUSY);
151
152         dinfo = device_get_ivars(child);
153
154         /* Resume child's agent resource  */
155         if (dinfo->res_agent != NULL) {
156                 error = BHNDB_RESUME_RESOURCE(device_get_parent(dev), dev,
157                     SYS_RES_MEMORY, dinfo->res_agent->res);
158                 if (error)
159                         return (error);
160         }
161
162         /* Resume the child */
163         if ((error = bhnd_generic_br_resume_child(dev, child))) {
164                 /* On failure, re-suspend the agent resource */
165                 if (dinfo->res_agent != NULL) {
166                         BHNDB_SUSPEND_RESOURCE(device_get_parent(dev), dev,
167                             SYS_RES_MEMORY, dinfo->res_agent->res);
168                 }
169
170                 return (error);
171         }
172
173         return (0);
174 }
175
176 static device_method_t bcma_bhndb_methods[] = {
177         /* Device interface */
178         DEVMETHOD(device_probe,                 bcma_bhndb_probe),
179         DEVMETHOD(device_attach,                bcma_bhndb_attach),
180
181         /* Bus interface */
182         DEVMETHOD(bus_suspend_child,            bcma_bhndb_suspend_child),
183         DEVMETHOD(bus_resume_child,             bcma_bhndb_resume_child),
184
185         DEVMETHOD_END
186 };
187
188 DEFINE_CLASS_2(bhnd, bcma_bhndb_driver, bcma_bhndb_methods,
189     sizeof(struct bcma_softc), bhnd_bhndb_driver, bcma_driver);
190
191 DRIVER_MODULE(bcma_bhndb, bhndb, bcma_bhndb_driver, bhnd_devclass, NULL, NULL);
192  
193 MODULE_VERSION(bcma_bhndb, 1);
194 MODULE_DEPEND(bcma_bhndb, bcma, 1, 1, 1);
195 MODULE_DEPEND(bcma_bhndb, bhnd, 1, 1, 1);
196 MODULE_DEPEND(bcma_bhndb, bhndb, 1, 1, 1);