ofnet.c revision 1.15
1 /* $NetBSD: ofnet.c,v 1.15 1998/07/05 00:51:22 jonathan Exp $ */ 2 3 /* 4 * Copyright (C) 1995, 1996 Wolfgang Solfrank. 5 * Copyright (C) 1995, 1996 TooLs GmbH. 6 * All rights reserved. 7 * 8 * Redistribution and use in source and binary forms, with or without 9 * modification, are permitted provided that the following conditions 10 * are met: 11 * 1. Redistributions of source code must retain the above copyright 12 * notice, this list of conditions and the following disclaimer. 13 * 2. Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in the 15 * documentation and/or other materials provided with the distribution. 16 * 3. All advertising materials mentioning features or use of this software 17 * must display the following acknowledgement: 18 * This product includes software developed by TooLs GmbH. 19 * 4. The name of TooLs GmbH may not be used to endorse or promote products 20 * derived from this software without specific prior written permission. 21 * 22 * THIS SOFTWARE IS PROVIDED BY TOOLS GMBH ``AS IS'' AND ANY EXPRESS OR 23 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 24 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 25 * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 26 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 27 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; 28 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, 29 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR 30 * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF 31 * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 32 */ 33 #include "ofnet.h" 34 #include "opt_inet.h" 35 #include "bpfilter.h" 36 37 #include <sys/param.h> 38 #include <sys/systm.h> 39 #include <sys/device.h> 40 #include <sys/ioctl.h> 41 #include <sys/mbuf.h> 42 #include <sys/socket.h> 43 #include <sys/syslog.h> 44 45 #include <net/if.h> 46 #include <net/if_ether.h> 47 48 #ifdef INET 49 #include <netinet/in.h> 50 #include <netinet/if_inarp.h> 51 #endif 52 53 #if NBPFILTER > 0 54 #include <net/bpf.h> 55 #include <net/bpfdesc.h> 56 #endif 57 58 #include <dev/ofw/openfirm.h> 59 60 #if NIPKDB_OFN > 0 61 #include <ipkdb/ipkdb.h> 62 #include <machine/ipkdb.h> 63 64 struct cfattach ipkdb_ofn_ca = { 65 0, ipkdb_probe, ipkdb_attach 66 }; 67 68 static struct ipkdb_if *kifp; 69 static struct ofnet_softc *ipkdb_of; 70 71 static int ipkdbprobe __P((struct cfdata *, void *)); 72 #endif 73 74 struct ofnet_softc { 75 struct device sc_dev; 76 int sc_phandle; 77 int sc_ihandle; 78 struct ethercom sc_ethercom; 79 }; 80 81 static int ofnet_match __P((struct device *, struct cfdata *, void *)); 82 static void ofnet_attach __P((struct device *, struct device *, void *)); 83 84 struct cfattach ofnet_ca = { 85 sizeof(struct ofnet_softc), ofnet_match, ofnet_attach 86 }; 87 88 static void ofnet_read __P((struct ofnet_softc *)); 89 static void ofnet_timer __P((struct ofnet_softc *)); 90 static void ofnet_init __P((struct ofnet_softc *)); 91 static void ofnet_stop __P((struct ofnet_softc *)); 92 93 static void ofnet_start __P((struct ifnet *)); 94 static int ofnet_ioctl __P((struct ifnet *, u_long, caddr_t)); 95 static void ofnet_watchdog __P((struct ifnet *)); 96 97 static int 98 ofnet_match(parent, match, aux) 99 struct device *parent; 100 struct cfdata *match; 101 void *aux; 102 { 103 struct ofbus_attach_args *oba = aux; 104 char type[32]; 105 int l; 106 107 #if NIPKDB_OFN > 0 108 if (!parent) 109 return ipkdbprobe(match, aux); 110 #endif 111 if (strcmp(oba->oba_busname, "ofw")) 112 return (0); 113 if ((l = OF_getprop(oba->oba_phandle, "device_type", type, 114 sizeof type - 1)) < 0) 115 return 0; 116 if (l >= sizeof type) 117 return 0; 118 type[l] = 0; 119 if (strcmp(type, "network")) 120 return 0; 121 return 1; 122 } 123 124 static void 125 ofnet_attach(parent, self, aux) 126 struct device *parent, *self; 127 void *aux; 128 { 129 struct ofnet_softc *of = (void *)self; 130 struct ifnet *ifp = &of->sc_ethercom.ec_if; 131 struct ofbus_attach_args *oba = aux; 132 char path[256]; 133 int l; 134 u_int8_t myaddr[ETHER_ADDR_LEN]; 135 136 of->sc_phandle = oba->oba_phandle; 137 #if NIPKDB_OFN > 0 138 if (kifp && 139 kifp->unit - 1 == of->sc_dev.dv_unit && 140 OF_instance_to_package(kifp->port) == oba->oba_phandle) { 141 ipkdb_of = of; 142 of->sc_ihandle = kifp->port; 143 } else 144 #endif 145 if ((l = OF_package_to_path(oba->oba_phandle, path, 146 sizeof path - 1)) < 0 || 147 l >= sizeof path || 148 (path[l] = 0, !(of->sc_ihandle = OF_open(path)))) 149 panic("ofnet_attach: unable to open"); 150 if (OF_getprop(oba->oba_phandle, "mac-address", myaddr, 151 sizeof myaddr) < 0) 152 panic("ofnet_attach: no mac-address"); 153 printf(": address %s\n", ether_sprintf(myaddr)); 154 155 bcopy(of->sc_dev.dv_xname, ifp->if_xname, IFNAMSIZ); 156 ifp->if_softc = of; 157 ifp->if_start = ofnet_start; 158 ifp->if_ioctl = ofnet_ioctl; 159 ifp->if_watchdog = ofnet_watchdog; 160 ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_NOTRAILERS; 161 162 if_attach(ifp); 163 ether_ifattach(ifp, myaddr); 164 165 #if NBPFILTER > 0 166 bpfattach(&ifp->if_bpf, ifp, DLT_EN10MB, sizeof(struct ether_header)); 167 #endif 168 169 dk_establish(0, self); /* XXX */ 170 } 171 172 static char buf[ETHERMTU + sizeof(struct ether_header)]; 173 174 static void 175 ofnet_read(of) 176 struct ofnet_softc *of; 177 { 178 struct ifnet *ifp = &of->sc_ethercom.ec_if; 179 struct ether_header *eh; 180 struct mbuf *m, **mp, *head; 181 int l, len; 182 char *bufp; 183 184 #if NIPKDB_OFN > 0 185 ipkdbrint(kifp, ifp); 186 #endif 187 while (1) { 188 if ((len = OF_read(of->sc_ihandle, buf, sizeof buf)) < 0) { 189 if (len == -2 || len == 0) 190 return; 191 ifp->if_ierrors++; 192 continue; 193 } 194 if (len < sizeof(struct ether_header)) { 195 ifp->if_ierrors++; 196 continue; 197 } 198 bufp = buf; 199 200 /* Allocate a header mbuf */ 201 MGETHDR(m, M_DONTWAIT, MT_DATA); 202 if (m == 0) { 203 ifp->if_ierrors++; 204 continue; 205 } 206 m->m_pkthdr.rcvif = ifp; 207 m->m_pkthdr.len = len; 208 l = MHLEN; 209 head = 0; 210 mp = &head; 211 212 while (len > 0) { 213 if (head) { 214 MGET(m, M_DONTWAIT, MT_DATA); 215 if (m == 0) { 216 ifp->if_ierrors++; 217 m_freem(head); 218 head = 0; 219 break; 220 } 221 l = MLEN; 222 } 223 if (len >= MINCLSIZE) { 224 MCLGET(m, M_DONTWAIT); 225 if ((m->m_flags & M_EXT) == 0) { 226 ifp->if_ierrors++; 227 m_free(m); 228 m_freem(head); 229 head = 0; 230 break; 231 } 232 l = MCLBYTES; 233 } 234 235 /* 236 * Make sure the data after the Ethernet header 237 * is aligned. 238 * 239 * XXX Assumes the device is an ethernet, but 240 * XXX then so does other code in this driver. 241 */ 242 if (head == NULL) { 243 caddr_t newdata = (caddr_t)ALIGN(m->m_data + 244 sizeof(struct ether_header)) - 245 sizeof(struct ether_header); 246 l -= newdata - m->m_data; 247 m->m_data = newdata; 248 } 249 250 m->m_len = l = min(len, l); 251 bcopy(bufp, mtod(m, char *), l); 252 bufp += l; 253 len -= l; 254 *mp = m; 255 mp = &m->m_next; 256 } 257 if (head == 0) 258 continue; 259 eh = mtod(head, struct ether_header *); 260 261 #if NBPFILTER > 0 262 if (ifp->if_bpf) 263 bpf_mtap(ifp->if_bpf, m); 264 #endif 265 m_adj(head, sizeof(struct ether_header)); 266 ifp->if_ipackets++; 267 ether_input(ifp, eh, head); 268 } 269 } 270 271 static void 272 ofnet_timer(of) 273 struct ofnet_softc *of; 274 { 275 ofnet_read(of); 276 timeout(ofnet_timer, of, 1); 277 } 278 279 static void 280 ofnet_init(of) 281 struct ofnet_softc *of; 282 { 283 struct ifnet *ifp = &of->sc_ethercom.ec_if; 284 285 if (ifp->if_flags & IFF_RUNNING) 286 return; 287 288 ifp->if_flags |= IFF_RUNNING; 289 /* Start reading from interface */ 290 ofnet_timer(of); 291 /* Attempt to start output */ 292 ofnet_start(ifp); 293 } 294 295 static void 296 ofnet_stop(of) 297 struct ofnet_softc *of; 298 { 299 untimeout(ofnet_timer, of); 300 of->sc_ethercom.ec_if.if_flags &= ~IFF_RUNNING; 301 } 302 303 static void 304 ofnet_start(ifp) 305 struct ifnet *ifp; 306 { 307 struct ofnet_softc *of = ifp->if_softc; 308 struct mbuf *m, *m0; 309 char *bufp; 310 int len; 311 312 if (!(ifp->if_flags & IFF_RUNNING)) 313 return; 314 315 for (;;) { 316 /* First try reading any packets */ 317 ofnet_read(of); 318 319 /* Now get the first packet on the queue */ 320 IF_DEQUEUE(&ifp->if_snd, m0); 321 if (!m0) 322 return; 323 324 if (!(m0->m_flags & M_PKTHDR)) 325 panic("ofnet_start: no header mbuf"); 326 len = m0->m_pkthdr.len; 327 328 #if NBPFILTER > 0 329 if (ifp->if_bpf) 330 bpf_mtap(ifp->if_bpf, m0); 331 #endif 332 333 if (len > ETHERMTU + sizeof(struct ether_header)) { 334 /* packet too large, toss it */ 335 ifp->if_oerrors++; 336 m_freem(m0); 337 continue; 338 } 339 340 for (bufp = buf; m = m0;) { 341 bcopy(mtod(m, char *), bufp, m->m_len); 342 bufp += m->m_len; 343 MFREE(m, m0); 344 } 345 if (OF_write(of->sc_ihandle, buf, bufp - buf) != bufp - buf) 346 ifp->if_oerrors++; 347 else 348 ifp->if_opackets++; 349 } 350 } 351 352 static int 353 ofnet_ioctl(ifp, cmd, data) 354 struct ifnet *ifp; 355 u_long cmd; 356 caddr_t data; 357 { 358 struct ofnet_softc *of = ifp->if_softc; 359 struct ifaddr *ifa = (struct ifaddr *)data; 360 struct ifreq *ifr = (struct ifreq *)data; 361 int error = 0; 362 363 switch (cmd) { 364 case SIOCSIFADDR: 365 ifp->if_flags |= IFF_UP; 366 367 switch (ifa->ifa_addr->sa_family) { 368 #ifdef INET 369 case AF_INET: 370 arp_ifinit(ifp, ifa); 371 break; 372 #endif 373 default: 374 break; 375 } 376 ofnet_init(of); 377 break; 378 case SIOCSIFFLAGS: 379 if ((ifp->if_flags & IFF_UP) == 0 && 380 (ifp->if_flags & IFF_RUNNING) != 0) { 381 /* If interface is down, but running, stop it. */ 382 ofnet_stop(of); 383 } else if ((ifp->if_flags & IFF_UP) != 0 && 384 (ifp->if_flags & IFF_RUNNING) == 0) { 385 /* If interface is up, but not running, start it. */ 386 ofnet_init(of); 387 } else { 388 /* Other flags are ignored. */ 389 } 390 break; 391 default: 392 error = EINVAL; 393 break; 394 } 395 return error; 396 } 397 398 static void 399 ofnet_watchdog(ifp) 400 struct ifnet *ifp; 401 { 402 struct ofnet_softc *of = ifp->if_softc; 403 404 log(LOG_ERR, "%s: device timeout\n", of->sc_dev.dv_xname); 405 ifp->if_oerrors++; 406 ofnet_stop(of); 407 ofnet_init(of); 408 } 409 410 #if NIPKDB_OFN > 0 411 static void 412 ipkdbofstart(kip) 413 struct ipkdb_if *kip; 414 { 415 int unit = kip->unit - 1; 416 417 if (ipkdb_of) 418 ipkdbattach(kip, &ipkdb_of->sc_ethercom); 419 } 420 421 static void 422 ipkdbofleave(kip) 423 struct ipkdb_if *kip; 424 { 425 } 426 427 static int 428 ipkdbofrcv(kip, buf, poll) 429 struct ipkdb_if *kip; 430 u_char *buf; 431 int poll; 432 { 433 int l; 434 435 do { 436 l = OF_read(kip->port, buf, ETHERMTU); 437 if (l < 0) 438 l = 0; 439 } while (!poll && !l); 440 return l; 441 } 442 443 static void 444 ipkdbofsend(kip, buf, l) 445 struct ipkdb_if *kip; 446 u_char *buf; 447 int l; 448 { 449 OF_write(kip->port, buf, l); 450 } 451 452 static int 453 ipkdbprobe(match, aux) 454 struct cfdata *match; 455 void *aux; 456 { 457 struct ipkdb_if *kip = aux; 458 static char name[256]; 459 int len; 460 int phandle; 461 462 kip->unit = match->cf_unit + 1; 463 464 if (!(kip->port = OF_open("net"))) 465 return -1; 466 if ((len = OF_instance_to_path(kip->port, name, sizeof name - 1)) < 0 || 467 len >= sizeof name) 468 return -1; 469 name[len] = 0; 470 if ((phandle = OF_instance_to_package(kip->port)) == -1) 471 return -1; 472 if (OF_getprop(phandle, "mac-address", kip->myenetaddr, 473 sizeof kip->myenetaddr) < 0) 474 return -1; 475 476 kip->flags |= IPKDB_MYHW; 477 kip->name = name; 478 kip->start = ipkdbofstart; 479 kip->leave = ipkdbofleave; 480 kip->receive = ipkdbofrcv; 481 kip->send = ipkdbofsend; 482 483 kifp = kip; 484 485 return 0; 486 } 487 #endif 488
Indexes created Tue Sep 30 17:09:57 GMT 2025