199767f8919635c4928607450d9e0abb932109ceToomas Soome/* $NetBSD: ether.c,v 1.11 1997/07/07 15:52:50 drochner Exp $ */
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome/*
199767f8919635c4928607450d9e0abb932109ceToomas Soome * Copyright (c) 1992 Regents of the University of California.
199767f8919635c4928607450d9e0abb932109ceToomas Soome * All rights reserved.
199767f8919635c4928607450d9e0abb932109ceToomas Soome *
199767f8919635c4928607450d9e0abb932109ceToomas Soome * This software was developed by the Computer Systems Engineering group
199767f8919635c4928607450d9e0abb932109ceToomas Soome * at Lawrence Berkeley Laboratory under DARPA contract BG 91-66 and
199767f8919635c4928607450d9e0abb932109ceToomas Soome * contributed to Berkeley.
199767f8919635c4928607450d9e0abb932109ceToomas Soome *
199767f8919635c4928607450d9e0abb932109ceToomas Soome * Redistribution and use in source and binary forms, with or without
199767f8919635c4928607450d9e0abb932109ceToomas Soome * modification, are permitted provided that the following conditions
199767f8919635c4928607450d9e0abb932109ceToomas Soome * are met:
199767f8919635c4928607450d9e0abb932109ceToomas Soome * 1. Redistributions of source code must retain the above copyright
199767f8919635c4928607450d9e0abb932109ceToomas Soome * notice, this list of conditions and the following disclaimer.
199767f8919635c4928607450d9e0abb932109ceToomas Soome * 2. Redistributions in binary form must reproduce the above copyright
199767f8919635c4928607450d9e0abb932109ceToomas Soome * notice, this list of conditions and the following disclaimer in the
199767f8919635c4928607450d9e0abb932109ceToomas Soome * documentation and/or other materials provided with the distribution.
199767f8919635c4928607450d9e0abb932109ceToomas Soome * 4. Neither the name of the University nor the names of its contributors
199767f8919635c4928607450d9e0abb932109ceToomas Soome * may be used to endorse or promote products derived from this software
199767f8919635c4928607450d9e0abb932109ceToomas Soome * without specific prior written permission.
199767f8919635c4928607450d9e0abb932109ceToomas Soome *
199767f8919635c4928607450d9e0abb932109ceToomas Soome * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
199767f8919635c4928607450d9e0abb932109ceToomas Soome * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
199767f8919635c4928607450d9e0abb932109ceToomas Soome * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
199767f8919635c4928607450d9e0abb932109ceToomas Soome * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
199767f8919635c4928607450d9e0abb932109ceToomas Soome * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
199767f8919635c4928607450d9e0abb932109ceToomas Soome * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
199767f8919635c4928607450d9e0abb932109ceToomas Soome * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
199767f8919635c4928607450d9e0abb932109ceToomas Soome * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
199767f8919635c4928607450d9e0abb932109ceToomas Soome * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
199767f8919635c4928607450d9e0abb932109ceToomas Soome * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
199767f8919635c4928607450d9e0abb932109ceToomas Soome * SUCH DAMAGE.
199767f8919635c4928607450d9e0abb932109ceToomas Soome *
199767f8919635c4928607450d9e0abb932109ceToomas Soome * @(#) Header: net.c,v 1.9 93/08/06 19:32:15 leres Exp (LBL)
199767f8919635c4928607450d9e0abb932109ceToomas Soome */
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome#include <sys/cdefs.h>
199767f8919635c4928607450d9e0abb932109ceToomas Soome__FBSDID("$FreeBSD$");
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome#include <sys/param.h>
199767f8919635c4928607450d9e0abb932109ceToomas Soome#include <sys/socket.h>
199767f8919635c4928607450d9e0abb932109ceToomas Soome#include <string.h>
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome#include <net/if.h>
199767f8919635c4928607450d9e0abb932109ceToomas Soome#include <netinet/in.h>
199767f8919635c4928607450d9e0abb932109ceToomas Soome#include <netinet/if_ether.h>
199767f8919635c4928607450d9e0abb932109ceToomas Soome#include <netinet/in_systm.h>
199767f8919635c4928607450d9e0abb932109ceToomas Soome#include <netinet/ip.h>
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome#include "stand.h"
199767f8919635c4928607450d9e0abb932109ceToomas Soome#include "net.h"
199767f8919635c4928607450d9e0abb932109ceToomas Soome#include "netif.h"
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome/* Caller must leave room for ethernet header in front!! */
199767f8919635c4928607450d9e0abb932109ceToomas Soomessize_t
199767f8919635c4928607450d9e0abb932109ceToomas Soomesendether(d, pkt, len, dea, etype)
199767f8919635c4928607450d9e0abb932109ceToomas Soome struct iodesc *d;
199767f8919635c4928607450d9e0abb932109ceToomas Soome void *pkt;
199767f8919635c4928607450d9e0abb932109ceToomas Soome size_t len;
199767f8919635c4928607450d9e0abb932109ceToomas Soome u_char *dea;
199767f8919635c4928607450d9e0abb932109ceToomas Soome int etype;
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome ssize_t n;
199767f8919635c4928607450d9e0abb932109ceToomas Soome struct ether_header *eh;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome#ifdef ETHER_DEBUG
199767f8919635c4928607450d9e0abb932109ceToomas Soome if (debug)
199767f8919635c4928607450d9e0abb932109ceToomas Soome printf("sendether: called\n");
199767f8919635c4928607450d9e0abb932109ceToomas Soome#endif
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome eh = (struct ether_header *)pkt - 1;
199767f8919635c4928607450d9e0abb932109ceToomas Soome len += sizeof(*eh);
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome MACPY(d->myea, eh->ether_shost); /* by byte */
199767f8919635c4928607450d9e0abb932109ceToomas Soome MACPY(dea, eh->ether_dhost); /* by byte */
199767f8919635c4928607450d9e0abb932109ceToomas Soome eh->ether_type = htons(etype);
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome n = netif_put(d, eh, len);
199767f8919635c4928607450d9e0abb932109ceToomas Soome if (n == -1 || n < sizeof(*eh))
199767f8919635c4928607450d9e0abb932109ceToomas Soome return (-1);
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome n -= sizeof(*eh);
199767f8919635c4928607450d9e0abb932109ceToomas Soome return (n);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome/*
199767f8919635c4928607450d9e0abb932109ceToomas Soome * Get a packet of any Ethernet type, with our address or
199767f8919635c4928607450d9e0abb932109ceToomas Soome * the broadcast address. Save the Ether type in arg 5.
199767f8919635c4928607450d9e0abb932109ceToomas Soome * NOTE: Caller must leave room for the Ether header.
199767f8919635c4928607450d9e0abb932109ceToomas Soome */
199767f8919635c4928607450d9e0abb932109ceToomas Soomessize_t
199767f8919635c4928607450d9e0abb932109ceToomas Soomereadether(d, pkt, len, tleft, etype)
199767f8919635c4928607450d9e0abb932109ceToomas Soome struct iodesc *d;
199767f8919635c4928607450d9e0abb932109ceToomas Soome void *pkt;
199767f8919635c4928607450d9e0abb932109ceToomas Soome size_t len;
199767f8919635c4928607450d9e0abb932109ceToomas Soome time_t tleft;
199767f8919635c4928607450d9e0abb932109ceToomas Soome u_int16_t *etype;
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome ssize_t n;
199767f8919635c4928607450d9e0abb932109ceToomas Soome struct ether_header *eh;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome#ifdef ETHER_DEBUG
199767f8919635c4928607450d9e0abb932109ceToomas Soome if (debug)
199767f8919635c4928607450d9e0abb932109ceToomas Soome printf("readether: called\n");
199767f8919635c4928607450d9e0abb932109ceToomas Soome#endif
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome eh = (struct ether_header *)pkt - 1;
199767f8919635c4928607450d9e0abb932109ceToomas Soome len += sizeof(*eh);
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome n = netif_get(d, eh, len, tleft);
199767f8919635c4928607450d9e0abb932109ceToomas Soome if (n == -1 || n < sizeof(*eh))
199767f8919635c4928607450d9e0abb932109ceToomas Soome return (-1);
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome /* Validate Ethernet address. */
199767f8919635c4928607450d9e0abb932109ceToomas Soome if (bcmp(d->myea, eh->ether_dhost, 6) != 0 &&
199767f8919635c4928607450d9e0abb932109ceToomas Soome bcmp(bcea, eh->ether_dhost, 6) != 0) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome#ifdef ETHER_DEBUG
199767f8919635c4928607450d9e0abb932109ceToomas Soome if (debug)
199767f8919635c4928607450d9e0abb932109ceToomas Soome printf("readether: not ours (ea=%s)\n",
199767f8919635c4928607450d9e0abb932109ceToomas Soome ether_sprintf(eh->ether_dhost));
199767f8919635c4928607450d9e0abb932109ceToomas Soome#endif
199767f8919635c4928607450d9e0abb932109ceToomas Soome return (-1);
199767f8919635c4928607450d9e0abb932109ceToomas Soome }
199767f8919635c4928607450d9e0abb932109ceToomas Soome *etype = ntohs(eh->ether_type);
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome n -= sizeof(*eh);
199767f8919635c4928607450d9e0abb932109ceToomas Soome return (n);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome/*
199767f8919635c4928607450d9e0abb932109ceToomas Soome * Convert Ethernet address to printable (loggable) representation.
199767f8919635c4928607450d9e0abb932109ceToomas Soome */
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic char digits[] = "0123456789abcdef";
199767f8919635c4928607450d9e0abb932109ceToomas Soomechar *
199767f8919635c4928607450d9e0abb932109ceToomas Soomeether_sprintf(ap)
199767f8919635c4928607450d9e0abb932109ceToomas Soome u_char *ap;
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome int i;
199767f8919635c4928607450d9e0abb932109ceToomas Soome static char etherbuf[18];
199767f8919635c4928607450d9e0abb932109ceToomas Soome char *cp = etherbuf;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome for (i = 0; i < 6; i++) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome *cp++ = digits[*ap >> 4];
199767f8919635c4928607450d9e0abb932109ceToomas Soome *cp++ = digits[*ap++ & 0xf];
199767f8919635c4928607450d9e0abb932109ceToomas Soome *cp++ = ':';
199767f8919635c4928607450d9e0abb932109ceToomas Soome }
199767f8919635c4928607450d9e0abb932109ceToomas Soome *--cp = 0;
199767f8919635c4928607450d9e0abb932109ceToomas Soome return (etherbuf);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}