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

/*
 * Copyright (c) 2000 Apple Computer, Inc. All rights reserved.
 *
 * @APPLE_LICENSE_HEADER_START@
 * 
 * The contents of this file constitute Original Code as defined in and
 * are subject to the Apple Public Source License Version 1.1 (the
 * "License").  You may not use this file except in compliance with the
 * License.  Please obtain a copy of the License at
 * http://www.apple.com/publicsource and read it before using this file.
 * 
 * This 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 OR NON-INFRINGEMENT.  Please see the
 * License for the specific language governing rights and limitations
 * under the License.
 * 
 * @APPLE_LICENSE_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 <net/if.h>
#include <net/route.h>
#include <net/if_llc.h>
#include <net/if_dl.h>
#include <net/if_types.h>
#include <netinet/if_ether.h>

#include <sys/socketvar.h>

#include <net/dlil.h>
#include <netat/at_pat.h>
#if NETAT
extern struct ifqueue atalkintrq;
#endif


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

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

struct dl_es_at_entry 
{
	struct ifnet *ifp;
	int    ref_count;
};

/* Local fuction declerations */
int at_ether_input(struct mbuf *m, char *frame_header, struct ifnet *ifp,
				   u_long protocol_family, int sync_ok);
int ether_pre_output(struct ifnet *ifp, u_long protocol_family, struct mbuf **m0,
					 const struct sockaddr *dst_netaddr, caddr_t route, char *type, char *edst);
int ether_prmod_ioctl(u_long protocol_family, struct ifnet *ifp, u_long command,
					  caddr_t data);
int ether_attach_at(struct ifnet *ifp);
void ether_detach_at(struct ifnet *ifp);


/*
 * Temp static for protocol registration XXX
 */

#define MAX_EN_COUNT 30

static struct dl_es_at_entry en_at_array[MAX_EN_COUNT];

/*
 * Process a received Ethernet packet;
 * the packet is in the mbuf chain m without
 * the ether header, which is provided separately.
 */
int
at_ether_input(
	struct mbuf				*m,
	__unused char			*frame_header,
	__unused struct ifnet	*ifp,
	__unused u_long			protocol_family,
	__unused int			sync_ok)

{
   /*
	* note: for AppleTalk we need to pass the enet header of the
	* packet up stack. To do so, we made sure in that the FULL packet
	* is copied in the mbuf by the mace driver, and only the m_data and
	* length have been shifted to make IP and the other guys happy.
	*/

	m->m_data -= sizeof(struct ether_header);
	m->m_len += sizeof(struct ether_header);
	m->m_pkthdr.len += sizeof(struct ether_header);
	proto_input(PF_APPLETALK, m);

	return 0;
}


int
ether_pre_output(
	struct ifnet			*ifp,
	__unused u_long			protocol_family,
	struct mbuf				**m0,
	const struct sockaddr	*dst_netaddr,
	__unused caddr_t		route,
	char					*type,
	char					*edst)
{
    register struct mbuf *m = *m0;
    register struct ether_header *eh;
    int hlen;	/* link layer header lenght */


    if ((ifp->if_flags & (IFF_UP|IFF_RUNNING)) != (IFF_UP|IFF_RUNNING)) 
	return ENETDOWN;

    hlen = ETHER_HDR_LEN;

    /*
     * Tell ether_frameout it's ok to loop packet unless negated below.
     */
    m->m_flags |= M_LOOP;

    switch (dst_netaddr->sa_family) {
    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;
	

    case AF_APPLETALK:
    {
	eh = (struct ether_header *)dst_netaddr->sa_data;
	bcopy((caddr_t)eh->ether_dhost, (caddr_t)edst, 6);
		
	*(u_short *)type = m->m_pkthdr.len;
    }
    break;


    default:
	kprintf("%s%d: can't handle af%d\n", ifp->if_name, ifp->if_unit,
	       dst_netaddr->sa_family);

        return EAFNOSUPPORT;
    }

    return (0);
}


