[apple/xnu.git] / bsd / net / ether_inet_pr_module.c

/*
 * Copyright (c) 2000 Apple Computer, Inc. All rights reserved.
 *
 * @APPLE_LICENSE_OSREFERENCE_HEADER_START@
 * 
 * This file contains Original Code and/or Modifications of Original Code 
 * as defined in and that are subject to the Apple Public Source License 
 * Version 2.0 (the 'License'). You may not use this file except in 
 * compliance with the License.  The rights granted to you under the 
 * License may not be used to create, or enable the creation or 
 * redistribution of, unlawful or unlicensed copies of an Apple operating 
 * system, or to circumvent, violate, or enable the circumvention or 
 * violation of, any terms of an Apple operating system software license 
 * agreement.
 *
 * Please obtain a copy of the License at 
 * http://www.opensource.apple.com/apsl/ and read it before using this 
 * file.
 *
 * The Original Code and all software distributed under the License are 
 * distributed on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER 
 * EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES, 
 * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY, 
 * FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT. 
 * Please see the License for the specific language governing rights and 
 * limitations under the License.
 *
 * @APPLE_LICENSE_OSREFERENCE_HEADER_END@
 */
/*
 * Copyright (c) 1982, 1989, 1993
 *	The Regents of the University of California.  All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. All advertising materials mentioning features or use of this software
 *    must display the following acknowledgement:
 *	This product includes software developed by the University of
 *	California, Berkeley and its contributors.
 * 4. Neither the name of the University nor the names of its contributors
 *    may be used to endorse or promote products derived from this software
 *    without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 * SUCH DAMAGE.
 *
 */


#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/malloc.h>
#include <sys/mbuf.h>
#include <sys/socket.h>
#include <sys/sockio.h>
#include <sys/sysctl.h>
#include <kern/lock.h>

#include <net/if.h>
#include <net/route.h>
#include <net/if_llc.h>
#include <net/if_dl.h>
#include <net/if_types.h>
#include <net/kpi_protocol.h>

#include <netinet/in.h>
#include <netinet/in_var.h>
#include <netinet/if_ether.h>
#include <netinet/in_systm.h>
#include <netinet/ip.h>
#include <netinet/in_arp.h>

#include <sys/socketvar.h>

#include <net/dlil.h>

#if LLC && CCITT
extern struct ifqueue pkintrq;
#endif

#if BRIDGE
#include <net/bridge.h>
#endif

/* #include "vlan.h" */
#if NVLAN > 0
#include <net/if_vlan_var.h>
#endif /* NVLAN > 0 */

/* Local function declerations */
int ether_attach_inet(struct ifnet *ifp, u_long proto_family);
int ether_detach_inet(struct ifnet *ifp, u_long proto_family);

extern void * kdp_get_interface(void);
extern void ipintr(void);
extern void arp_input(struct mbuf* m);

static void
inet_ether_arp_input(
	struct mbuf *m)
{
	struct ether_arp *ea;
	struct sockaddr_dl	sender_hw;
	struct sockaddr_in	sender_ip;
	struct sockaddr_in	target_ip;
	
	if (mbuf_len(m) < sizeof(*ea) &&
		mbuf_pullup(&m, sizeof(*ea)) != 0)
		return;
	
	ea = mbuf_data(m);
	
	/* Verify this is an ethernet/ip arp and address lengths are correct */
	if (ntohs(ea->arp_hrd) != ARPHRD_ETHER ||
		ntohs(ea->arp_pro) != ETHERTYPE_IP ||
		ea->arp_pln != sizeof(struct in_addr) ||
		ea->arp_hln != ETHER_ADDR_LEN) {
		mbuf_free(m);
		return;
	}
	
	/* Verify the sender is not broadcast */
	if (bcmp(ea->arp_sha, etherbroadcastaddr, ETHER_ADDR_LEN) == 0) {
		mbuf_free(m);
		return;
	}
	
	bzero(&sender_ip, sizeof(sender_ip));
	sender_ip.sin_len = sizeof(sender_ip);
	sender_ip.sin_family = AF_INET;
	sender_ip.sin_addr = *(struct in_addr*)ea->arp_spa;
	target_ip = sender_ip;
	target_ip.sin_addr = *(struct in_addr*)ea->arp_tpa;
	
	bzero(&sender_hw, sizeof(sender_hw));
	sender_hw.sdl_len = sizeof(sender_hw);
	sender_hw.sdl_family = AF_LINK;
	sender_hw.sdl_type = IFT_ETHER;
	sender_hw.sdl_alen = ETHER_ADDR_LEN;
	bcopy(ea->arp_sha, LLADDR(&sender_hw), ETHER_ADDR_LEN);
	
