if_ncm.c revision 1.2 1 /* $NetBSD: if_ncm.c,v 1.2 2025/08/18 20:59:55 andvar Exp $ */
2
3 /*
4 * Copyright (c) 1997, 1998, 1999, 2000-2003 Bill Paul <wpaul (at) windriver.com>
5 * Copyright (c) 2003 Craig Boston
6 * Copyright (c) 2004 Daniel Hartmeier
7 * All rights reserved.
8 *
9 * Redistribution and use in source and binary forms, with or without
10 * modification, are permitted provided that the following conditions
11 * are met:
12 * 1. Redistributions of source code must retain the above copyright
13 * notice, this list of conditions and the following disclaimer.
14 * 2. Redistributions in binary form must reproduce the above copyright
15 * notice, this list of conditions and the following disclaimer in the
16 * documentation and/or other materials provided with the distribution.
17 * 3. All advertising materials mentioning features or use of this software
18 * must display the following acknowledgement:
19 * This product includes software developed by Bill Paul.
20 * 4. Neither the name of the author nor the names of any co-contributors
21 * may be used to endorse or promote products derived from this software
22 * without specific prior written permission.
23 *
24 * THIS SOFTWARE IS PROVIDED BY Bill Paul AND CONTRIBUTORS ``AS IS'' AND
25 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
27 * ARE DISCLAIMED. IN NO EVENT SHALL Bill Paul, THE VOICES IN HIS HEAD OR
28 * THE CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
29 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
30 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
31 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
32 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
33 * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
34 * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
35 */
36
37 /*
38 * USB Network Control Model (NCM)
39 * https://www.usb.org/sites/default/files/NCM10_012011.zip
40 */
41
42 #include <sys/cdefs.h>
43 __KERNEL_RCSID(0, "$NetBSD: if_ncm.c,v 1.2 2025/08/18 20:59:55 andvar Exp $");
44
45 #include <sys/param.h>
46 #include <sys/types.h>
47
48 #include <sys/device.h>
49
50 #include <dev/usb/usbnet.h>
51 #include <dev/usb/usbcdc.h>
52
53 #include <dev/usb/if_ncmreg.h>
54
55 struct ncm_softc {
56 struct usbnet ncm_un;
57 uint32_t sc_tx_seq;
58 };
59
60 static int ncm_match(device_t, cfdata_t, void *);
61 static void ncm_attach(device_t, device_t, void *);
62
63 CFATTACH_DECL_NEW(ncm, sizeof(struct ncm_softc), ncm_match, ncm_attach,
64 usbnet_detach, usbnet_activate);
65
66 static void ncm_uno_rx_loop(struct usbnet *, struct usbnet_chain *,
67 uint32_t);
68 static unsigned ncm_uno_tx_prepare(struct usbnet *, struct mbuf *,
69 struct usbnet_chain *);
70
71 static const struct usbnet_ops ncm_ops = {
72 .uno_tx_prepare = ncm_uno_tx_prepare,
73 .uno_rx_loop = ncm_uno_rx_loop,
74 };
75
76 static int
77 ncm_match(device_t parent, cfdata_t match, void *aux)
78 {
79 struct usbif_attach_arg *uiaa = aux;
80
81 if (uiaa->uiaa_class == UICLASS_CDC && uiaa->uiaa_subclass ==
82 UISUBCLASS_NETWORK_CONTROL_MODEL)
83 return UMATCH_IFACECLASS_GENERIC;
84
85 return UMATCH_NONE;
86 }
87
88 static void
89 ncm_attach(device_t parent, device_t self, void *aux)
90 {
91 struct ncm_softc *sc = device_private(self);
92 struct usbnet * const un = &sc->ncm_un;
93 struct usbif_attach_arg *uiaa = aux;
94 char *devinfop;
95 struct usbd_device *dev = uiaa->uiaa_device;
96 usb_interface_descriptor_t *id;
97 usb_endpoint_descriptor_t *ed;
98 const usb_cdc_union_descriptor_t *ud;
99 usb_config_descriptor_t *cd;
100 int data_ifcno;
101 int i, j, numalts;
102 const usb_cdc_ethernet_descriptor_t *ue;
103 char eaddr_str[USB_MAX_ENCODED_STRING_LEN];
104 usb_device_request_t req;
105 struct ncm_ntb_parameters np;
106
107
108 aprint_naive("\n");
109 aprint_normal("\n");
110 devinfop = usbd_devinfo_alloc(dev, 0);
111 aprint_normal_dev(self, "%s\n", devinfop);
112 usbd_devinfo_free(devinfop);
113
114 un->un_dev = self;
115 un->un_udev = dev;
116 un->un_sc = sc;
117 un->un_ops = &ncm_ops;
118 un->un_rx_xfer_flags = USBD_SHORT_XFER_OK;
119 un->un_tx_xfer_flags = USBD_FORCE_SHORT_XFER;
120
121 ud = (const usb_cdc_union_descriptor_t *)usb_find_desc_if(un->un_udev,
122 UDESC_CS_INTERFACE, UDESCSUB_CDC_UNION,
123 usbd_get_interface_descriptor(uiaa->uiaa_iface));
124 if (ud == NULL) {
125 aprint_error_dev(self, "no union descriptor\n");
126 return;
127 }
128 data_ifcno = ud->bSlaveInterface[0];
129
130 for (i = 0; i < uiaa->uiaa_nifaces; i++) {
131 if (uiaa->uiaa_ifaces[i] != NULL) {
132 id = usbd_get_interface_descriptor(
133 uiaa->uiaa_ifaces[i]);
134 if (id != NULL && id->bInterfaceNumber ==
135 data_ifcno) {
136 un->un_iface = uiaa->uiaa_ifaces[i];
137 uiaa->uiaa_ifaces[i] = NULL;
138 }
139 }
140 }
141 if (un->un_iface == NULL) {
142 aprint_error_dev(self, "no data interface\n");
143 return;
144 }
145
146 /*
147 * <quote>
148 * The Data Class interface of a networking device shall have a minimum
149 * of two interface settings. The first setting (the default interface
150 * setting) includes no endpoints and therefore no networking traffic is
151 * exchanged whenever the default interface setting is selected. One or
152 * more additional interface settings are used for normal operation, and
153 * therefore each includes a pair of endpoints (one IN, and one OUT) to
154 * exchange network traffic. Select an alternate interface setting to
155 * initialize the network aspects of the device and to enable the
156 * exchange of network traffic.
157 * </quote>
158 *
159 * Some devices, most notably cable modems, include interface settings
160 * that have no IN or OUT endpoint, therefore loop through the list of all
161 * available interface settings looking for one with both IN and OUT
162 * endpoints.
163 */
164 id = usbd_get_interface_descriptor(un->un_iface);
165 cd = usbd_get_config_descriptor(un->un_udev);
166 numalts = usbd_get_no_alts(cd, id->bInterfaceNumber);
167
168 for (j = 0; j < numalts; j++) {
169 if (usbd_set_interface(un->un_iface, j)) {
170 aprint_error_dev(un->un_dev,
171 "setting alternate interface failed\n");
172 return;
173 }
174 /* Find endpoints. */
175 id = usbd_get_interface_descriptor(un->un_iface);
176 un->un_ed[USBNET_ENDPT_RX] = un->un_ed[USBNET_ENDPT_TX] = 0;
177 for (i = 0; i < id->bNumEndpoints; i++) {
178 ed = usbd_interface2endpoint_descriptor(un->un_iface, i);
179 if (!ed) {
180 aprint_error_dev(self,
181 "could not read endpoint descriptor\n");
182 return;
183 }
184 if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
185 UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
186 un->un_ed[USBNET_ENDPT_RX] = ed->bEndpointAddress;
187 } else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT &&
188 UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
189 un->un_ed[USBNET_ENDPT_TX] = ed->bEndpointAddress;
190 } else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
191 UE_GET_XFERTYPE(ed->bmAttributes) == UE_INTERRUPT) {
192 /* XXX: CDC spec defines an interrupt pipe, but it is not
193 * needed for simple host-to-host applications. */
194 } else {
195 aprint_error_dev(self, "unexpected endpoint\n");
196 }
197 }
198 /* If we found something, try and use it... */
199 if (un->un_ed[USBNET_ENDPT_RX] != 0 && un->un_ed[USBNET_ENDPT_TX] != 0)
200 break;
201 }
202
203 if (un->un_ed[USBNET_ENDPT_RX] == 0) {
204 aprint_error_dev(self, "could not find data bulk in\n");
205 return;
206 }
207 if (un->un_ed[USBNET_ENDPT_TX] == 0) {
208 aprint_error_dev(self, "could not find data bulk out\n");
209 return;
210 }
211
212 ue = (const usb_cdc_ethernet_descriptor_t *)usb_find_desc_if(dev,
213 UDESC_CS_INTERFACE, UDESCSUB_CDC_ENF,
214 usbd_get_interface_descriptor(uiaa->uiaa_iface));
215 if (!ue || usbd_get_string(dev, ue->iMacAddress, eaddr_str) ||
216 ether_aton_r(un->un_eaddr, sizeof(un->un_eaddr), eaddr_str)) {
217 aprint_normal_dev(self, "faking address\n");
218 un->un_eaddr[0] = 0x2a;
219 uint32_t ticks = getticks();
220 memcpy(&un->un_eaddr[1], &ticks, sizeof(ticks));
221 un->un_eaddr[5] = (uint8_t)(device_unit(un->un_dev));
222 }
223
224 /* Query NTB transfers sizes */
225 req.bmRequestType = UT_READ_CLASS_INTERFACE;
226 req.bRequest = NCM_GET_NTB_PARAMETERS;
227 USETW(req.wValue, 0);
228 USETW(req.wIndex, uiaa->uiaa_ifaceno);
229 USETW(req.wLength, sizeof(np));
230 if (usbd_do_request(un->un_udev, &req, &np) != USBD_NORMAL_COMPLETION ||
231 UGETW(np.wLength) != sizeof(np)) {
232 aprint_error_dev(un->un_dev,
233 "NCM_GET_NTB_PARAMETERS failed\n");
234 return;
235 }
236 un->un_rx_list_cnt = 1;
237 un->un_tx_list_cnt = 1;
238 un->un_rx_bufsz = UGETDW(np.dwNtbInMaxSize);
239 un->un_tx_bufsz = UGETDW(np.dwNtbOutMaxSize);
240 if (un->un_tx_bufsz < NCM_MIN_TX_BUFSZ) {
241 aprint_error_dev(un->un_dev, "dwNtbOutMaxSize %u too small\n",
242 un->un_tx_bufsz);
243 return;
244 }
245
246 usbnet_attach(un);
247 usbnet_attach_ifp(un, IFF_SIMPLEX | IFF_BROADCAST | IFF_MULTICAST,
248 0, NULL);
249
250 /* XXX There is no link state, pretend we are always on */
251 if_link_state_change(usbnet_ifp(un), LINK_STATE_UP);
252 }
253
254 static void
255 ncm_uno_rx_loop(struct usbnet *un, struct usbnet_chain *c, uint32_t total_len)
256 {
257 struct ifnet *ifp = usbnet_ifp(un);
258 uint8_t *buf = c->unc_buf;
259 struct ncm_header16 *hdr;
260 struct ncm_dptab16 *ptr;
261 unsigned i;
262
263 if (total_len < sizeof(*hdr) + sizeof(*ptr)) {
264 aprint_error_dev(un->un_dev, "got a too small usb message\n");
265 if_statinc(ifp, if_ierrors);
266 return;
267 }
268 hdr = (struct ncm_header16 *)buf;
269 if (UGETDW(hdr->dwSignature) != NCM_HDR16_SIG) {
270 aprint_error_dev(un->un_dev,
271 "got a non NCM_HDR16_SIG header %08x\n",
272 UGETDW(hdr->dwSignature));
273 return;
274 }
275 const unsigned ndp_index = UGETW(hdr->wNdpIndex);
276
277 if (ndp_index < sizeof(*hdr) ||
278 ndp_index > total_len - sizeof(*ptr)) {
279 aprint_error_dev(un->un_dev, "ndp start offset %d "
280 "bigger than data sizeof(*hdr) %zu sizeof(*ptr) %zu "
281 "total_len %u\n", ndp_index,
282 sizeof(*hdr), sizeof(*ptr),
283 total_len);
284 if_statinc(ifp, if_ierrors);
285 return;
286 }
287 ptr = (struct ncm_dptab16 *)(buf + ndp_index);
288 if (UGETDW(ptr->dwSignature) != NCM_PTR16_SIG_NO_CRC) {
289 aprint_error_dev(un->un_dev, "ncm dptab16 signature %08x is "
290 "weird\n", UGETDW(ptr->dwSignature));
291 if_statinc(ifp, if_ierrors);
292 return;
293 }
294
295 if ((unsigned)UGETW(ptr->wLength) > total_len - ndp_index) {
296 aprint_error_dev(un->un_dev, "dptab16 wlength %u goes off end "
297 "ndp_index %u total_len %u\n", UGETW(ptr->wLength),
298 ndp_index, total_len);
299 if_statinc(ifp, if_ierrors);
300 return;
301 }
302
303 const unsigned max_datagrams = (UGETW(ptr->wLength) -
304 offsetof(struct ncm_dptab16, datagram))/sizeof(ptr->datagram[0]);
305 for (i = 0; i < max_datagrams; i++) {
306 uint16_t data_start = UGETW(ptr->datagram[i].wDatagramIndex);
307 uint16_t data_len = UGETW(ptr->datagram[i].wDatagramLength);
308
309 if (data_start == 0 || data_len == 0)
310 break;
311
312 if (data_len > total_len ||
313 data_start > total_len - data_len) {
314 aprint_error_dev(un->un_dev,
315 "datagram points out of buffer\n");
316 if_statinc(ifp, if_ierrors);
317 return;
318 }
319 usbnet_enqueue(un, buf + data_start, data_len, 0, 0, 0);
320 }
321 }
322
323 static unsigned
324 ncm_uno_tx_prepare(struct usbnet *un, struct mbuf *m, struct usbnet_chain *c)
325 {
326 struct ncm_softc *sc = un->un_sc;
327 struct ncm_dptab16 *ptr;
328 struct ncm_header16 *hdr;
329 unsigned hdr_len, len;
330
331 hdr_len = sizeof(*hdr) + sizeof(*ptr);
332 len = m->m_pkthdr.len;
333 KASSERT(hdr_len <= un->un_tx_bufsz);
334 KASSERT(len <= un->un_tx_bufsz - hdr_len);
335
336 hdr = (struct ncm_header16 *)c->unc_buf;
337 ptr = (struct ncm_dptab16 *)(hdr + 1);
338 memset(hdr, 0, sizeof(*hdr));
339 memset(ptr, 0, sizeof(*ptr));
340
341 USETDW(hdr->dwSignature, NCM_HDR16_SIG);
342 USETW(hdr->wHeaderLength, sizeof(*hdr));
343 USETW(hdr->wSequence, sc->sc_tx_seq);
344 sc->sc_tx_seq++;
345
346 USETW(hdr->wBlockLength, hdr_len + len);
347 USETW(hdr->wNdpIndex, sizeof(*hdr));
348
349 USETDW(ptr->dwSignature, NCM_PTR16_SIG_NO_CRC);
350 USETW(ptr->wLength, sizeof(*ptr));
351 USETW(ptr->wNextNdpIndex, 0);
352
353 USETW(ptr->datagram[0].wDatagramIndex, hdr_len);
354 USETW(ptr->datagram[0].wDatagramLength, len);
355
356 USETW(ptr->datagram[1].wDatagramIndex, 0);
357 USETW(ptr->datagram[1].wDatagramLength, 0);
358
359 m_copydata(m, 0, len, c->unc_buf + hdr_len);
360
361 return len + hdr_len;
362 }
363
364 #ifdef _MODULE
365 #include "ioconf.c"
366 #endif
367
368 USBNET_MODULE(ncm)
369