int
ether_prmod_ioctl(
    __unused u_long	protocol_family,
    struct ifnet	*ifp,
    u_long			command,
    caddr_t			data)
{
    struct ifreq *ifr = (struct ifreq *) data;
    int error = 0;

    switch (command) {

    case SIOCSIFADDR:
	 if ((ifp->if_flags & IFF_RUNNING) == 0) {
	      ifnet_set_flags(ifp, IFF_UP, IFF_UP);
	      dlil_ioctl(0, ifp, SIOCSIFFLAGS, (caddr_t) 0);
	 }

	break;

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

    case SIOCSIFMTU:
	/*
	 * Set the interface MTU.
	 */
	if (ifr->ifr_mtu > ETHERMTU) {
	    error = EINVAL;
	} else {
	    ifp->if_mtu = ifr->ifr_mtu;
	}
	break;

    default:
	 return EOPNOTSUPP;
    }


    return (error);
}


int
ether_attach_at(
	struct ifnet *ifp)
{
    struct dlil_proto_reg_str   reg;
    struct dlil_demux_desc      desc;
    struct dlil_demux_desc      desc2;
    int   stat;
    int   first_empty;
    int   i;
    u_int8_t	atalk_snap[5] = {0x08, 0x00, 0x07, 0x80, 0x9b};
    u_int8_t	aarp_snap[5] = {0x00, 0x00, 0x00, 0x80, 0xf3};

    first_empty = MAX_EN_COUNT;
	for (i=0; i < MAX_EN_COUNT; i++) {
		if (en_at_array[i].ifp == 0)
			first_empty = i;
		
		if (en_at_array[i].ifp == ifp) {
			en_at_array[i].ref_count++;
			return 0;
		}
    }
    
	if (first_empty == MAX_EN_COUNT)
		return ENOMEM;
	
	bzero(&reg, sizeof(reg));
	bzero(&desc, sizeof(desc));
	bzero(&desc2, sizeof(desc2));
	
	TAILQ_INIT(&reg.demux_desc_head);
	reg.interface_family = ifp->if_family;
	reg.unit_number      = ifp->if_unit;
	reg.input            = at_ether_input;
	reg.pre_output       = ether_pre_output;
	reg.ioctl            = ether_prmod_ioctl;
	reg.protocol_family  = PF_APPLETALK;

	desc.type = DLIL_DESC_SNAP;
	desc.native_type = atalk_snap;
	desc.variants.native_type_length = sizeof(atalk_snap);
	TAILQ_INSERT_TAIL(&reg.demux_desc_head, &desc, next);
	
	desc2.type = DLIL_DESC_SNAP;
	desc2.native_type = aarp_snap;
	desc2.variants.native_type_length = sizeof(aarp_snap);
	TAILQ_INSERT_TAIL(&reg.demux_desc_head, &desc2, next);
	
    stat = dlil_attach_protocol(&reg);
	if (stat) {
		printf("WARNING: ether_attach_at can't attach at to interface\n");
		return stat;
	}

	en_at_array[first_empty].ifp = ifp;
	en_at_array[first_empty].ref_count = 1;
	
	return 0;
} /* ether_attach_at */