	arp_ip_handle_input(mbuf_pkthdr_rcvif(m), ntohs(ea->arp_op), &sender_hw, &sender_ip, &target_ip);
	mbuf_free(m);
}

/*
 * Process a received Ethernet packet;
 * the packet is in the mbuf chain m without
 * the ether header, which is provided separately.
 */
static errno_t
inet_ether_input(
	__unused ifnet_t			ifp,
	__unused protocol_family_t	protocol_family,
	mbuf_t						m,
	char     					*frame_header)
{
    register struct ether_header *eh = (struct ether_header *) frame_header;
    u_short ether_type;

    ether_type = ntohs(eh->ether_type);

    switch (ether_type) {

		case ETHERTYPE_IP:
			proto_input(PF_INET, m);
			break;
		
		case ETHERTYPE_ARP: {
			inet_ether_arp_input(m);
		}
		break;
		
		default: {
			return ENOENT;
		}
    }
	
    return 0;
}

static errno_t
inet_ether_pre_output(
	ifnet_t						ifp,
	__unused protocol_family_t	protocol_family,
	mbuf_t						*m0,
	const struct sockaddr		*dst_netaddr,
	void*						route,
	char						*type,
	char						*edst)
{
    register struct mbuf *m = *m0;
    register struct ether_header *eh;
    errno_t	result = 0;


    if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING)) 
		return ENETDOWN;
	
    /*
     * Tell ether_frameout it's ok to loop packet unless negated below.
     */
    m->m_flags |= M_LOOP;

    switch (dst_netaddr->sa_family) {
    
		case AF_INET: {
				struct sockaddr_dl	ll_dest;
				result = arp_lookup_ip(ifp, (const struct sockaddr_in*)dst_netaddr,
									   &ll_dest, sizeof(ll_dest), (route_t)route, *m0);
				if (result == 0) {
					bcopy(LLADDR(&ll_dest), edst, ETHER_ADDR_LEN);
					*(u_int16_t*)type = htons(ETHERTYPE_IP);
				}
			}
			break;

		case pseudo_AF_HDRCMPLT:	
		case AF_UNSPEC:
			m->m_flags &= ~M_LOOP;
			eh = (struct ether_header *)dst_netaddr->sa_data;
			(void)memcpy(edst, eh->ether_dhost, 6);
			*(u_short *)type = eh->ether_type;
			break;
	
		default:
			printf("%s%d: can't handle af%d\n", ifp->if_name, ifp->if_unit,
				   dst_netaddr->sa_family);
	
			result = EAFNOSUPPORT;
    }

    return result;
}

static errno_t
ether_inet_resolve_multi(
	ifnet_t					ifp,
	const struct sockaddr	*proto_addr,
	struct sockaddr_dl		*out_ll,
	size_t					ll_len)
{
	static const size_t minsize = offsetof(struct sockaddr_dl, sdl_data[0]) + ETHER_ADDR_LEN;
	const struct sockaddr_in	*sin = (const struct sockaddr_in*)proto_addr;
	
	if (proto_addr->sa_family != AF_INET)
		return EAFNOSUPPORT;
	
	if (proto_addr->sa_len < sizeof(struct sockaddr_in))
		return EINVAL;

	if (ll_len < minsize)
		return EMSGSIZE;
	
	bzero(out_ll, minsize);
	out_ll->sdl_len = minsize;
	out_ll->sdl_family = AF_LINK;
	out_ll->sdl_index = ifp->if_index;
	out_ll->sdl_type = IFT_ETHER;
	out_ll->sdl_nlen = 0;
	out_ll->sdl_alen = ETHER_ADDR_LEN;
	out_ll->sdl_slen = 0;
	ETHER_MAP_IP_MULTICAST(&sin->sin_addr, LLADDR(out_ll));
	
	return 0;
}


static errno_t
ether_inet_prmod_ioctl(
    ifnet_t						ifp,
    __unused protocol_family_t	protocol_family,
    u_int32_t					command,
    void*						data)
{
    ifaddr_t ifa = data;
    struct ifreq *ifr = data;
    int error = 0;


    switch (command) {
    case SIOCSIFADDR:
	if ((ifnet_flags(ifp) & IFF_RUNNING) == 0) {
		ifnet_set_flags(ifp, IFF_UP, IFF_UP);
		ifnet_ioctl(ifp, 0, SIOCSIFFLAGS, NULL);
	}

	 switch (ifaddr_address_family(ifa)) {

	 case AF_INET:

	    inet_arp_init_ifaddr(ifp, ifa);
	    /*
	     * Register new IP and MAC addresses with the kernel debugger
	     * if the interface is the same as was registered by IOKernelDebugger. If
		 * no interface was registered, fall back and just match against en0 interface.
	     */
	    if ((kdp_get_interface() != 0 && kdp_get_interface() == ifp->if_softc)
		 || (kdp_get_interface() == 0 && ifp->if_unit == 0))
			kdp_set_ip_and_mac_addresses(&(IA_SIN(ifa)->sin_addr), ifnet_lladdr(ifp));

	    break;

	default:
	    break;
	}

	break;

    case SIOCGIFADDR:
	ifnet_lladdr_copy_bytes(ifp, ifr->ifr_addr.sa_data, ETHER_ADDR_LEN);
    break;

    case SIOCSIFMTU:
	/*
	 * IOKit IONetworkFamily will set the right MTU according to the driver
	 */

	 return (0);

    default:
	 return EOPNOTSUPP;
    }

    return (error);
}

