ofnet.c revision 1.12
1 /* $NetBSD: ofnet.c,v 1.12 1998/01/27 23:55:18 cgd 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 "bpfilter.h" 35 36 #include <sys/param.h> 37 #include <sys/device.h> 38 #include <sys/ioctl.h> 39 #include <sys/mbuf.h> 40 #include <sys/socket.h> 41 #include <sys/syslog.h> 42 43 #include <net/if.h> 44 #include <net/if_ether.h> 45 46 #ifdef INET 47 #include <netinet/in.h> 48 #include <netinet/if_inarp.h> 49 #endif 50 51 #if NBPFILTER > 0 52 #include <net/bpf.h> 53 #include <net/bpfdesc.h> 54 #endif 55 56 #include <dev/ofw/openfirm.h> 57 58 #if NIPKDB_OFN > 0 59 #include <ipkdb/ipkdb.h> 60 #include <machine/ipkdb.h> 61 62 struct cfattach ipkdb_ofn_ca = { 63 0, ipkdb_probe, ipkdb_attach 64 }; 65 66 static struct ipkdb_if *kifp; 67 static struct ofn_softc *ipkdb_of; 68 69 static int ipkdbprobe __P((struct cfdata *, void *)); 70 #endif 71 72 struct ofn_softc { 73 struct device sc_dev; 74 int sc_phandle; 75 int sc_ihandle; 76 struct ethercom sc_ethercom; 77 }; 78 79 static int ofnprobe __P((struct device *, struct cfdata *, void *)); 80 static void ofnattach __P((struct device *, struct device *, void *)); 81 82 struct cfattach ofnet_ca = { 83 sizeof(struct ofn_softc), ofnprobe, ofnattach 84 }; 85 86 static void ofnread __P((struct ofn_softc *)); 87 static void ofntimer __P((struct ofn_softc *)); 88 static void ofninit __P((struct ofn_softc *)); 89 static void ofnstop __P((struct ofn_softc *)); 90 91 static void ofnstart __P((struct ifnet *)); 92 static int ofnioctl __P((struct ifnet *, u_long, caddr_t)); 93 static void ofnwatchdog __P((struct ifnet *)); 94 95 static int 96 ofnprobe(parent, match, aux) 97 struct device *parent; 98 struct cfdata *match; 99 void *aux; 100 { 101 struct ofprobe *ofp = aux; 102 char type[32]; 103 int l; 104 105 #if NIPKDB_OFN > 0 106 if (!parent) 107 return ipkdbprobe(match, aux); 108 #endif 109 if ((l = OF_getprop(ofp->phandle, "device_type", type, sizeof type - 1)) < 0) 110 return 0; 111 if (l >= sizeof type) 112 return 0; 113 type[l] = 0; 114 if (strcmp(type, "network")) 115 return 0; 116 return 1; 117 } 118 119 static void 120 ofnattach(parent, self, aux) 121 struct device *parent, *self; 122 void *aux; 123 { 124 struct ofn_softc *of = (void *)self; 125 struct ifnet *ifp = &of->sc_ethercom.ec_if; 126 struct ofprobe *ofp = aux; 127 char path[256]; 128 int l; 129 u_int8_t myaddr[ETHER_ADDR_LEN]; 130 131 of->sc_phandle = ofp->phandle; 132 #if NIPKDB_OFN > 0 133 if (kifp 134 && kifp->unit - 1 == of->sc_dev.dv_unit 135 && OF_instance_to_package(kifp->port) == ofp->phandle) { 136 ipkdb_of = of; 137 of->sc_ihandle = kifp->port; 138 } else 139 #endif 140 if ((l = OF_package_to_path(ofp->phandle, path, sizeof path - 1)) < 0 141 || l >= sizeof path 142 || (path[l] = 0, !(of->sc_ihandle = OF_open(path)))) 143 panic("ofnattach: unable to open"); 144 if (OF_getprop(ofp->phandle, "mac-address", 145 myaddr, sizeof myaddr) 146 < 0) 147 panic("ofnattach: no mac-address"); 148 printf(": address %s\n", ether_sprintf(myaddr)); 149 150 bcopy(of->sc_dev.dv_xname, ifp->if_xname, IFNAMSIZ); 151 ifp->if_softc = of; 152 ifp->if_start = ofnstart; 153 ifp->if_ioctl = ofnioctl; 154 ifp->if_watchdog = ofnwatchdog; 155 ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_NOTRAILERS; 156 157 if_attach(ifp); 158 ether_ifattach(ifp, myaddr); 159 160 #if NBPFILTER > 0 161 bpfattach(&ifp->if_bpf, ifp, DLT_EN10MB, sizeof(struct ether_header)); 162 #endif 163 164 dk_establish(0, self); /* XXX */ 165 } 166 167 static char buf[ETHERMTU + sizeof(struct ether_header)]; 168 169 static void 170 ofnread(of) 171 struct ofn_softc *of; 172 { 173 struct ifnet *ifp = &of->sc_ethercom.ec_if; 174 struct ether_header *eh; 175 struct mbuf *m, **mp, *head; 176 int l, len; 177 char *bufp; 178 179 #if NIPKDB_OFN > 0 180 ipkdbrint(kifp, ifp); 181 #endif 182 while (1) { 183 if ((len = OF_read(of->sc_ihandle, buf, sizeof buf)) < 0) { 184 if (len == -2 || len == 0) 185 return; 186 ifp->if_ierrors++; 187 continue; 188 } 189 if (len < sizeof(struct ether_header)) { 190 ifp->if_ierrors++; 191 continue; 192 } 193 bufp = buf; 194 195 /* Allocate a header mbuf */ 196 MGETHDR(m, M_DONTWAIT, MT_DATA); 197 if (m == 0) { 198 ifp->if_ierrors++; 199 continue; 200 } 201 m->m_pkthdr.rcvif = ifp; 202 m->m_pkthdr.len = len; 203 l = MHLEN; 204 head = 0; 205 mp = &head; 206 207 while (len > 0) { 208 if (head) { 209 MGET(m, M_DONTWAIT, MT_DATA); 210 if (m == 0) { 211 ifp->if_ierrors++; 212 m_freem(head); 213 head = 0; 214 break; 215 } 216 l = MLEN; 217 } 218 if (len >= MINCLSIZE) { 219 MCLGET(m, M_DONTWAIT); 220 if ((m->m_flags & M_EXT) == 0) { 221 ifp->if_ierrors++; 222 m_free(m); 223 m_freem(head); 224 head = 0; 225 break; 226 } 227 l = MCLBYTES; 228 } 229 230 /* 231 * Make sure the data after the Ethernet header 232 * is aligned. 233 * 234 * XXX Assumes the device is an ethernet, but 235 * XXX then so does other code in this driver. 236 */ 237 if (head == NULL) { 238 caddr_t newdata = (caddr_t)ALIGN(m->m_data + 239 sizeof(struct ether_header)) - 240 sizeof(struct ether_header); 241 l -= newdata - m->m_data; 242 m->m_data = newdata; 243 } 244 245 m->m_len = l = min(len, l); 246 bcopy(bufp, mtod(m, char *), l); 247 bufp += l; 248 len -= l; 249 *mp = m; 250 mp = &m->m_next; 251 } 252 if (head == 0) 253 continue; 254 eh = mtod(head, struct ether_header *); 255 256 #if NBPFILTER > 0 257 if (ifp->if_bpf) 258 bpf_mtap(ifp->if_bpf, m); 259 #endif 260 m_adj(head, sizeof(struct ether_header)); 261 ifp->if_ipackets++; 262 ether_input(ifp, eh, head); 263 } 264 } 265 266 static void 267 ofntimer(of) 268 struct ofn_softc *of; 269 { 270 ofnread(of); 271 timeout(ofntimer, of, 1); 272 } 273 274 static void 275 ofninit(of) 276 struct ofn_softc *of; 277 { 278 struct ifnet *ifp = &of->sc_ethercom.ec_if; 279 280 if (ifp->if_flags & IFF_RUNNING) 281 return; 282 283 ifp->if_flags |= IFF_RUNNING; 284 /* Start reading from interface */ 285 ofntimer(of); 286 /* Attempt to start output */ 287 ofnstart(ifp); 288 } 289 290 static void 291 ofnstop(of) 292 struct ofn_softc *of; 293 { 294 untimeout(ofntimer, of); 295 of->sc_ethercom.ec_if.if_flags &= ~IFF_RUNNING; 296 } 297 298 static void 299 ofnstart(ifp) 300 struct ifnet *ifp; 301 { 302 struct ofn_softc *of = ifp->if_softc; 303 struct mbuf *m, *m0; 304 char *bufp; 305 int len; 306 307 if (!(ifp->if_flags & IFF_RUNNING)) 308 return; 309 310 for (;;) { 311 /* First try reading any packets */ 312 ofnread(of); 313 314 /* Now get the first packet on the queue */ 315 IF_DEQUEUE(&ifp->if_snd, m0); 316 if (!m0) 317 return; 318 319 if (!(m0->m_flags & M_PKTHDR)) 320 panic("ofnstart: no header mbuf"); 321 len = m0->m_pkthdr.len; 322 323 #if NBPFILTER > 0 324 if (ifp->if_bpf) 325 bpf_mtap(ifp->if_bpf, m0); 326 #endif 327 328 if (len > ETHERMTU + sizeof(struct ether_header)) { 329 /* packet too large, toss it */ 330 ifp->if_oerrors++; 331 m_freem(m0); 332 continue; 333 } 334 335 for (bufp = buf; m = m0;) { 336 bcopy(mtod(m, char *), bufp, m->m_len); 337 bufp += m->m_len; 338 MFREE(m, m0); 339 } 340 if (OF_write(of->sc_ihandle, buf, bufp - buf) != bufp - buf) 341 ifp->if_oerrors++; 342 else 343 ifp->if_opackets++; 344 } 345 } 346 347 static int 348 ofnioctl(ifp, cmd, data) 349 struct ifnet *ifp; 350 u_long cmd; 351 caddr_t data; 352 { 353 struct ofn_softc *of = ifp->if_softc; 354 struct ifaddr *ifa = (struct ifaddr *)data; 355 struct ifreq *ifr = (struct ifreq *)data; 356 int error = 0; 357 358 switch (cmd) { 359 case SIOCSIFADDR: 360 ifp->if_flags |= IFF_UP; 361 362 switch (ifa->ifa_addr->sa_family) { 363 #ifdef INET 364 case AF_INET: 365 arp_ifinit(ifp, ifa); 366 break; 367 #endif 368 default: 369 break; 370 } 371 ofninit(of); 372 break; 373 case SIOCSIFFLAGS: 374 if (!(ifp->if_flags & IFF_UP) 375 && (ifp->if_flags & IFF_RUNNING)) { 376 /* If interface is down, but running, stop it. */ 377 ofnstop(of); 378 } else if ((ifp->if_flags & IFF_UP) 379 && !(ifp->if_flags & IFF_RUNNING)) { 380 /* If interface is up, but not running, start it. */ 381 ofninit(of); 382 } else { 383 /* Other flags are ignored. */ 384 } 385 break; 386 default: 387 error = EINVAL; 388 break; 389 } 390 return error; 391 } 392 393 static void 394 ofnwatchdog(ifp) 395 struct ifnet *ifp; 396 { 397 struct ofn_softc *of = ifp->if_softc; 398 399 log(LOG_ERR, "%s: device timeout\n", of->sc_dev.dv_xname); 400 ifp->if_oerrors++; 401 ofnstop(of); 402 ofninit(of); 403 } 404 405 #if NIPKDB_OFN > 0 406 static void 407 ipkdbofstart(kip) 408 struct ipkdb_if *kip; 409 { 410 int unit = kip->unit - 1; 411 412 if (ipkdb_of) 413 ipkdbattach(kip, &ipkdb_of->sc_ethercom); 414 } 415 416 static void 417 ipkdbofleave(kip) 418 struct ipkdb_if *kip; 419 { 420 } 421 422 static int 423 ipkdbofrcv(kip, buf, poll) 424 struct ipkdb_if *kip; 425 u_char *buf; 426 int poll; 427 { 428 int l; 429 430 do { 431 l = OF_read(kip->port, buf, ETHERMTU); 432 if (l < 0) 433 l = 0; 434 } while (!poll && !l); 435 return l; 436 } 437 438 static void 439 ipkdbofsend(kip, buf, l) 440 struct ipkdb_if *kip; 441 u_char *buf; 442 int l; 443 { 444 OF_write(kip->port, buf, l); 445 } 446 447 static int 448 ipkdbprobe(match, aux) 449 struct cfdata *match; 450 void *aux; 451 { 452 struct ipkdb_if *kip = aux; 453 static char name[256]; 454 int len; 455 int phandle; 456 457 kip->unit = match->cf_unit + 1; 458 459 if (!(kip->port = OF_open("net"))) 460 return -1; 461 if ((len = OF_instance_to_path(kip->port, name, sizeof name - 1)) < 0 462 || len >= sizeof name) 463 return -1; 464 name[len] = 0; 465 if ((phandle = OF_instance_to_package(kip->port)) == -1) 466 return -1; 467 if (OF_getprop(phandle, "mac-address", kip->myenetaddr, sizeof kip->myenetaddr) 468 < 0) 469 return -1; 470 471 kip->flags |= IPKDB_MYHW; 472 kip->name = name; 473 kip->start = ipkdbofstart; 474 kip->leave = ipkdbofleave; 475 kip->receive = ipkdbofrcv; 476 kip->send = ipkdbofsend; 477 478 kifp = kip; 479 480 return 0; 481 } 482 #endif 483
Indexes created Tue Sep 30 20:09:53 GMT 2025