void
ether_detach_at(struct ifnet *ifp)
{
	int i;
	
	for (i=0; i < MAX_EN_COUNT; i++) {
		if (en_at_array[i].ifp == ifp)
			break;
	}
	
	if (i < MAX_EN_COUNT) {
		if (en_at_array[i].ref_count > 1) 
			en_at_array[i].ref_count--;
		else {
			if (en_at_array[i].ref_count == 1) {
				dlil_detach_protocol(ifp, PF_APPLETALK);
				en_at_array[i].ifp = 0;
			}
		}
	}
}
Commit	Line	Data
1c79356b A	1	/*
	2	* Copyright (c) 2000 Apple Computer, Inc. All rights reserved.
	3	*
	4	* @APPLE_LICENSE_HEADER_START@
	5	*
e5568f75 A	6	* The contents of this file constitute Original Code as defined in and
	7	* are subject to the Apple Public Source License Version 1.1 (the
	8	* "License"). You may not use this file except in compliance with the
	9	* License. Please obtain a copy of the License at
	10	* http://www.apple.com/publicsource and read it before using this file.
1c79356b	11	*
e5568f75 A	12	* This Original Code and all software distributed under the License are
e5568f75 A	13	* distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY KIND, EITHER
1c79356b A	14	* EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
1c79356b A	15	* INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
e5568f75 A	16	* FITNESS FOR A PARTICULAR PURPOSE OR NON-INFRINGEMENT. Please see the
	17	* License for the specific language governing rights and limitations
	18	* under the License.
1c79356b A	19	*
	20	* @APPLE_LICENSE_HEADER_END@
	21	*/
	22	/*
	23	* Copyright (c) 1982, 1989, 1993
	24	* The Regents of the University of California. All rights reserved.
	25	*
	26	* Redistribution and use in source and binary forms, with or without
	27	* modification, are permitted provided that the following conditions
	28	* are met:
	29	* 1. Redistributions of source code must retain the above copyright
	30	* notice, this list of conditions and the following disclaimer.
	31	* 2. Redistributions in binary form must reproduce the above copyright
	32	* notice, this list of conditions and the following disclaimer in the
	33	* documentation and/or other materials provided with the distribution.
	34	* 3. All advertising materials mentioning features or use of this software
	35	* must display the following acknowledgement:
	36	* This product includes software developed by the University of
	37	* California, Berkeley and its contributors.
	38	* 4. Neither the name of the University nor the names of its contributors
	39	* may be used to endorse or promote products derived from this software
	40	* without specific prior written permission.
	41	*
	42	* THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
	43	* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
	44	* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
	45	* ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
	46	* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
	47	* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
	48	* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
	49	* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
	50	* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
	51	* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
	52	* SUCH DAMAGE.
	53	*
	54	*/
	55
	56
	57
	58	#include <sys/param.h>
	59	#include <sys/systm.h>
	60	#include <sys/kernel.h>
	61	#include <sys/malloc.h>
	62	#include <sys/mbuf.h>
	63	#include <sys/socket.h>
	64	#include <sys/sockio.h>
	65	#include <sys/sysctl.h>
	66
	67	#include <net/if.h>
1c79356b A	68	#include <net/route.h>
	69	#include <net/if_llc.h>
	70	#include <net/if_dl.h>
	71	#include <net/if_types.h>
1c79356b A	72	#include <netinet/if_ether.h>
	73
	74	#include <sys/socketvar.h>
	75
	76	#include <net/dlil.h>
	77	#include <netat/at_pat.h>
	78	#if NETAT
	79	extern struct ifqueue atalkintrq;
	80	#endif
	81
	82
	83	#if BRIDGE
	84	#include <net/bridge.h>
	85	#endif
	86
	87	/* #include "vlan.h" */
	88	#if NVLAN > 0
	89	#include <net/if_vlan_var.h>
	90	#endif /* NVLAN > 0 */
	91
1c79356b A	92	struct dl_es_at_entry
1c79356b A	93	{
91447636 A	94	struct ifnet *ifp;
91447636 A	95	int ref_count;
1c79356b A	96	};
1c79356b A	97
91447636 A	98	/* Local fuction declerations */
	99	int at_ether_input(struct mbuf m, char frame_header, struct ifnet *ifp,
	100	u_long protocol_family, int sync_ok);
	101	int ether_pre_output(struct ifnet ifp, u_long protocol_family, struct mbuf *m0,
	102	const struct sockaddr dst_netaddr, caddr_t route, char type, char *edst);
	103	int ether_prmod_ioctl(u_long protocol_family, struct ifnet *ifp, u_long command,
	104	caddr_t data);
	105	int ether_attach_at(struct ifnet *ifp);
	106	void ether_detach_at(struct ifnet *ifp);
	107