static void
ether_inet_event(
	ifnet_t						ifp,
	__unused protocol_family_t	protocol,
	const struct kev_msg		*event)
{
	ifaddr_t	*addresses;
	
	if (event->vendor_code !=  KEV_VENDOR_APPLE ||
		event->kev_class != KEV_NETWORK_CLASS ||
		event->kev_subclass != KEV_DL_SUBCLASS ||
		event->event_code != KEV_DL_LINK_ADDRESS_CHANGED) {
		return;
	}
	
	if (ifnet_get_address_list_family(ifp, &addresses, AF_INET) == 0) {
		int i;
		
		for (i = 0; addresses[i] != NULL; i++) {
			inet_arp_init_ifaddr(ifp, addresses[i]);
		}
		
		ifnet_free_address_list(addresses);
	}
}

static errno_t
ether_inet_arp(
	ifnet_t								ifp,
	u_short								arpop,
	const struct sockaddr_dl*			sender_hw,
	const struct sockaddr*				sender_proto,
	const struct sockaddr_dl*			target_hw,
	const struct sockaddr*				target_proto)
{
	mbuf_t	m;
	errno_t	result;
	struct ether_header *eh;
	struct ether_arp *ea;
	const struct sockaddr_in* sender_ip = (const struct sockaddr_in*)sender_proto;
	const struct sockaddr_in* target_ip = (const struct sockaddr_in*)target_proto;
	char *datap;
	
	if (target_ip == NULL)
		return EINVAL;
	
	if ((sender_ip && sender_ip->sin_family != AF_INET) ||
		(target_ip && target_ip->sin_family != AF_INET))
		return EAFNOSUPPORT;
	
	result = mbuf_gethdr(MBUF_WAITOK, MBUF_TYPE_DATA, &m);
	if (result != 0)
		return result;
	
	mbuf_setlen(m, sizeof(*ea));
	mbuf_pkthdr_setlen(m, sizeof(*ea));
	
	/* Move the data pointer in the mbuf to the end, aligned to 4 bytes */
	datap = mbuf_datastart(m);
	datap += mbuf_trailingspace(m);
	datap -= (((u_long)datap) & 0x3);
	mbuf_setdata(m, datap, sizeof(*ea));
	ea = mbuf_data(m);
	
	/* Prepend the ethernet header, we will send the raw frame */
	mbuf_prepend(&m, sizeof(*eh), MBUF_WAITOK);
	eh = mbuf_data(m);
	eh->ether_type = htons(ETHERTYPE_ARP);
	
	/* Fill out the arp header */
	ea->arp_pro = htons(ETHERTYPE_IP);
	ea->arp_hln = sizeof(ea->arp_sha);
	ea->arp_pln = sizeof(ea->arp_spa);
	ea->arp_hrd = htons(ARPHRD_ETHER);
	ea->arp_op = htons(arpop);
	
	/* Sender Hardware */
	if (sender_hw != NULL) {
		bcopy(CONST_LLADDR(sender_hw), ea->arp_sha, sizeof(ea->arp_sha));
	}
	else {
		ifnet_lladdr_copy_bytes(ifp, ea->arp_sha, ETHER_ADDR_LEN);
	}
	ifnet_lladdr_copy_bytes(ifp, eh->ether_shost, sizeof(eh->ether_shost));
	
	/* Sender IP */
	if (sender_ip != NULL) {
		bcopy(&sender_ip->sin_addr, ea->arp_spa, sizeof(ea->arp_spa));
	}
	else {
		struct ifaddr *ifa;
		
		/* Look for an IP address to use as our source */
		ifnet_lock_shared(ifp);
		TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) {
			if (ifa->ifa_addr && ifa->ifa_addr->sa_family == AF_INET)
				break;
		}
		if (ifa) {
			bcopy(&((struct sockaddr_in*)ifa->ifa_addr)->sin_addr, ea->arp_spa,
				  sizeof(ea->arp_spa));
		}
		ifnet_lock_done(ifp);
		
		if (ifa == NULL) {
			mbuf_free(m);
			return ENXIO;
		}
	}
	
	/* Target Hardware */
	if (target_hw == 0) {
		bzero(ea->arp_tha, sizeof(ea->arp_tha));
		bcopy(etherbroadcastaddr, eh->ether_dhost, sizeof(eh->ether_dhost));
	}
	else {
		bcopy(CONST_LLADDR(target_hw), ea->arp_tha, sizeof(ea->arp_tha));
		bcopy(CONST_LLADDR(target_hw), eh->ether_dhost, sizeof(eh->ether_dhost));
	}
	
	/* Target IP */
	bcopy(&target_ip->sin_addr, ea->arp_tpa, sizeof(ea->arp_tpa));
	
	ifnet_output_raw(ifp, PF_INET, m);
	
	return 0;
}

