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