1c79356b A	108
	109	/*
	110	* Temp static for protocol registration XXX
	111	*/
	112
	113	#define MAX_EN_COUNT 30
	114
	115	static struct dl_es_at_entry en_at_array[MAX_EN_COUNT];
	116
	117	/*
	118	* Process a received Ethernet packet;
	119	* the packet is in the mbuf chain m without
	120	* the ether header, which is provided separately.
	121	*/
	122	int
91447636 A	123	at_ether_input(
	124	struct mbuf *m,
	125	__unused char *frame_header,
	126	__unused struct ifnet *ifp,
	127	__unused u_long protocol_family,
	128	__unused int sync_ok)
1c79356b A	129
1c79356b A	130	{
91447636 A	131	/*
	132	* note: for AppleTalk we need to pass the enet header of the
	133	* packet up stack. To do so, we made sure in that the FULL packet
	134	* is copied in the mbuf by the mace driver, and only the m_data and
	135	* length have been shifted to make IP and the other guys happy.
	136	*/
	137
	138	m->m_data -= sizeof(struct ether_header);
	139	m->m_len += sizeof(struct ether_header);
	140	m->m_pkthdr.len += sizeof(struct ether_header);
	141	proto_input(PF_APPLETALK, m);
1c79356b	142
1c79356b	143	return 0;
1c79356b A	144	}
	145
	146
	147
	148	int
91447636 A	149	ether_pre_output(
	150	struct ifnet *ifp,
	151	__unused u_long protocol_family,
	152	struct mbuf **m0,
	153	const struct sockaddr *dst_netaddr,
	154	__unused caddr_t route,
	155	char *type,
	156	char *edst)
1c79356b	157	{
1c79356b	158	register struct mbuf m = m0;
1c79356b	159	register struct ether_header *eh;
1c79356b	160	int hlen; /* link layer header lenght */
1c79356b A	161
	162
	163
	164	if ((ifp->if_flags & (IFF_UP\|IFF_RUNNING)) != (IFF_UP\|IFF_RUNNING))
	165	return ENETDOWN;
	166
	167	hlen = ETHER_HDR_LEN;
	168
	169	/*
	170	* Tell ether_frameout it's ok to loop packet unless negated below.
	171	*/
	172	m->m_flags \|= M_LOOP;
	173
	174	switch (dst_netaddr->sa_family) {
	175	case AF_UNSPEC:
	176	m->m_flags &= ~M_LOOP;
	177	eh = (struct ether_header *)dst_netaddr->sa_data;
	178	(void)memcpy(edst, eh->ether_dhost, 6);
	179	(u_short )type = eh->ether_type;
	180	break;
	181
	182
	183	case AF_APPLETALK:
	184	{
	185	eh = (struct ether_header *)dst_netaddr->sa_data;
	186	bcopy((caddr_t)eh->ether_dhost, (caddr_t)edst, 6);
	187
	188	(u_short )type = m->m_pkthdr.len;
	189	}
	190	break;
	191
	192
	193	default:
	194	kprintf("%s%d: can't handle af%d\n", ifp->if_name, ifp->if_unit,
	195	dst_netaddr->sa_family);
	196
	197	return EAFNOSUPPORT;
	198	}
	199
	200	return (0);
	201	}
	202
	203
	204
	205
	206
	207	int
91447636 A	208	ether_prmod_ioctl(
	209	__unused u_long protocol_family,
	210	struct ifnet *ifp,
	211	u_long command,
	212	caddr_t data)
1c79356b	213	{
1c79356b A	214	struct ifreq ifr = (struct ifreq ) data;
1c79356b A	215	int error = 0;
1c79356b A	216
	217	switch (command) {
	218
	219	case SIOCSIFADDR:
	220	if ((ifp->if_flags & IFF_RUNNING) == 0) {
91447636	221	ifnet_set_flags(ifp, IFF_UP, IFF_UP);
1c79356b A	222	dlil_ioctl(0, ifp, SIOCSIFFLAGS, (caddr_t) 0);
	223	}
	224
	225	break;
	226
	227	case SIOCGIFADDR:
91447636	228	ifnet_lladdr_copy_bytes(ifp, ifr->ifr_addr.sa_data, ETHER_ADDR_LEN);
1c79356b A	229	break;
	230
	231	case SIOCSIFMTU:
	232	/*
	233	* Set the interface MTU.
	234	*/
	235	if (ifr->ifr_mtu > ETHERMTU) {
	236	error = EINVAL;
	237	} else {
	238	ifp->if_mtu = ifr->ifr_mtu;
	239	}
	240	break;
	241
	242	default:
	243	return EOPNOTSUPP;
	244	}
	245
1c79356b A	246
	247	return (error);
	248	}
	249
	250
	251