int
ether_attach_inet(
	struct ifnet	*ifp,
	__unused u_long	proto_family)
{
	struct ifnet_attach_proto_param proto;
	struct ifnet_demux_desc demux[2];
	u_short en_native=htons(ETHERTYPE_IP);
	u_short arp_native=htons(ETHERTYPE_ARP);
	errno_t	error;
	
	bzero(&demux[0], sizeof(demux));
	demux[0].type = DLIL_DESC_ETYPE2;
	demux[0].data = &en_native;
	demux[0].datalen = sizeof(en_native);
	demux[1].type = DLIL_DESC_ETYPE2;
	demux[1].data = &arp_native;
	demux[1].datalen = sizeof(arp_native);

	bzero(&proto, sizeof(proto));
	proto.demux_list = demux;
	proto.demux_count = sizeof(demux) / sizeof(demux[0]);
	proto.input = inet_ether_input;
	proto.pre_output = inet_ether_pre_output;
	proto.ioctl = ether_inet_prmod_ioctl;
	proto.event = ether_inet_event;
	proto.resolve = ether_inet_resolve_multi;
	proto.send_arp = ether_inet_arp;
	
	error = ifnet_attach_protocol(ifp, proto_family, &proto);
	if (error && error != EEXIST) {
		printf("WARNING: ether_attach_inet can't attach ip to %s%d\n",
			   ifp->if_name, ifp->if_unit);
	}
	return error;
}

int
ether_detach_inet(
	struct ifnet *ifp,
	u_long proto_family)
{
    int         stat;

	stat = dlil_detach_protocol(ifp, proto_family);

    return stat;
}
Commit	Line	Data
1c79356b	1	/*
5d5c5d0d A	2	* Copyright (c) 2000 Apple Computer, Inc. All rights reserved.
5d5c5d0d A	3	*
8ad349bb	4	* @APPLE_LICENSE_OSREFERENCE_HEADER_START@
1c79356b	5	*
8ad349bb A	6	* This file contains Original Code and/or Modifications of Original Code
	7	* as defined in and that are subject to the Apple Public Source License
	8	* Version 2.0 (the 'License'). You may not use this file except in
	9	* compliance with the License. The rights granted to you under the
	10	* License may not be used to create, or enable the creation or
	11	* redistribution of, unlawful or unlicensed copies of an Apple operating
	12	* system, or to circumvent, violate, or enable the circumvention or
	13	* violation of, any terms of an Apple operating system software license
	14	* agreement.
	15	*
	16	* Please obtain a copy of the License at
	17	* http://www.opensource.apple.com/apsl/ and read it before using this
	18	* file.
	19	*
	20	* The Original Code and all software distributed under the License are
	21	* distributed on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER
	22	* EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
	23	* INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
	24	* FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT.
	25	* Please see the License for the specific language governing rights and
	26	* limitations under the License.
	27	*
	28	* @APPLE_LICENSE_OSREFERENCE_HEADER_END@
1c79356b A	29	*/
	30	/*
	31	* Copyright (c) 1982, 1989, 1993
	32	* The Regents of the University of California. All rights reserved.
	33	*
	34	* Redistribution and use in source and binary forms, with or without
	35	* modification, are permitted provided that the following conditions
	36	* are met:
	37	* 1. Redistributions of source code must retain the above copyright
	38	* notice, this list of conditions and the following disclaimer.
	39	* 2. Redistributions in binary form must reproduce the above copyright
	40	* notice, this list of conditions and the following disclaimer in the
	41	* documentation and/or other materials provided with the distribution.
	42	* 3. All advertising materials mentioning features or use of this software
	43	* must display the following acknowledgement:
	44	* This product includes software developed by the University of
	45	* California, Berkeley and its contributors.
	46	* 4. Neither the name of the University nor the names of its contributors
	47	* may be used to endorse or promote products derived from this software
	48	* without specific prior written permission.
	49	*
	50	* THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
	51	* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
	52	* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
	53	* ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
	54	* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
	55	* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
	56	* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
	57	* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
	58	* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
	59	* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
	60	* SUCH DAMAGE.
	61	*
	62	*/
	63
	64
	65
	66	#include <sys/param.h>
	67	#include <sys/systm.h>
	68	#include <sys/kernel.h>
	69	#include <sys/malloc.h>
	70	#include <sys/mbuf.h>
	71	#include <sys/socket.h>
	72	#include <sys/sockio.h>
	73	#include <sys/sysctl.h>
