ofnet.c revision 1.17 
1/*	$NetBSD: ofnet.c,v 1.17 1999/05/18 23:52:57 thorpej 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
64struct cfattach ipkdb_ofn_ca = {
65	0, ipkdb_probe, ipkdb_attach
66};
67
68static struct ipkdb_if *kifp;
69static struct ofnet_softc *ipkdb_of;
70
71static int ipkdbprobe __P((struct cfdata *, void *));
72#endif
73
74struct ofnet_softc {
75	struct device sc_dev;
76	int sc_phandle;
77	int sc_ihandle;
78	struct ethercom sc_ethercom;
79};
80
81static int ofnet_match __P((struct device *, struct cfdata *, void *));
82static void ofnet_attach __P((struct device *, struct device *, void *));
83
84struct cfattach ofnet_ca = {
85	sizeof(struct ofnet_softc), ofnet_match, ofnet_attach
86};
87
88static void ofnet_read __P((struct ofnet_softc *));
89static void ofnet_timer __P((void *));
90static void ofnet_init __P((struct ofnet_softc *));
91static void ofnet_stop __P((struct ofnet_softc *));
92
93static void ofnet_start __P((struct ifnet *));
94static int ofnet_ioctl __P((struct ifnet *, u_long, caddr_t));
95static void ofnet_watchdog __P((struct ifnet *));
96
97static int
98ofnet_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
124static void
125ofnet_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
172static char buf[ETHERMTU + sizeof(struct ether_header)];
173
174static void
175ofnet_read(of)
176	struct ofnet_softc *of;
177{
178	struct ifnet *ifp = &of->sc_ethercom.ec_if;
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 || len == 0)
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					ifp->if_ierrors++;
226					m_free(m);
227					m_freem(head);
228					head = 0;
229					break;
230				}
231				l = MCLBYTES;
232			}
233
234			/*
235			 * Make sure the data after the Ethernet header
236			 * is aligned.
237			 *
238			 * XXX Assumes the device is an ethernet, but
239			 * XXX then so does other code in this driver.
240			 */
241			if (head == NULL) {
242				caddr_t newdata = (caddr_t)ALIGN(m->m_data +
243				      sizeof(struct ether_header)) -
244				    sizeof(struct ether_header);
245				l -= newdata - m->m_data;
246				m->m_data = newdata;
247			}
248
249			m->m_len = l = min(len, l);
250			bcopy(bufp, mtod(m, char *), l);
251			bufp += l;
252			len -= l;
253			*mp = m;
254			mp = &m->m_next;
255		}
256		if (head == 0)
257			continue;
258
259#if NBPFILTER > 0
260		if (ifp->if_bpf)
261			bpf_mtap(ifp->if_bpf, m);
262#endif
263		ifp->if_ipackets++;
264		(*ifp->if_input)(ifp, head);
265	}
266}
267
268static void
269ofnet_timer(arg)
270	void *arg;
271{
272	struct ofnet_softc *of = arg;
273
274	ofnet_read(of);
275	timeout(ofnet_timer, of, 1);
276}
277
278static void
279ofnet_init(of)
280	struct ofnet_softc *of;
281{
282	struct ifnet *ifp = &of->sc_ethercom.ec_if;
283
284	if (ifp->if_flags & IFF_RUNNING)
285		return;
286
287	ifp->if_flags |= IFF_RUNNING;
288	/* Start reading from interface */
289	ofnet_timer(of);
290	/* Attempt to start output */
291	ofnet_start(ifp);
292}
293
294static void
295ofnet_stop(of)
296	struct ofnet_softc *of;
297{
298	untimeout(ofnet_timer, of);
299	of->sc_ethercom.ec_if.if_flags &= ~IFF_RUNNING;
300}
301
302static void
303ofnet_start(ifp)
304	struct ifnet *ifp;
305{
306	struct ofnet_softc *of = ifp->if_softc;
307	struct mbuf *m, *m0;
308	char *bufp;
309	int len;
310
311	if (!(ifp->if_flags & IFF_RUNNING))
312		return;
313
314	for (;;) {
315		/* First try reading any packets */
316		ofnet_read(of);
317
318		/* Now get the first packet on the queue */
319		IF_DEQUEUE(&ifp->if_snd, m0);
320		if (!m0)
321			return;
322
323		if (!(m0->m_flags & M_PKTHDR))
324			panic("ofnet_start: no header mbuf");
325		len = m0->m_pkthdr.len;
326
327#if NBPFILTER > 0
328		if (ifp->if_bpf)
329			bpf_mtap(ifp->if_bpf, m0);
330#endif
331
332		if (len > ETHERMTU + sizeof(struct ether_header)) {
333			/* packet too large, toss it */
334			ifp->if_oerrors++;
335			m_freem(m0);
336			continue;
337		}
338
339		for (bufp = buf; m = m0;) {
340			bcopy(mtod(m, char *), bufp, m->m_len);
341			bufp += m->m_len;
342			MFREE(m, m0);
343		}
344		if (OF_write(of->sc_ihandle, buf, bufp - buf) != bufp - buf)
345			ifp->if_oerrors++;
346		else
347			ifp->if_opackets++;
348	}
349}
350
351static int
352ofnet_ioctl(ifp, cmd, data)
353	struct ifnet *ifp;
354	u_long cmd;
355	caddr_t data;
356{
357	struct ofnet_softc *of = ifp->if_softc;
358	struct ifaddr *ifa = (struct ifaddr *)data;
359	struct ifreq *ifr = (struct ifreq *)data;
360	int error = 0;
361
362	switch (cmd) {
363	case SIOCSIFADDR:
364		ifp->if_flags |= IFF_UP;
365
366		switch (ifa->ifa_addr->sa_family) {
367#ifdef	INET
368		case AF_INET:
369			arp_ifinit(ifp, ifa);
370			break;
371#endif
372		default:
373			break;
374		}
375		ofnet_init(of);
376		break;
377	case SIOCSIFFLAGS:
378		if ((ifp->if_flags & IFF_UP) == 0 &&
379		    (ifp->if_flags & IFF_RUNNING) != 0) {
380			/* If interface is down, but running, stop it. */
381			ofnet_stop(of);
382		} else if ((ifp->if_flags & IFF_UP) != 0 &&
383			   (ifp->if_flags & IFF_RUNNING) == 0) {
384			/* If interface is up, but not running, start it. */
385			ofnet_init(of);
386		} else {
387			/* Other flags are ignored. */
388		}
389		break;
390	default:
391		error = EINVAL;
392		break;
393	}
394	return error;
395}
396
397static void
398ofnet_watchdog(ifp)
399	struct ifnet *ifp;
400{
401	struct ofnet_softc *of = ifp->if_softc;
402
403	log(LOG_ERR, "%s: device timeout\n", of->sc_dev.dv_xname);
404	ifp->if_oerrors++;
405	ofnet_stop(of);
406	ofnet_init(of);
407}
408
409#if NIPKDB_OFN > 0
410static void
411ipkdbofstart(kip)
412	struct ipkdb_if *kip;
413{
414	int unit = kip->unit - 1;
415
416	if (ipkdb_of)
417		ipkdbattach(kip, &ipkdb_of->sc_ethercom);
418}
419
420static void
421ipkdbofleave(kip)
422	struct ipkdb_if *kip;
423{
424}
425
426static int
427ipkdbofrcv(kip, buf, poll)
428	struct ipkdb_if *kip;
429	u_char *buf;
430	int poll;
431{
432	int l;
433
434	do {
435		l = OF_read(kip->port, buf, ETHERMTU);
436		if (l < 0)
437			l = 0;
438	} while (!poll && !l);
439	return l;
440}
441
442static void
443ipkdbofsend(kip, buf, l)
444	struct ipkdb_if *kip;
445	u_char *buf;
446	int l;
447{
448	OF_write(kip->port, buf, l);
449}
450
451static int
452ipkdbprobe(match, aux)
453	struct cfdata *match;
454	void *aux;
455{
456	struct ipkdb_if *kip = aux;
457	static char name[256];
458	int len;
459	int phandle;
460
461	kip->unit = match->cf_unit + 1;
462
463	if (!(kip->port = OF_open("net")))
464		return -1;
465	if ((len = OF_instance_to_path(kip->port, name, sizeof name - 1)) < 0 ||
466	    len >= sizeof name)
467		return -1;
468	name[len] = 0;
469	if ((phandle = OF_instance_to_package(kip->port)) == -1)
470		return -1;
471	if (OF_getprop(phandle, "mac-address", kip->myenetaddr,
472	    sizeof kip->myenetaddr) < 0)
473		return -1;
474
475	kip->flags |= IPKDB_MYHW;
476	kip->name = name;
477	kip->start = ipkdbofstart;
478	kip->leave = ipkdbofleave;
479	kip->receive = ipkdbofrcv;
480	kip->send = ipkdbofsend;
481
482	kifp = kip;
483
484	return 0;
485}
486#endif
487