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