91447636	74	#include <kern/lock.h>
1c79356b A	75
1c79356b A	76	#include <net/if.h>
1c79356b A	77	#include <net/route.h>
	78	#include <net/if_llc.h>
	79	#include <net/if_dl.h>
	80	#include <net/if_types.h>
91447636	81	#include <net/kpi_protocol.h>
1c79356b A	82
	83	#include <netinet/in.h>
	84	#include <netinet/in_var.h>
	85	#include <netinet/if_ether.h>
	86	#include <netinet/in_systm.h>
	87	#include <netinet/ip.h>
91447636	88	#include <netinet/in_arp.h>
1c79356b A	89
	90	#include <sys/socketvar.h>
	91
	92	#include <net/dlil.h>
	93
	94	#if LLC && CCITT
	95	extern struct ifqueue pkintrq;
	96	#endif
	97
1c79356b A	98	#if BRIDGE
	99	#include <net/bridge.h>
	100	#endif
	101
	102	/* #include "vlan.h" */
	103	#if NVLAN > 0
	104	#include <net/if_vlan_var.h>
	105	#endif /* NVLAN > 0 */
	106
91447636 A	107	/* Local function declerations */
	108	int ether_attach_inet(struct ifnet *ifp, u_long proto_family);
	109	int ether_detach_inet(struct ifnet *ifp, u_long proto_family);
1c79356b	110
91447636 A	111	extern void * kdp_get_interface(void);
	112	extern void ipintr(void);
	113	extern void arp_input(struct mbuf* m);
1c79356b	114
91447636 A	115	static void
	116	inet_ether_arp_input(
	117	struct mbuf *m)
	118	{
	119	struct ether_arp *ea;
	120	struct sockaddr_dl sender_hw;
	121	struct sockaddr_in sender_ip;
	122	struct sockaddr_in target_ip;
	123
	124	if (mbuf_len(m) < sizeof(*ea) &&
	125	mbuf_pullup(&m, sizeof(*ea)) != 0)
	126	return;
	127
	128	ea = mbuf_data(m);
	129
	130	/* Verify this is an ethernet/ip arp and address lengths are correct */
	131	if (ntohs(ea->arp_hrd) != ARPHRD_ETHER \|\|
	132	ntohs(ea->arp_pro) != ETHERTYPE_IP \|\|
	133	ea->arp_pln != sizeof(struct in_addr) \|\|
	134	ea->arp_hln != ETHER_ADDR_LEN) {
	135	mbuf_free(m);
	136	return;
	137	}
	138
13fec989 A	139	/* Verify the sender is not broadcast */
13fec989 A	140	if (bcmp(ea->arp_sha, etherbroadcastaddr, ETHER_ADDR_LEN) == 0) {
91447636 A	141	mbuf_free(m);
	142	return;
	143	}
	144
	145	bzero(&sender_ip, sizeof(sender_ip));
	146	sender_ip.sin_len = sizeof(sender_ip);
	147	sender_ip.sin_family = AF_INET;
	148	sender_ip.sin_addr = (struct in_addr)ea->arp_spa;
	149	target_ip = sender_ip;
	150	target_ip.sin_addr = (struct in_addr)ea->arp_tpa;
	151
	152	bzero(&sender_hw, sizeof(sender_hw));
	153	sender_hw.sdl_len = sizeof(sender_hw);
	154	sender_hw.sdl_family = AF_LINK;
	155	sender_hw.sdl_type = IFT_ETHER;
	156	sender_hw.sdl_alen = ETHER_ADDR_LEN;
	157	bcopy(ea->arp_sha, LLADDR(&sender_hw), ETHER_ADDR_LEN);
	158
	159	arp_ip_handle_input(mbuf_pkthdr_rcvif(m), ntohs(ea->arp_op), &sender_hw, &sender_ip, &target_ip);
	160	mbuf_free(m);
	161	}
1c79356b A	162
	163	/*
	164	* Process a received Ethernet packet;
	165	* the packet is in the mbuf chain m without
	166	* the ether header, which is provided separately.
	167	*/
91447636 A	168	static errno_t
	169	inet_ether_input(
	170	__unused ifnet_t ifp,
	171	__unused protocol_family_t protocol_family,
	172	mbuf_t m,
	173	char *frame_header)
