if_udav.c revision 1.64 1 1.64 mrg /* $NetBSD: if_udav.c,v 1.64 2019/08/09 06:44:42 mrg Exp $ */
2 1.1 itojun /* $nabe: if_udav.c,v 1.3 2003/08/21 16:57:19 nabe Exp $ */
3 1.37 mrg
4 1.1 itojun /*
5 1.1 itojun * Copyright (c) 2003
6 1.1 itojun * Shingo WATANABE <nabe (at) nabechan.org>. All rights reserved.
7 1.1 itojun *
8 1.1 itojun * Redistribution and use in source and binary forms, with or without
9 1.1 itojun * modification, are permitted provided that the following conditions
10 1.1 itojun * are met:
11 1.1 itojun * 1. Redistributions of source code must retain the above copyright
12 1.1 itojun * notice, this list of conditions and the following disclaimer.
13 1.1 itojun * 2. Redistributions in binary form must reproduce the above copyright
14 1.1 itojun * notice, this list of conditions and the following disclaimer in the
15 1.1 itojun * documentation and/or other materials provided with the distribution.
16 1.2 tsutsui * 3. Neither the name of the author nor the names of any co-contributors
17 1.1 itojun * may be used to endorse or promote products derived from this software
18 1.1 itojun * without specific prior written permission.
19 1.1 itojun *
20 1.1 itojun * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
21 1.1 itojun * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
22 1.1 itojun * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
23 1.1 itojun * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
24 1.1 itojun * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
25 1.1 itojun * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
26 1.1 itojun * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
27 1.1 itojun * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28 1.1 itojun * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
29 1.1 itojun * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
30 1.1 itojun * SUCH DAMAGE.
31 1.1 itojun *
32 1.1 itojun */
33 1.1 itojun
34 1.1 itojun /*
35 1.1 itojun * DM9601(DAVICOM USB to Ethernet MAC Controller with Integrated 10/100 PHY)
36 1.1 itojun * The spec can be found at the following url.
37 1.1 itojun * http://www.davicom.com.tw/big5/download/Data%20Sheet/DM9601-DS-F01-062202s.pdf
38 1.1 itojun */
39 1.1 itojun
40 1.1 itojun /*
41 1.1 itojun * TODO:
42 1.1 itojun * Interrupt Endpoint support
43 1.1 itojun * External PHYs
44 1.1 itojun * powerhook() support?
45 1.1 itojun */
46 1.1 itojun
47 1.1 itojun #include <sys/cdefs.h>
48 1.64 mrg __KERNEL_RCSID(0, "$NetBSD: if_udav.c,v 1.64 2019/08/09 06:44:42 mrg Exp $");
49 1.1 itojun
50 1.40 christos #ifdef _KERNEL_OPT
51 1.49 skrll #include "opt_usb.h"
52 1.40 christos #endif
53 1.1 itojun
54 1.1 itojun #include <sys/param.h>
55 1.1 itojun #include <sys/systm.h>
56 1.61 skrll #include <sys/module.h>
57 1.1 itojun #include <sys/kernel.h>
58 1.1 itojun
59 1.61 skrll #include <dev/usb/usbnet.h>
60 1.1 itojun #include <dev/usb/if_udavreg.h>
61 1.1 itojun
62 1.1 itojun /* Function declarations */
63 1.48 msaitoh int udav_match(device_t, cfdata_t, void *);
64 1.48 msaitoh void udav_attach(device_t, device_t, void *);
65 1.57 mrg
66 1.64 mrg CFATTACH_DECL_NEW(udav, sizeof(struct usbnet), udav_match, udav_attach,
67 1.61 skrll usbnet_detach, usbnet_activate);
68 1.61 skrll
69 1.61 skrll static void udav_chip_init(struct usbnet *);
70 1.1 itojun
71 1.61 skrll static unsigned udav_tx_prepare(struct usbnet *, struct mbuf *,
72 1.61 skrll struct usbnet_chain *);
73 1.61 skrll static void udav_rxeof_loop(struct usbnet *, struct usbd_xfer *,
74 1.61 skrll struct usbnet_chain *, uint32_t);
75 1.61 skrll static void udav_stop_cb(struct ifnet *, int);
76 1.61 skrll static int udav_ioctl_cb(struct ifnet *, u_long, void *);
77 1.61 skrll static usbd_status udav_mii_read_reg(struct usbnet *, int, int, uint16_t *);
78 1.61 skrll static usbd_status udav_mii_write_reg(struct usbnet *, int, int, uint16_t);
79 1.61 skrll static void udav_mii_statchg(struct ifnet *);
80 1.61 skrll static int udav_init(struct ifnet *);
81 1.61 skrll static void udav_setiff(struct usbnet *);
82 1.61 skrll static void udav_setiff_locked(struct usbnet *);
83 1.61 skrll static void udav_reset(struct usbnet *);
84 1.61 skrll
85 1.64 mrg static int udav_csr_read(struct usbnet *, int, void *, int);
86 1.64 mrg static int udav_csr_write(struct usbnet *, int, void *, int);
87 1.64 mrg static int udav_csr_read1(struct usbnet *, int);
88 1.64 mrg static int udav_csr_write1(struct usbnet *, int, unsigned char);
89 1.1 itojun
90 1.1 itojun #if 0
91 1.64 mrg static int udav_mem_read(struct usbnet *, int, void *, int);
92 1.64 mrg static int udav_mem_write(struct usbnet *, int, void *, int);
93 1.64 mrg static int udav_mem_write1(struct usbnet *, int, unsigned char);
94 1.1 itojun #endif
95 1.1 itojun
96 1.1 itojun /* Macros */
97 1.1 itojun #ifdef UDAV_DEBUG
98 1.31 dyoung #define DPRINTF(x) if (udavdebug) printf x
99 1.58 msaitoh #define DPRINTFN(n, x) if (udavdebug >= (n)) printf x
100 1.61 skrll int udavdebug = 10;
101 1.1 itojun #else
102 1.1 itojun #define DPRINTF(x)
103 1.58 msaitoh #define DPRINTFN(n, x)
104 1.1 itojun #endif
105 1.1 itojun
106 1.64 mrg #define UDAV_SETBIT(un, reg, x) \
107 1.64 mrg udav_csr_write1(un, reg, udav_csr_read1(un, reg) | (x))
108 1.1 itojun
109 1.64 mrg #define UDAV_CLRBIT(un, reg, x) \
110 1.64 mrg udav_csr_write1(un, reg, udav_csr_read1(un, reg) & ~(x))
111 1.1 itojun
112 1.1 itojun static const struct udav_type {
113 1.1 itojun struct usb_devno udav_dev;
114 1.46 skrll uint16_t udav_flags;
115 1.1 itojun #define UDAV_EXT_PHY 0x0001
116 1.42 jakllsch #define UDAV_NO_PHY 0x0002
117 1.1 itojun } udav_devs [] = {
118 1.1 itojun /* Corega USB-TXC */
119 1.1 itojun {{ USB_VENDOR_COREGA, USB_PRODUCT_COREGA_FETHER_USB_TXC }, 0},
120 1.18 xtraeme /* ShanTou ST268 USB NIC */
121 1.18 xtraeme {{ USB_VENDOR_SHANTOU, USB_PRODUCT_SHANTOU_ST268_USB_NIC }, 0},
122 1.22 drochner /* ShanTou ADM8515 */
123 1.22 drochner {{ USB_VENDOR_SHANTOU, USB_PRODUCT_SHANTOU_ADM8515 }, 0},
124 1.30 jmcneill /* SUNRISING SR9600 */
125 1.30 jmcneill {{ USB_VENDOR_SUNRISING, USB_PRODUCT_SUNRISING_SR9600 }, 0 },
126 1.42 jakllsch /* SUNRISING QF9700 */
127 1.42 jakllsch {{ USB_VENDOR_SUNRISING, USB_PRODUCT_SUNRISING_QF9700 }, UDAV_NO_PHY },
128 1.35 mbalmer /* QUAN DM9601 */
129 1.35 mbalmer {{USB_VENDOR_QUAN, USB_PRODUCT_QUAN_DM9601 }, 0},
130 1.1 itojun #if 0
131 1.1 itojun /* DAVICOM DM9601 Generic? */
132 1.1 itojun /* XXX: The following ids was obtained from the data sheet. */
133 1.1 itojun {{ 0x0a46, 0x9601 }, 0},
134 1.1 itojun #endif
135 1.1 itojun };
136 1.7 christos #define udav_lookup(v, p) ((const struct udav_type *)usb_lookup(udav_devs, v, p))
137 1.1 itojun
138 1.63 mrg static struct usbnet_ops udav_ops = {
139 1.63 mrg .uno_stop = udav_stop_cb,
140 1.63 mrg .uno_ioctl = udav_ioctl_cb,
141 1.63 mrg .uno_read_reg = udav_mii_read_reg,
142 1.63 mrg .uno_write_reg = udav_mii_write_reg,
143 1.63 mrg .uno_statchg = udav_mii_statchg,
144 1.63 mrg .uno_tx_prepare = udav_tx_prepare,
145 1.63 mrg .uno_rx_loop = udav_rxeof_loop,
146 1.63 mrg .uno_init = udav_init,
147 1.63 mrg };
148 1.1 itojun
149 1.1 itojun /* Probe */
150 1.40 christos int
151 1.31 dyoung udav_match(device_t parent, cfdata_t match, void *aux)
152 1.1 itojun {
153 1.31 dyoung struct usb_attach_arg *uaa = aux;
154 1.1 itojun
155 1.46 skrll return udav_lookup(uaa->uaa_vendor, uaa->uaa_product) != NULL ?
156 1.46 skrll UMATCH_VENDOR_PRODUCT : UMATCH_NONE;
157 1.1 itojun }
158 1.1 itojun
159 1.1 itojun /* Attach */
160 1.40 christos void
161 1.31 dyoung udav_attach(device_t parent, device_t self, void *aux)
162 1.1 itojun {
163 1.64 mrg struct usbnet * const un = device_private(self);
164 1.31 dyoung struct usb_attach_arg *uaa = aux;
165 1.46 skrll struct usbd_device *dev = uaa->uaa_device;
166 1.46 skrll struct usbd_interface *iface;
167 1.1 itojun usbd_status err;
168 1.1 itojun usb_interface_descriptor_t *id;
169 1.1 itojun usb_endpoint_descriptor_t *ed;
170 1.6 augustss char *devinfop;
171 1.61 skrll int i;
172 1.1 itojun
173 1.26 plunky aprint_naive("\n");
174 1.26 plunky aprint_normal("\n");
175 1.6 augustss devinfop = usbd_devinfo_alloc(dev, 0);
176 1.24 cube aprint_normal_dev(self, "%s\n", devinfop);
177 1.6 augustss usbd_devinfo_free(devinfop);
178 1.1 itojun
179 1.61 skrll un->un_dev = self;
180 1.61 skrll un->un_udev = dev;
181 1.64 mrg un->un_sc = un;
182 1.63 mrg un->un_ops = &udav_ops;
183 1.61 skrll
184 1.1 itojun /* Move the device into the configured state. */
185 1.22 drochner err = usbd_set_config_no(dev, UDAV_CONFIG_NO, 1); /* idx 0 */
186 1.1 itojun if (err) {
187 1.39 skrll aprint_error_dev(self, "failed to set configuration"
188 1.39 skrll ", err=%s\n", usbd_errstr(err));
189 1.61 skrll return;
190 1.1 itojun }
191 1.1 itojun
192 1.1 itojun /* get control interface */
193 1.1 itojun err = usbd_device2interface_handle(dev, UDAV_IFACE_INDEX, &iface);
194 1.1 itojun if (err) {
195 1.24 cube aprint_error_dev(self, "failed to get interface, err=%s\n",
196 1.1 itojun usbd_errstr(err));
197 1.61 skrll return;
198 1.1 itojun }
199 1.1 itojun
200 1.61 skrll un->un_iface = iface;
201 1.64 mrg un->un_flags = udav_lookup(uaa->uaa_vendor,
202 1.48 msaitoh uaa->uaa_product)->udav_flags;
203 1.1 itojun
204 1.1 itojun /* get interface descriptor */
205 1.61 skrll id = usbd_get_interface_descriptor(un->un_iface);
206 1.1 itojun
207 1.1 itojun /* find endpoints */
208 1.61 skrll un->un_ed[USBNET_ENDPT_RX] = un->un_ed[USBNET_ENDPT_TX] =
209 1.61 skrll un->un_ed[USBNET_ENDPT_INTR] = -1;
210 1.1 itojun for (i = 0; i < id->bNumEndpoints; i++) {
211 1.61 skrll ed = usbd_interface2endpoint_descriptor(un->un_iface, i);
212 1.1 itojun if (ed == NULL) {
213 1.24 cube aprint_error_dev(self, "couldn't get endpoint %d\n", i);
214 1.61 skrll return;
215 1.1 itojun }
216 1.1 itojun if ((ed->bmAttributes & UE_XFERTYPE) == UE_BULK &&
217 1.1 itojun UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN)
218 1.61 skrll un->un_ed[USBNET_ENDPT_RX] = ed->bEndpointAddress;
219 1.1 itojun else if ((ed->bmAttributes & UE_XFERTYPE) == UE_BULK &&
220 1.1 itojun UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT)
221 1.61 skrll un->un_ed[USBNET_ENDPT_TX] = ed->bEndpointAddress;
222 1.1 itojun else if ((ed->bmAttributes & UE_XFERTYPE) == UE_INTERRUPT &&
223 1.1 itojun UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN)
224 1.61 skrll un->un_ed[USBNET_ENDPT_INTR] = ed->bEndpointAddress;
225 1.1 itojun }
226 1.1 itojun
227 1.62 skrll if (un->un_ed[USBNET_ENDPT_RX] == 0 ||
228 1.62 skrll un->un_ed[USBNET_ENDPT_TX] == 0 ||
229 1.62 skrll un->un_ed[USBNET_ENDPT_INTR] == 0) {
230 1.24 cube aprint_error_dev(self, "missing endpoint\n");
231 1.61 skrll return;
232 1.1 itojun }
233 1.1 itojun
234 1.61 skrll /* Not supported yet. */
235 1.61 skrll un->un_ed[USBNET_ENDPT_INTR] = 0;
236 1.61 skrll
237 1.61 skrll // /* reset the adapter */
238 1.61 skrll // udav_reset(un);
239 1.1 itojun
240 1.63 mrg usbnet_attach(un, "udavdet", UDAV_RX_LIST_CNT, UDAV_TX_LIST_CNT,
241 1.63 mrg USBD_SHORT_XFER_OK, USBD_FORCE_SHORT_XFER,
242 1.63 mrg UDAV_BUFSZ, UDAV_BUFSZ);
243 1.1 itojun
244 1.1 itojun /* Get Ethernet Address */
245 1.61 skrll usbnet_lock_mii(un);
246 1.64 mrg err = udav_csr_read(un, UDAV_PAR, un->un_eaddr, ETHER_ADDR_LEN);
247 1.61 skrll usbnet_unlock_mii(un);
248 1.1 itojun if (err) {
249 1.24 cube aprint_error_dev(self, "read MAC address failed\n");
250 1.61 skrll return;
251 1.1 itojun }
252 1.1 itojun
253 1.64 mrg bool have_mii = !ISSET(un->un_flags, UDAV_NO_PHY);
254 1.61 skrll if (!have_mii)
255 1.61 skrll un->un_link = 1;
256 1.1 itojun
257 1.9 wiz /* initialize interface information */
258 1.61 skrll usbnet_attach_ifp(un, have_mii,
259 1.61 skrll IFF_SIMPLEX | IFF_BROADCAST | IFF_MULTICAST, 0, 0);
260 1.42 jakllsch
261 1.31 dyoung return;
262 1.1 itojun }
263 1.1 itojun
264 1.1 itojun #if 0
265 1.1 itojun /* read memory */
266 1.61 skrll static int
267 1.64 mrg udav_mem_read(struct usbnet *un, int offset, void *buf, int len)
268 1.1 itojun {
269 1.1 itojun usb_device_request_t req;
270 1.1 itojun usbd_status err;
271 1.1 itojun
272 1.1 itojun DPRINTFN(0x200,
273 1.61 skrll ("%s: %s: enter\n", device_xname(un->un_dev), __func__));
274 1.1 itojun
275 1.63 mrg if (usbnet_isdying(un))
276 1.46 skrll return 0;
277 1.1 itojun
278 1.1 itojun offset &= 0xffff;
279 1.1 itojun len &= 0xff;
280 1.1 itojun
281 1.1 itojun req.bmRequestType = UT_READ_VENDOR_DEVICE;
282 1.1 itojun req.bRequest = UDAV_REQ_MEM_READ;
283 1.1 itojun USETW(req.wValue, 0x0000);
284 1.1 itojun USETW(req.wIndex, offset);
285 1.1 itojun USETW(req.wLength, len);
286 1.1 itojun
287 1.61 skrll err = usbd_do_request(un->un_udev, &req, buf);
288 1.1 itojun if (err) {
289 1.1 itojun DPRINTF(("%s: %s: read failed. off=%04x, err=%d\n",
290 1.61 skrll device_xname(un->un_dev), __func__, offset, err));
291 1.1 itojun }
292 1.1 itojun
293 1.46 skrll return err;
294 1.1 itojun }
295 1.1 itojun
296 1.1 itojun /* write memory */
297 1.61 skrll static int
298 1.64 mrg udav_mem_write(struct usbnet *un, int offset, void *buf, int len)
299 1.1 itojun {
300 1.1 itojun usb_device_request_t req;
301 1.1 itojun usbd_status err;
302 1.1 itojun
303 1.1 itojun DPRINTFN(0x200,
304 1.61 skrll ("%s: %s: enter\n", device_xname(un->un_dev), __func__));
305 1.1 itojun
306 1.63 mrg if (usbnet_isdying(un))
307 1.46 skrll return 0;
308 1.1 itojun
309 1.1 itojun offset &= 0xffff;
310 1.1 itojun len &= 0xff;
311 1.1 itojun
312 1.1 itojun req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
313 1.1 itojun req.bRequest = UDAV_REQ_MEM_WRITE;
314 1.1 itojun USETW(req.wValue, 0x0000);
315 1.1 itojun USETW(req.wIndex, offset);
316 1.1 itojun USETW(req.wLength, len);
317 1.1 itojun
318 1.61 skrll err = usbd_do_request(un->un_udev, &req, buf);
319 1.1 itojun if (err) {
320 1.1 itojun DPRINTF(("%s: %s: write failed. off=%04x, err=%d\n",
321 1.61 skrll device_xname(un->un_dev), __func__, offset, err));
322 1.1 itojun }
323 1.1 itojun
324 1.46 skrll return err;
325 1.1 itojun }
326 1.1 itojun
327 1.1 itojun /* write memory */
328 1.61 skrll static int
329 1.64 mrg udav_mem_write1(struct usbnet *un, int offset, unsigned char ch)
330 1.1 itojun {
331 1.1 itojun usb_device_request_t req;
332 1.1 itojun usbd_status err;
333 1.1 itojun
334 1.1 itojun DPRINTFN(0x200,
335 1.61 skrll ("%s: %s: enter\n", device_xname(un->un_dev), __func__));
336 1.1 itojun
337 1.63 mrg if (usbnet_isdying(un))
338 1.46 skrll return 0;
339 1.1 itojun
340 1.1 itojun offset &= 0xffff;
341 1.1 itojun
342 1.1 itojun req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
343 1.1 itojun req.bRequest = UDAV_REQ_MEM_WRITE1;
344 1.1 itojun USETW(req.wValue, ch);
345 1.1 itojun USETW(req.wIndex, offset);
346 1.1 itojun USETW(req.wLength, 0x0000);
347 1.1 itojun
348 1.61 skrll err = usbd_do_request(un->un_udev, &req, NULL);
349 1.1 itojun if (err) {
350 1.1 itojun DPRINTF(("%s: %s: write failed. off=%04x, err=%d\n",
351 1.61 skrll device_xname(un->un_dev), __func__, offset, err));
352 1.1 itojun }
353 1.1 itojun
354 1.46 skrll return err;
355 1.1 itojun }
356 1.1 itojun #endif
357 1.1 itojun
358 1.1 itojun /* read register(s) */
359 1.61 skrll static int
360 1.64 mrg udav_csr_read(struct usbnet *un, int offset, void *buf, int len)
361 1.1 itojun {
362 1.1 itojun usb_device_request_t req;
363 1.1 itojun usbd_status err;
364 1.1 itojun
365 1.61 skrll usbnet_isowned_mii(un);
366 1.63 mrg KASSERT(!usbnet_isdying(un));
367 1.1 itojun
368 1.1 itojun DPRINTFN(0x200,
369 1.61 skrll ("%s: %s: enter\n", device_xname(un->un_dev), __func__));
370 1.1 itojun
371 1.1 itojun offset &= 0xff;
372 1.1 itojun len &= 0xff;
373 1.1 itojun
374 1.1 itojun req.bmRequestType = UT_READ_VENDOR_DEVICE;
375 1.1 itojun req.bRequest = UDAV_REQ_REG_READ;
376 1.1 itojun USETW(req.wValue, 0x0000);
377 1.1 itojun USETW(req.wIndex, offset);
378 1.1 itojun USETW(req.wLength, len);
379 1.1 itojun
380 1.61 skrll err = usbd_do_request(un->un_udev, &req, buf);
381 1.1 itojun if (err) {
382 1.1 itojun DPRINTF(("%s: %s: read failed. off=%04x, err=%d\n",
383 1.61 skrll device_xname(un->un_dev), __func__, offset, err));
384 1.1 itojun }
385 1.1 itojun
386 1.46 skrll return err;
387 1.1 itojun }
388 1.1 itojun
389 1.1 itojun /* write register(s) */
390 1.61 skrll static int
391 1.64 mrg udav_csr_write(struct usbnet *un, int offset, void *buf, int len)
392 1.1 itojun {
393 1.1 itojun usb_device_request_t req;
394 1.1 itojun usbd_status err;
395 1.1 itojun
396 1.61 skrll usbnet_isowned_mii(un);
397 1.63 mrg KASSERT(!usbnet_isdying(un));
398 1.1 itojun
399 1.1 itojun DPRINTFN(0x200,
400 1.61 skrll ("%s: %s: enter\n", device_xname(un->un_dev), __func__));
401 1.1 itojun
402 1.1 itojun offset &= 0xff;
403 1.1 itojun len &= 0xff;
404 1.1 itojun
405 1.1 itojun req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
406 1.1 itojun req.bRequest = UDAV_REQ_REG_WRITE;
407 1.1 itojun USETW(req.wValue, 0x0000);
408 1.1 itojun USETW(req.wIndex, offset);
409 1.1 itojun USETW(req.wLength, len);
410 1.1 itojun
411 1.61 skrll err = usbd_do_request(un->un_udev, &req, buf);
412 1.1 itojun if (err) {
413 1.1 itojun DPRINTF(("%s: %s: write failed. off=%04x, err=%d\n",
414 1.61 skrll device_xname(un->un_dev), __func__, offset, err));
415 1.1 itojun }
416 1.1 itojun
417 1.46 skrll return err;
418 1.1 itojun }
419 1.1 itojun
420 1.61 skrll static int
421 1.64 mrg udav_csr_read1(struct usbnet *un, int offset)
422 1.1 itojun {
423 1.46 skrll uint8_t val = 0;
424 1.5 perry
425 1.61 skrll usbnet_isowned_mii(un);
426 1.1 itojun
427 1.1 itojun DPRINTFN(0x200,
428 1.61 skrll ("%s: %s: enter\n", device_xname(un->un_dev), __func__));
429 1.1 itojun
430 1.63 mrg if (usbnet_isdying(un))
431 1.46 skrll return 0;
432 1.1 itojun
433 1.64 mrg return udav_csr_read(un, offset, &val, 1) ? 0 : val;
434 1.1 itojun }
435 1.1 itojun
436 1.1 itojun /* write a register */
437 1.61 skrll static int
438 1.64 mrg udav_csr_write1(struct usbnet *un, int offset, unsigned char ch)
439 1.1 itojun {
440 1.1 itojun usb_device_request_t req;
441 1.1 itojun usbd_status err;
442 1.1 itojun
443 1.61 skrll usbnet_isowned_mii(un);
444 1.63 mrg KASSERT(!usbnet_isdying(un));
445 1.1 itojun
446 1.1 itojun DPRINTFN(0x200,
447 1.61 skrll ("%s: %s: enter\n", device_xname(un->un_dev), __func__));
448 1.1 itojun
449 1.1 itojun offset &= 0xff;
450 1.1 itojun
451 1.1 itojun req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
452 1.1 itojun req.bRequest = UDAV_REQ_REG_WRITE1;
453 1.1 itojun USETW(req.wValue, ch);
454 1.1 itojun USETW(req.wIndex, offset);
455 1.1 itojun USETW(req.wLength, 0x0000);
456 1.1 itojun
457 1.61 skrll err = usbd_do_request(un->un_udev, &req, NULL);
458 1.1 itojun if (err) {
459 1.1 itojun DPRINTF(("%s: %s: write failed. off=%04x, err=%d\n",
460 1.61 skrll device_xname(un->un_dev), __func__, offset, err));
461 1.1 itojun }
462 1.1 itojun
463 1.46 skrll return err;
464 1.1 itojun }
465 1.1 itojun
466 1.61 skrll static int
467 1.61 skrll udav_init_locked(struct ifnet *ifp)
468 1.1 itojun {
469 1.61 skrll struct usbnet * const un = ifp->if_softc;
470 1.61 skrll struct mii_data * const mii = usbnet_mii(un);
471 1.20 dyoung uint8_t eaddr[ETHER_ADDR_LEN];
472 1.61 skrll int rc;
473 1.61 skrll
474 1.61 skrll DPRINTF(("%s: %s: enter\n", device_xname(un->un_dev), __func__));
475 1.1 itojun
476 1.61 skrll usbnet_isowned(un);
477 1.1 itojun
478 1.63 mrg if (usbnet_isdying(un))
479 1.46 skrll return EIO;
480 1.1 itojun
481 1.61 skrll /* Cancel pending I/O and free all TX/RX buffers */
482 1.61 skrll if (ifp->if_flags & IFF_RUNNING)
483 1.61 skrll usbnet_stop(un, ifp, 1);
484 1.1 itojun
485 1.61 skrll usbnet_lock_mii_un_locked(un);
486 1.1 itojun
487 1.20 dyoung memcpy(eaddr, CLLADDR(ifp->if_sadl), sizeof(eaddr));
488 1.64 mrg udav_csr_write(un, UDAV_PAR, eaddr, ETHER_ADDR_LEN);
489 1.1 itojun
490 1.1 itojun /* Initialize network control register */
491 1.1 itojun /* Disable loopback */
492 1.64 mrg UDAV_CLRBIT(un, UDAV_NCR, UDAV_NCR_LBK0 | UDAV_NCR_LBK1);
493 1.1 itojun
494 1.1 itojun /* Initialize RX control register */
495 1.64 mrg UDAV_SETBIT(un, UDAV_RCR, UDAV_RCR_DIS_LONG | UDAV_RCR_DIS_CRC);
496 1.1 itojun
497 1.1 itojun /* If we want promiscuous mode, accept all physical frames. */
498 1.1 itojun if (ifp->if_flags & IFF_PROMISC)
499 1.64 mrg UDAV_SETBIT(un, UDAV_RCR, UDAV_RCR_ALL | UDAV_RCR_PRMSC);
500 1.1 itojun else
501 1.64 mrg UDAV_CLRBIT(un, UDAV_RCR, UDAV_RCR_ALL | UDAV_RCR_PRMSC);
502 1.1 itojun
503 1.1 itojun /* Load the multicast filter */
504 1.61 skrll udav_setiff_locked(un);
505 1.1 itojun
506 1.1 itojun /* Enable RX */
507 1.64 mrg UDAV_SETBIT(un, UDAV_RCR, UDAV_RCR_RXEN);
508 1.1 itojun
509 1.1 itojun /* clear POWER_DOWN state of internal PHY */
510 1.64 mrg UDAV_SETBIT(un, UDAV_GPCR, UDAV_GPCR_GEP_CNTL0);
511 1.64 mrg UDAV_CLRBIT(un, UDAV_GPR, UDAV_GPR_GEPIO0);
512 1.1 itojun
513 1.61 skrll usbnet_unlock_mii_un_locked(un);
514 1.1 itojun
515 1.61 skrll rc = 0;
516 1.61 skrll if (mii) {
517 1.61 skrll if ((rc = mii_mediachg(mii)) == ENXIO)
518 1.61 skrll rc = 0;
519 1.46 skrll }
520 1.46 skrll
521 1.61 skrll if (rc != 0)
522 1.61 skrll return rc;
523 1.46 skrll
524 1.63 mrg return usbnet_init_rx_tx(un);
525 1.61 skrll }
526 1.46 skrll
527 1.61 skrll static int
528 1.61 skrll udav_init(struct ifnet *ifp)
529 1.61 skrll {
530 1.61 skrll struct usbnet * const un = ifp->if_softc;
531 1.1 itojun
532 1.61 skrll usbnet_lock(un);
533 1.61 skrll int ret = udav_init_locked(ifp);
534 1.61 skrll usbnet_unlock(un);
535 1.1 itojun
536 1.61 skrll return ret;
537 1.1 itojun }
538 1.1 itojun
539 1.61 skrll static void
540 1.61 skrll udav_reset(struct usbnet *un)
541 1.1 itojun {
542 1.61 skrll usbnet_isowned(un);
543 1.61 skrll
544 1.63 mrg if (usbnet_isdying(un))
545 1.61 skrll return;
546 1.61 skrll
547 1.61 skrll DPRINTF(("%s: %s: enter\n", device_xname(un->un_dev), __func__));
548 1.61 skrll
549 1.61 skrll udav_chip_init(un);
550 1.61 skrll }
551 1.1 itojun
552 1.61 skrll static void
553 1.61 skrll udav_chip_init(struct usbnet *un)
554 1.61 skrll {
555 1.61 skrll usbnet_lock_mii_un_locked(un);
556 1.1 itojun
557 1.1 itojun /* Select PHY */
558 1.1 itojun #if 1
559 1.1 itojun /*
560 1.1 itojun * XXX: force select internal phy.
561 1.1 itojun * external phy routines are not tested.
562 1.1 itojun */
563 1.64 mrg UDAV_CLRBIT(un, UDAV_NCR, UDAV_NCR_EXT_PHY);
564 1.1 itojun #else
565 1.64 mrg if (un->un_flags & UDAV_EXT_PHY) {
566 1.64 mrg UDAV_SETBIT(un, UDAV_NCR, UDAV_NCR_EXT_PHY);
567 1.1 itojun } else {
568 1.64 mrg UDAV_CLRBIT(un, UDAV_NCR, UDAV_NCR_EXT_PHY);
569 1.1 itojun }
570 1.1 itojun #endif
571 1.1 itojun
572 1.64 mrg UDAV_SETBIT(un, UDAV_NCR, UDAV_NCR_RST);
573 1.1 itojun
574 1.61 skrll for (int i = 0; i < UDAV_TX_TIMEOUT; i++) {
575 1.64 mrg if (!(udav_csr_read1(un, UDAV_NCR) & UDAV_NCR_RST))
576 1.1 itojun break;
577 1.1 itojun delay(10); /* XXX */
578 1.1 itojun }
579 1.1 itojun delay(10000); /* XXX */
580 1.1 itojun
581 1.61 skrll usbnet_unlock_mii_un_locked(un);
582 1.1 itojun }
583 1.1 itojun
584 1.1 itojun #define UDAV_BITS 6
585 1.1 itojun
586 1.1 itojun #define UDAV_CALCHASH(addr) \
587 1.1 itojun (ether_crc32_le((addr), ETHER_ADDR_LEN) & ((1 << UDAV_BITS) - 1))
588 1.1 itojun
589 1.61 skrll static void
590 1.61 skrll udav_setiff_locked(struct usbnet *un)
591 1.1 itojun {
592 1.61 skrll struct ethercom *ec = usbnet_ec(un);
593 1.61 skrll struct ifnet * const ifp = usbnet_ifp(un);
594 1.1 itojun struct ether_multi *enm;
595 1.1 itojun struct ether_multistep step;
596 1.46 skrll uint8_t hashes[8];
597 1.1 itojun int h = 0;
598 1.1 itojun
599 1.61 skrll DPRINTF(("%s: %s: enter\n", device_xname(un->un_dev), __func__));
600 1.61 skrll
601 1.61 skrll usbnet_isowned_mii(un);
602 1.1 itojun
603 1.63 mrg if (usbnet_isdying(un))
604 1.1 itojun return;
605 1.1 itojun
606 1.64 mrg if (ISSET(un->un_flags, UDAV_NO_PHY)) {
607 1.64 mrg UDAV_SETBIT(un, UDAV_RCR, UDAV_RCR_ALL);
608 1.64 mrg UDAV_SETBIT(un, UDAV_RCR, UDAV_RCR_PRMSC);
609 1.42 jakllsch return;
610 1.42 jakllsch }
611 1.42 jakllsch
612 1.1 itojun if (ifp->if_flags & IFF_PROMISC) {
613 1.64 mrg UDAV_SETBIT(un, UDAV_RCR, UDAV_RCR_ALL | UDAV_RCR_PRMSC);
614 1.1 itojun return;
615 1.1 itojun } else if (ifp->if_flags & IFF_ALLMULTI) {
616 1.59 msaitoh allmulti:
617 1.1 itojun ifp->if_flags |= IFF_ALLMULTI;
618 1.64 mrg UDAV_SETBIT(un, UDAV_RCR, UDAV_RCR_ALL);
619 1.64 mrg UDAV_CLRBIT(un, UDAV_RCR, UDAV_RCR_PRMSC);
620 1.1 itojun return;
621 1.1 itojun }
622 1.1 itojun
623 1.1 itojun /* first, zot all the existing hash bits */
624 1.1 itojun memset(hashes, 0x00, sizeof(hashes));
625 1.1 itojun hashes[7] |= 0x80; /* broadcast address */
626 1.64 mrg udav_csr_write(un, UDAV_MAR, hashes, sizeof(hashes));
627 1.1 itojun
628 1.1 itojun /* now program new ones */
629 1.59 msaitoh ETHER_LOCK(ec);
630 1.59 msaitoh ETHER_FIRST_MULTI(step, ec, enm);
631 1.1 itojun while (enm != NULL) {
632 1.1 itojun if (memcmp(enm->enm_addrlo, enm->enm_addrhi,
633 1.59 msaitoh ETHER_ADDR_LEN) != 0) {
634 1.59 msaitoh ETHER_UNLOCK(ec);
635 1.1 itojun goto allmulti;
636 1.59 msaitoh }
637 1.1 itojun
638 1.1 itojun h = UDAV_CALCHASH(enm->enm_addrlo);
639 1.1 itojun hashes[h>>3] |= 1 << (h & 0x7);
640 1.1 itojun ETHER_NEXT_MULTI(step, enm);
641 1.1 itojun }
642 1.59 msaitoh ETHER_UNLOCK(ec);
643 1.1 itojun
644 1.1 itojun /* disable all multicast */
645 1.1 itojun ifp->if_flags &= ~IFF_ALLMULTI;
646 1.64 mrg UDAV_CLRBIT(un, UDAV_RCR, UDAV_RCR_ALL);
647 1.1 itojun
648 1.1 itojun /* write hash value to the register */
649 1.64 mrg udav_csr_write(un, UDAV_MAR, hashes, sizeof(hashes));
650 1.1 itojun }
651 1.1 itojun
652 1.61 skrll static void
653 1.61 skrll udav_setiff(struct usbnet *un)
654 1.1 itojun {
655 1.61 skrll usbnet_lock_mii(un);
656 1.61 skrll udav_setiff_locked(un);
657 1.61 skrll usbnet_unlock_mii(un);
658 1.1 itojun }
659 1.1 itojun
660 1.1 itojun
661 1.61 skrll static unsigned
662 1.61 skrll udav_tx_prepare(struct usbnet *un, struct mbuf *m, struct usbnet_chain *c)
663 1.1 itojun {
664 1.61 skrll int total_len;
665 1.61 skrll uint8_t *buf = c->unc_buf;
666 1.1 itojun
667 1.61 skrll usbnet_isowned_tx(un);
668 1.1 itojun
669 1.61 skrll DPRINTF(("%s: %s: enter\n", device_xname(un->un_dev), __func__));
670 1.1 itojun
671 1.61 skrll if (m->m_pkthdr.len > UDAV_BUFSZ - 2)
672 1.61 skrll return 0;
673 1.1 itojun
674 1.1 itojun /* Copy the mbuf data into a contiguous buffer */
675 1.61 skrll m_copydata(m, 0, m->m_pkthdr.len, buf + 2);
676 1.1 itojun total_len = m->m_pkthdr.len;
677 1.1 itojun if (total_len < UDAV_MIN_FRAME_LEN) {
678 1.61 skrll memset(buf + 2 + total_len, 0,
679 1.1 itojun UDAV_MIN_FRAME_LEN - total_len);
680 1.1 itojun total_len = UDAV_MIN_FRAME_LEN;
681 1.1 itojun }
682 1.1 itojun
683 1.1 itojun /* Frame length is specified in the first 2bytes of the buffer */
684 1.61 skrll buf[0] = (uint8_t)total_len;
685 1.61 skrll buf[1] = (uint8_t)(total_len >> 8);
686 1.1 itojun total_len += 2;
687 1.1 itojun
688 1.61 skrll DPRINTF(("%s: %s: send %d bytes\n", device_xname(un->un_dev),
689 1.61 skrll __func__, total_len));
690 1.1 itojun
691 1.61 skrll return total_len;
692 1.1 itojun }
693 1.1 itojun
694 1.61 skrll static void
695 1.61 skrll udav_rxeof_loop(struct usbnet *un, struct usbd_xfer *xfer,
696 1.61 skrll struct usbnet_chain *c, uint32_t total_len)
697 1.1 itojun {
698 1.61 skrll struct ifnet *ifp = usbnet_ifp(un);
699 1.61 skrll uint8_t *buf = c->unc_buf;
700 1.61 skrll uint16_t pkt_len;
701 1.61 skrll uint8_t pktstat;
702 1.1 itojun
703 1.61 skrll DPRINTF(("%s: %s: enter\n", device_xname(un->un_dev), __func__));
704 1.1 itojun
705 1.61 skrll /* first byte in received data */
706 1.61 skrll pktstat = *buf;
707 1.61 skrll total_len -= sizeof(pktstat);
708 1.61 skrll buf += sizeof(pktstat);
709 1.1 itojun
710 1.61 skrll DPRINTF(("%s: RX Status: 0x%02x\n", device_xname(un->un_dev), pktstat));
711 1.1 itojun
712 1.61 skrll pkt_len = UGETW(buf);
713 1.61 skrll total_len -= sizeof(pkt_len);
714 1.61 skrll buf += sizeof(pkt_len);
715 1.1 itojun
716 1.61 skrll DPRINTF(("%s: RX Length: 0x%02x\n", device_xname(un->un_dev), pkt_len));
717 1.1 itojun
718 1.61 skrll if (pktstat & UDAV_RSR_LCS) {
719 1.1 itojun ifp->if_collisions++;
720 1.61 skrll return;
721 1.1 itojun }
722 1.1 itojun
723 1.61 skrll if (pkt_len < sizeof(struct ether_header) ||
724 1.61 skrll pkt_len > total_len ||
725 1.61 skrll (pktstat & UDAV_RSR_ERR)) {
726 1.1 itojun ifp->if_ierrors++;
727 1.61 skrll return;
728 1.1 itojun }
729 1.1 itojun
730 1.61 skrll pkt_len -= ETHER_CRC_LEN;
731 1.1 itojun
732 1.61 skrll DPRINTF(("%s: Rx deliver: 0x%02x\n", device_xname(un->un_dev), pkt_len));
733 1.1 itojun
734 1.61 skrll usbnet_enqueue(un, buf, pkt_len, 0, 0, 0);
735 1.1 itojun }
736 1.1 itojun
737 1.61 skrll static int
738 1.61 skrll udav_ioctl_cb(struct ifnet *ifp, u_long cmd, void *data)
739 1.1 itojun {
740 1.61 skrll struct usbnet * const un = ifp->if_softc;
741 1.1 itojun
742 1.61 skrll switch (cmd) {
743 1.61 skrll case SIOCADDMULTI:
744 1.61 skrll case SIOCDELMULTI:
745 1.61 skrll udav_setiff(un);
746 1.61 skrll break;
747 1.61 skrll default:
748 1.61 skrll break;
749 1.1 itojun }
750 1.1 itojun
751 1.1 itojun
752 1.61 skrll return 0;
753 1.1 itojun }
754 1.1 itojun
755 1.1 itojun /* Stop the adapter and free any mbufs allocated to the RX and TX lists. */
756 1.61 skrll static void
757 1.61 skrll udav_stop_cb(struct ifnet *ifp, int disable)
758 1.1 itojun {
759 1.61 skrll struct usbnet * const un = ifp->if_softc;
760 1.1 itojun
761 1.61 skrll DPRINTF(("%s: %s: enter\n", device_xname(un->un_dev), __func__));
762 1.1 itojun
763 1.61 skrll udav_reset(un);
764 1.1 itojun }
765 1.1 itojun
766 1.61 skrll static usbd_status
767 1.61 skrll udav_mii_read_reg(struct usbnet *un, int phy, int reg, uint16_t *val)
768 1.1 itojun {
769 1.56 msaitoh uint8_t data[2];
770 1.1 itojun
771 1.61 skrll usbnet_isowned_mii(un);
772 1.1 itojun
773 1.1 itojun DPRINTFN(0xff, ("%s: %s: enter, phy=%d reg=0x%04x\n",
774 1.61 skrll device_xname(un->un_dev), __func__, phy, reg));
775 1.1 itojun
776 1.63 mrg if (usbnet_isdying(un)) {
777 1.1 itojun #ifdef DIAGNOSTIC
778 1.61 skrll printf("%s: %s: dying\n", device_xname(un->un_dev),
779 1.1 itojun __func__);
780 1.1 itojun #endif
781 1.61 skrll return USBD_INVAL;
782 1.1 itojun }
783 1.1 itojun
784 1.1 itojun /* XXX: one PHY only for the internal PHY */
785 1.1 itojun if (phy != 0) {
786 1.1 itojun DPRINTFN(0xff, ("%s: %s: phy=%d is not supported\n",
787 1.61 skrll device_xname(un->un_dev), __func__, phy));
788 1.61 skrll return USBD_INVAL;
789 1.1 itojun }
790 1.1 itojun
791 1.1 itojun /* select internal PHY and set PHY register address */
792 1.64 mrg udav_csr_write1(un, UDAV_EPAR,
793 1.1 itojun UDAV_EPAR_PHY_ADR0 | (reg & UDAV_EPAR_EROA_MASK));
794 1.1 itojun
795 1.1 itojun /* select PHY operation and start read command */
796 1.64 mrg udav_csr_write1(un, UDAV_EPCR, UDAV_EPCR_EPOS | UDAV_EPCR_ERPRR);
797 1.1 itojun
798 1.1 itojun /* XXX: should be wait? */
799 1.1 itojun
800 1.1 itojun /* end read command */
801 1.64 mrg UDAV_CLRBIT(un, UDAV_EPCR, UDAV_EPCR_ERPRR);
802 1.1 itojun
803 1.1 itojun /* retrieve the result from data registers */
804 1.64 mrg udav_csr_read(un, UDAV_EPDRL, data, 2);
805 1.1 itojun
806 1.56 msaitoh *val = data[0] | (data[1] << 8);
807 1.1 itojun
808 1.56 msaitoh DPRINTFN(0xff, ("%s: %s: phy=%d reg=0x%04x => 0x%04hx\n",
809 1.61 skrll device_xname(un->un_dev), __func__, phy, reg, *val));
810 1.1 itojun
811 1.61 skrll return USBD_NORMAL_COMPLETION;
812 1.1 itojun }
813 1.1 itojun
814 1.61 skrll static usbd_status
815 1.61 skrll udav_mii_write_reg(struct usbnet *un, int phy, int reg, uint16_t val)
816 1.1 itojun {
817 1.56 msaitoh uint8_t data[2];
818 1.1 itojun
819 1.61 skrll usbnet_isowned_mii(un);
820 1.1 itojun
821 1.56 msaitoh DPRINTFN(0xff, ("%s: %s: enter, phy=%d reg=0x%04x val=0x%04hx\n",
822 1.61 skrll device_xname(un->un_dev), __func__, phy, reg, val));
823 1.1 itojun
824 1.63 mrg if (usbnet_isdying(un)) {
825 1.1 itojun #ifdef DIAGNOSTIC
826 1.61 skrll printf("%s: %s: dying\n", device_xname(un->un_dev),
827 1.1 itojun __func__);
828 1.1 itojun #endif
829 1.56 msaitoh return -1;
830 1.1 itojun }
831 1.1 itojun
832 1.1 itojun /* XXX: one PHY only for the internal PHY */
833 1.1 itojun if (phy != 0) {
834 1.1 itojun DPRINTFN(0xff, ("%s: %s: phy=%d is not supported\n",
835 1.61 skrll device_xname(un->un_dev), __func__, phy));
836 1.56 msaitoh return -1;
837 1.1 itojun }
838 1.1 itojun
839 1.1 itojun /* select internal PHY and set PHY register address */
840 1.64 mrg udav_csr_write1(un, UDAV_EPAR,
841 1.1 itojun UDAV_EPAR_PHY_ADR0 | (reg & UDAV_EPAR_EROA_MASK));
842 1.1 itojun
843 1.1 itojun /* put the value to the data registers */
844 1.56 msaitoh data[0] = val & 0xff;
845 1.56 msaitoh data[1] = (val >> 8) & 0xff;
846 1.64 mrg udav_csr_write(un, UDAV_EPDRL, data, 2);
847 1.1 itojun
848 1.1 itojun /* select PHY operation and start write command */
849 1.64 mrg udav_csr_write1(un, UDAV_EPCR, UDAV_EPCR_EPOS | UDAV_EPCR_ERPRW);
850 1.1 itojun
851 1.1 itojun /* XXX: should be wait? */
852 1.1 itojun
853 1.1 itojun /* end write command */
854 1.64 mrg UDAV_CLRBIT(un, UDAV_EPCR, UDAV_EPCR_ERPRW);
855 1.1 itojun
856 1.61 skrll return USBD_NORMAL_COMPLETION;
857 1.1 itojun }
858 1.1 itojun
859 1.61 skrll static void
860 1.61 skrll udav_mii_statchg(struct ifnet *ifp)
861 1.1 itojun {
862 1.61 skrll struct usbnet * const un = ifp->if_softc;
863 1.61 skrll struct mii_data * const mii = usbnet_mii(un);
864 1.61 skrll
865 1.61 skrll DPRINTF(("%s: %s: enter\n", ifp->if_xname, __func__));
866 1.1 itojun
867 1.63 mrg if (usbnet_isdying(un))
868 1.1 itojun return;
869 1.1 itojun
870 1.61 skrll un->un_link = false;
871 1.61 skrll if (mii->mii_media_status & IFM_ACTIVE &&
872 1.61 skrll IFM_SUBTYPE(mii->mii_media_active) != IFM_NONE) {
873 1.61 skrll DPRINTF(("%s: %s: got link\n",
874 1.61 skrll device_xname(un->un_dev), __func__));
875 1.61 skrll un->un_link = true;
876 1.61 skrll }
877 1.61 skrll }
878 1.61 skrll
879 1.61 skrll MODULE(MODULE_CLASS_DRIVER, if_udav, "usbnet");
880 1.61 skrll
881 1.61 skrll #ifdef _MODULE
882 1.61 skrll #include "ioconf.c"
883 1.61 skrll #endif
884 1.61 skrll
885 1.61 skrll static int
886 1.61 skrll if_udav_modcmd(modcmd_t cmd, void *aux)
887 1.61 skrll {
888 1.61 skrll int error = 0;
889 1.61 skrll
890 1.61 skrll switch (cmd) {
891 1.61 skrll case MODULE_CMD_INIT:
892 1.61 skrll #ifdef _MODULE
893 1.61 skrll error = config_init_component(cfdriver_ioconf_udav,
894 1.61 skrll cfattach_ioconf_udav, cfdata_ioconf_udav);
895 1.61 skrll #endif
896 1.61 skrll return error;
897 1.61 skrll case MODULE_CMD_FINI:
898 1.61 skrll #ifdef _MODULE
899 1.61 skrll error = config_fini_component(cfdriver_ioconf_udav,
900 1.61 skrll cfattach_ioconf_udav, cfdata_ioconf_udav);
901 1.1 itojun #endif
902 1.61 skrll return error;
903 1.61 skrll default:
904 1.61 skrll return ENOTTY;
905 1.61 skrll }
906 1.1 itojun }
907