91447636 A	252	int
	253	ether_attach_at(
	254	struct ifnet *ifp)
1c79356b A	255	{
	256	struct dlil_proto_reg_str reg;
	257	struct dlil_demux_desc desc;
	258	struct dlil_demux_desc desc2;
1c79356b A	259	int stat;
	260	int first_empty;
	261	int i;
91447636 A	262	u_int8_t atalk_snap[5] = {0x08, 0x00, 0x07, 0x80, 0x9b};
91447636 A	263	u_int8_t aarp_snap[5] = {0x00, 0x00, 0x00, 0x80, 0xf3};
1c79356b A	264
1c79356b A	265	first_empty = MAX_EN_COUNT;
91447636 A	266	for (i=0; i < MAX_EN_COUNT; i++) {
	267	if (en_at_array[i].ifp == 0)
	268	first_empty = i;
	269
	270	if (en_at_array[i].ifp == ifp) {
	271	en_at_array[i].ref_count++;
	272	return 0;
	273	}
1c79356b A	274	}
1c79356b A	275
91447636 A	276	if (first_empty == MAX_EN_COUNT)
	277	return ENOMEM;
	278
	279	bzero(&reg, sizeof(reg));
	280	bzero(&desc, sizeof(desc));
	281	bzero(&desc2, sizeof(desc2));
	282
	283	TAILQ_INIT(&reg.demux_desc_head);
	284	reg.interface_family = ifp->if_family;
	285	reg.unit_number = ifp->if_unit;
	286	reg.input = at_ether_input;
	287	reg.pre_output = ether_pre_output;
	288	reg.ioctl = ether_prmod_ioctl;
	289	reg.protocol_family = PF_APPLETALK;
	290
	291	desc.type = DLIL_DESC_SNAP;
	292	desc.native_type = atalk_snap;
	293	desc.variants.native_type_length = sizeof(atalk_snap);
	294	TAILQ_INSERT_TAIL(&reg.demux_desc_head, &desc, next);
	295
	296	desc2.type = DLIL_DESC_SNAP;
	297	desc2.native_type = aarp_snap;
	298	desc2.variants.native_type_length = sizeof(aarp_snap);
	299	TAILQ_INSERT_TAIL(&reg.demux_desc_head, &desc2, next);
	300
	301	stat = dlil_attach_protocol(&reg);
	302	if (stat) {
	303	printf("WARNING: ether_attach_at can't attach at to interface\n");
	304	return stat;
	305	}
1c79356b	306
91447636 A	307	en_at_array[first_empty].ifp = ifp;
	308	en_at_array[first_empty].ref_count = 1;
	309
	310	return 0;
1c79356b A	311	} /* ether_attach_at */
	312
	313
	314	void
	315	ether_detach_at(struct ifnet *ifp)
	316	{
91447636 A	317	int i;
	318
	319	for (i=0; i < MAX_EN_COUNT; i++) {
	320	if (en_at_array[i].ifp == ifp)
	321	break;
	322	}
	323
	324	if (i < MAX_EN_COUNT) {
	325	if (en_at_array[i].ref_count > 1)
	326	en_at_array[i].ref_count--;
	327	else {
	328	if (en_at_array[i].ref_count == 1) {
	329	dlil_detach_protocol(ifp, PF_APPLETALK);
	330	en_at_array[i].ifp = 0;
	331	}
	332	}
	333	}
1c79356b	334	}