1c79356b A	174	{
1c79356b A	175	register struct ether_header eh = (struct ether_header ) frame_header;
1c79356b	176	u_short ether_type;
1c79356b A	177
	178	ether_type = ntohs(eh->ether_type);
	179
1c79356b A	180	switch (ether_type) {
1c79356b A	181
91447636 A	182	case ETHERTYPE_IP:
	183	proto_input(PF_INET, m);
	184	break;
	185
	186	case ETHERTYPE_ARP: {
	187	inet_ether_arp_input(m);
	188	}
	189	break;
	190
	191	default: {
	192	return ENOENT;
	193	}
1c79356b	194	}
91447636	195
1c79356b A	196	return 0;
	197	}
	198
91447636 A	199	static errno_t
	200	inet_ether_pre_output(
	201	ifnet_t ifp,
	202	__unused protocol_family_t protocol_family,
	203	mbuf_t *m0,
	204	const struct sockaddr *dst_netaddr,
	205	void* route,
	206	char *type,
	207	char *edst)
1c79356b	208	{
1c79356b	209	register struct mbuf m = m0;
1c79356b	210	register struct ether_header *eh;
91447636	211	errno_t result = 0;
1c79356b A	212
	213
	214	if ((ifp->if_flags & (IFF_UP\|IFF_RUNNING)) != (IFF_UP\|IFF_RUNNING))
91447636	215	return ENETDOWN;
1c79356b	216
1c79356b A	217	/*
	218	* Tell ether_frameout it's ok to loop packet unless negated below.
	219	*/
	220	m->m_flags \|= M_LOOP;
	221
	222	switch (dst_netaddr->sa_family) {
91447636 A	223
	224	case AF_INET: {
	225	struct sockaddr_dl ll_dest;
	226	result = arp_lookup_ip(ifp, (const struct sockaddr_in*)dst_netaddr,
	227	&ll_dest, sizeof(ll_dest), (route_t)route, *m0);
	228	if (result == 0) {
	229	bcopy(LLADDR(&ll_dest), edst, ETHER_ADDR_LEN);
	230	(u_int16_t)type = htons(ETHERTYPE_IP);
	231	}
	232	}
	233	break;
	234
	235	case pseudo_AF_HDRCMPLT:
	236	case AF_UNSPEC:
	237	m->m_flags &= ~M_LOOP;
	238	eh = (struct ether_header *)dst_netaddr->sa_data;
	239	(void)memcpy(edst, eh->ether_dhost, 6);
	240	(u_short )type = eh->ether_type;
	241	break;
	242
	243	default:
	244	printf("%s%d: can't handle af%d\n", ifp->if_name, ifp->if_unit,
	245	dst_netaddr->sa_family);
	246
	247	result = EAFNOSUPPORT;
	248	}
1c79356b	249
91447636 A	250	return result;
91447636 A	251	}
1c79356b	252
91447636 A	253	static errno_t
	254	ether_inet_resolve_multi(
	255	ifnet_t ifp,
	256	const struct sockaddr *proto_addr,
	257	struct sockaddr_dl *out_ll,
	258	size_t ll_len)
	259	{
	260	static const size_t minsize = offsetof(struct sockaddr_dl, sdl_data[0]) + ETHER_ADDR_LEN;
	261	const struct sockaddr_in sin = (const struct sockaddr_in)proto_addr;
	262
	263	if (proto_addr->sa_family != AF_INET)
	264	return EAFNOSUPPORT;
	265
	266	if (proto_addr->sa_len < sizeof(struct sockaddr_in))
	267	return EINVAL;
1c79356b	268
91447636 A	269	if (ll_len < minsize)
	270	return EMSGSIZE;
	271
	272	bzero(out_ll, minsize);
	273	out_ll->sdl_len = minsize;
	274	out_ll->sdl_family = AF_LINK;
	275	out_ll->sdl_index = ifp->if_index;
	276	out_ll->sdl_type = IFT_ETHER;
	277	out_ll->sdl_nlen = 0;
	278	out_ll->sdl_alen = ETHER_ADDR_LEN;
	279	out_ll->sdl_slen = 0;
	280	ETHER_MAP_IP_MULTICAST(&sin->sin_addr, LLADDR(out_ll));
	281
	282	return 0;
1c79356b A	283	}
	284
	285
91447636 A	286	static errno_t
	287	ether_inet_prmod_ioctl(
	288	ifnet_t ifp,
	289	__unused protocol_family_t protocol_family,
	290	u_int32_t command,
	291	void* data)
1c79356b	292	{
91447636 A	293	ifaddr_t ifa = data;
91447636 A	294	struct ifreq *ifr = data;
1c79356b	295	int error = 0;
1c79356b A	296
1c79356b A	297
1c79356b	298	switch (command) {
1c79356b	299	case SIOCSIFADDR:
91447636 A	300	if ((ifnet_flags(ifp) & IFF_RUNNING) == 0) {
	301	ifnet_set_flags(ifp, IFF_UP, IFF_UP);
	302	ifnet_ioctl(ifp, 0, SIOCSIFFLAGS, NULL);
	303	}
1c79356b	304
91447636	305	switch (ifaddr_address_family(ifa)) {
1c79356b A	306
	307	case AF_INET:
	308
91447636	309	inet_arp_init_ifaddr(ifp, ifa);
9bccf70c A	310	/*
9bccf70c A	311	* Register new IP and MAC addresses with the kernel debugger
4a249263 A	312	* if the interface is the same as was registered by IOKernelDebugger. If
4a249263 A	313	* no interface was registered, fall back and just match against en0 interface.
9bccf70c	314	*/
91447636	315	if ((kdp_get_interface() != 0 && kdp_get_interface() == ifp->if_softc)
4a249263	316	\|\| (kdp_get_interface() == 0 && ifp->if_unit == 0))
91447636	317	kdp_set_ip_and_mac_addresses(&(IA_SIN(ifa)->sin_addr), ifnet_lladdr(ifp));
9bccf70c	318
1c79356b A	319	break;
	320
	321	default:
	322	break;
	323	}
	324
	325	break;
	326
	327	case SIOCGIFADDR:
91447636	328	ifnet_lladdr_copy_bytes(ifp, ifr->ifr_addr.sa_data, ETHER_ADDR_LEN);
1c79356b A	329	break;
	330
	331	case SIOCSIFMTU:
	332	/*
9bccf70c	333	* IOKit IONetworkFamily will set the right MTU according to the driver
1c79356b	334	*/
9bccf70c A	335
9bccf70c A	336	return (0);
1c79356b A	337
	338	default:
	339	return EOPNOTSUPP;
	340	}
	341
1c79356b A	342	return (error);
	343	}
	344
91447636 A	345	static void
	346	ether_inet_event(
	347	ifnet_t ifp,
	348	__unused protocol_family_t protocol,
	349	const struct kev_msg *event)
	350	{
	351	ifaddr_t *addresses;
	352
	353	if (event->vendor_code != KEV_VENDOR_APPLE \|\|
	354	event->kev_class != KEV_NETWORK_CLASS \|\|
	355	event->kev_subclass != KEV_DL_SUBCLASS \|\|
	356	event->event_code != KEV_DL_LINK_ADDRESS_CHANGED) {
	357	return;
	358	}
	359
	360	if (ifnet_get_address_list_family(ifp, &addresses, AF_INET) == 0) {
	361	int i;
	362
	363	for (i = 0; addresses[i] != NULL; i++) {
	364	inet_arp_init_ifaddr(ifp, addresses[i]);
	365	}
	366
	367	ifnet_free_address_list(addresses);
	368	}
	369	}
1c79356b	370
91447636 A	371	static errno_t
	372	ether_inet_arp(
	373	ifnet_t ifp,
	374	u_short arpop,
	375	const struct sockaddr_dl* sender_hw,
	376	const struct sockaddr* sender_proto,
	377	const struct sockaddr_dl* target_hw,
	378	const struct sockaddr* target_proto)
	379	{
	380	mbuf_t m;
	381	errno_t result;
	382	struct ether_header *eh;
	383	struct ether_arp *ea;
	384	const struct sockaddr_in* sender_ip = (const struct sockaddr_in*)sender_proto;
	385	const struct sockaddr_in* target_ip = (const struct sockaddr_in*)target_proto;
	386	char *datap;
	387
	388	if (target_ip == NULL)
	389	return EINVAL;
	390
	391	if ((sender_ip && sender_ip->sin_family != AF_INET) \|\|
	392	(target_ip && target_ip->sin_family != AF_INET))
	393	return EAFNOSUPPORT;
	394
	395	result = mbuf_gethdr(MBUF_WAITOK, MBUF_TYPE_DATA, &m);
	396	if (result != 0)
	397	return result;
	398
	399	mbuf_setlen(m, sizeof(*ea));
	400	mbuf_pkthdr_setlen(m, sizeof(*ea));
	401
	402	/* Move the data pointer in the mbuf to the end, aligned to 4 bytes */
	403	datap = mbuf_datastart(m);
	404	datap += mbuf_trailingspace(m);
	405	datap -= (((u_long)datap) & 0x3);
	406	mbuf_setdata(m, datap, sizeof(*ea));
	407	ea = mbuf_data(m);
	408
	409	/* Prepend the ethernet header, we will send the raw frame */
	410	mbuf_prepend(&m, sizeof(*eh), MBUF_WAITOK);
	411	eh = mbuf_data(m);
	412	eh->ether_type = htons(ETHERTYPE_ARP);
	413
	414	/* Fill out the arp header */
	415	ea->arp_pro = htons(ETHERTYPE_IP);
	416	ea->arp_hln = sizeof(ea->arp_sha);
	417	ea->arp_pln = sizeof(ea->arp_spa);
	418	ea->arp_hrd = htons(ARPHRD_ETHER);
	419	ea->arp_op = htons(arpop);
	420
	421	/* Sender Hardware */
	422	if (sender_hw != NULL) {
	423	bcopy(CONST_LLADDR(sender_hw), ea->arp_sha, sizeof(ea->arp_sha));
	424	}
	425	else {
	426	ifnet_lladdr_copy_bytes(ifp, ea->arp_sha, ETHER_ADDR_LEN);
	427	}
	428	ifnet_lladdr_copy_bytes(ifp, eh->ether_shost, sizeof(eh->ether_shost));
	429
	430	/* Sender IP */
	431	if (sender_ip != NULL) {
	432	bcopy(&sender_ip->sin_addr, ea->arp_spa, sizeof(ea->arp_spa));
	433	}
	434	else {
435	struct ifaddr *ifa;
436
437	/* Look for an IP address to use as our source */
438	ifnet_lock_shared(ifp);
439	TAILQ_FOREACH(ifa, &ifp->if_addrhead, ifa_link) {
440	if (ifa->ifa_addr && ifa->ifa_addr->sa_family == AF_INET)
441	break;
442	}
443	if (ifa) {
444	bcopy(&((struct sockaddr_in*)ifa->ifa_addr)->sin_addr, ea->arp_spa,
445	sizeof(ea->arp_spa));
446	}
447	ifnet_lock_done(ifp);
448
449	if (ifa == NULL) {
450	mbuf_free(m);
451	return ENXIO;
452	}
453	}
454
455	/* Target Hardware */
456	if (target_hw == 0) {
457	bzero(ea->arp_tha, sizeof(ea->arp_tha));
458	bcopy(etherbroadcastaddr, eh->ether_dhost, sizeof(eh->ether_dhost));
459	}
460	else {
461	bcopy(CONST_LLADDR(target_hw), ea->arp_tha, sizeof(ea->arp_tha));
462	bcopy(CONST_LLADDR(target_hw), eh->ether_dhost, sizeof(eh->ether_dhost));
463	}
464
465	/* Target IP */
466	bcopy(&target_ip->sin_addr, ea->arp_tpa, sizeof(ea->arp_tpa));
467
468	ifnet_output_raw(ifp, PF_INET, m);
469
470	return 0;
471	}
1c79356b	472
55e303ae	473	int
91447636 A	474	ether_attach_inet(
	475	struct ifnet *ifp,
	476	__unused u_long proto_family)
1c79356b	477	{
91447636 A	478	struct ifnet_attach_proto_param proto;
	479	struct ifnet_demux_desc demux[2];
	480	u_short en_native=htons(ETHERTYPE_IP);
	481	u_short arp_native=htons(ETHERTYPE_ARP);
	482	errno_t error;
	483
	484	bzero(&demux[0], sizeof(demux));
	485	demux[0].type = DLIL_DESC_ETYPE2;
	486	demux[0].data = &en_native;
	487	demux[0].datalen = sizeof(en_native);
	488	demux[1].type = DLIL_DESC_ETYPE2;
	489	demux[1].data = &arp_native;
	490	demux[1].datalen = sizeof(arp_native);
	491
	492	bzero(&proto, sizeof(proto));
	493	proto.demux_list = demux;
	494	proto.demux_count = sizeof(demux) / sizeof(demux[0]);
	495	proto.input = inet_ether_input;
	496	proto.pre_output = inet_ether_pre_output;
	497	proto.ioctl = ether_inet_prmod_ioctl;
	498	proto.event = ether_inet_event;
	499	proto.resolve = ether_inet_resolve_multi;
	500	proto.send_arp = ether_inet_arp;
	501
	502	error = ifnet_attach_protocol(ifp, proto_family, &proto);
	503	if (error && error != EEXIST) {
	504	printf("WARNING: ether_attach_inet can't attach ip to %s%d\n",
	505	ifp->if_name, ifp->if_unit);
	506	}
	507	return error;
1c79356b	508	}
0b4e3aa0	509
91447636 A	510	int
	511	ether_detach_inet(
	512	struct ifnet *ifp,
	513	u_long proto_family)
0b4e3aa0	514	{
0b4e3aa0 A	515	int stat;
0b4e3aa0 A	516
91447636 A	517	stat = dlil_detach_protocol(ifp, proto_family);
91447636 A	518
0b4e3aa0 A	519	return stat;
	520	}
	521