#if defined(__FreeBSD__) && __FreeBSD__ >= 3
#include "opt_inet.h"
#endif
#include "faith.h"
#if NFAITH > 0
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/mbuf.h>
#include <sys/socket.h>
#include <sys/errno.h>
#if defined(__FreeBSD__) && __FreeBSD__ >= 3 || defined(__APPLE__)
#include <sys/sockio.h>
#else
#include <sys/ioctl.h>
#endif
#include <sys/time.h>
#if defined(__bsdi__) || defined(__NetBSD__)
#include <machine/cpu.h>
#endif
#include <net/if.h>
#include <net/if_types.h>
#include <net/netisr.h>
#include <net/route.h>
#include <net/bpf.h>
#if INET
#include <netinet/in.h>
#include <netinet/in_systm.h>
#include <netinet/in_var.h>
#include <netinet/ip.h>
#endif
#if INET6
#ifndef INET
#include <netinet/in.h>
#endif
#include <netinet6/in6_var.h>
#include <netinet/ip6.h>
#endif
#include <net/dlil.h>
#include "faith.h"
#include "bpfilter.h"
#include <net/net_osdep.h>
#if defined(__FreeBSD__) && __FreeBSD__ < 3
static int faithioctl __P((struct ifnet *, int, caddr_t));
#else
static int faithioctl __P((struct ifnet *, u_long, caddr_t));
#endif
int faith_pre_output __P((struct ifnet *, register struct mbuf **, struct sockaddr *,
register struct rtentry *, char *, char *, u_long));
static void faithrtrequest __P((int, struct rtentry *, struct sockaddr *));
#if defined(__FreeBSD__) || defined (__APPLE__)
void faithattach __P((void *));
#else
void faithattach __P((int));
#endif
#define HAVE_OLD_BPF 1
static struct ifnet faithif[NFAITH];
static struct if_proto *faith_array[NFAITH];
static int faith_count = 0;
#define FAITHMTU 1500
static
int faith_add_if(struct ifnet *ifp)
{
ifp->if_demux = 0;
ifp->if_framer = 0;
return 0;
}
static
int faith_del_if(struct ifnet *ifp)
{
return 0;
}
static
int faith_add_proto(struct ddesc_head_str *desc_head, struct if_proto *proto, u_long dl_tag)
{
int i;
for (i=0; i < faith_count; i++)
if (faith_array[i] == 0) {
faith_array[faith_count] = proto;
return 0;
}
if ((i == faith_count) && (faith_count == NFAITH))
panic("faith_add_proto -- Too many attachments\n");
faith_array[faith_count++] = proto;
return (0);
}
static
int faith_del_proto(struct if_proto *proto, u_long dl_tag)
{
int i;
for (i=0; i < faith_count; i++)
if (faith_array[i] == proto) {
faith_array[i] = 0;
return 0;
}
return ENOENT;
}
int faith_shutdown()
{
return 0;
}
void faith_reg_if_mods()
{
struct dlil_ifmod_reg_str faith_ifmod;
faith_ifmod.add_if = faith_add_if;
faith_ifmod.del_if = faith_del_if;
faith_ifmod.add_proto = faith_add_proto;
faith_ifmod.del_proto = faith_del_proto;
faith_ifmod.ifmod_ioctl = 0;
faith_ifmod.shutdown = faith_shutdown;
if (dlil_reg_if_modules(APPLE_IF_FAM_FAITH, &faith_ifmod))
panic("Couldn't register faith modules\n");
}
u_long faith_attach_inet(struct ifnet *ifp)
{
struct dlil_proto_reg_str reg;
struct dlil_demux_desc desc;
u_long dl_tag=0;
short native=0;
int stat;
int i;
for (i=0; i < faith_count; i++) {
if (faith_array[i] && (faith_array[i]->ifp == ifp) &&
(faith_array[i]->protocol_family == PF_INET)) {
#if 0
kprintf("faith_array for %s%d found dl_tag=%d\n",
ifp->if_name, ifp->if_unit, faith_array[i]->dl_tag);
#endif
return faith_array[i]->dl_tag;
}
}
TAILQ_INIT(®.demux_desc_head);
desc.type = DLIL_DESC_RAW;
desc.variants.bitmask.proto_id_length = 0;
desc.variants.bitmask.proto_id = 0;
desc.variants.bitmask.proto_id_mask = 0;
desc.native_type = (char *) &native;
TAILQ_INSERT_TAIL(®.demux_desc_head, &desc, next);
reg.interface_family = ifp->if_family;
reg.unit_number = ifp->if_unit;
reg.input = 0;
reg.pre_output = faith_pre_output;
reg.event = 0;
reg.offer = 0;
reg.ioctl = faithioctl;
reg.default_proto = 0;
reg.protocol_family = PF_INET;
stat = dlil_attach_protocol(®, &dl_tag);
if (stat) {
panic("faith_attach_inet can't attach interface\n");
}
return dl_tag;
}
void
faithattach(faith)
void *faith;
{
struct ifnet *ifp;
int i;
faith_reg_if_mods();
for (i = 0; i < NFAITH; i++) {
ifp = &faithif[i];
bzero(ifp, sizeof(faithif[i]));
ifp->if_name = "faith";
ifp->if_unit = i;
ifp->if_family = APPLE_IF_FAM_FAITH;
ifp->if_mtu = FAITHMTU;
ifp->if_flags = IFF_BROADCAST | IFF_MULTICAST;
ifp->if_ioctl = faithioctl;
ifp->if_output = NULL;
ifp->if_type = IFT_FAITH;
ifp->if_hdrlen = 0;
ifp->if_addrlen = 0;
dlil_if_attach(ifp);
#if NBPFILTER > 0
#ifdef HAVE_OLD_BPF
bpfattach(ifp, DLT_NULL, sizeof(u_int));
#else
bpfattach(&ifp->if_bpf, ifp, DLT_NULL, sizeof(u_int));
#endif
#endif
}
}
int
faith_pre_output(ifp, m0, dst, rt, frame_type, dst_addr, dl_tag)
struct ifnet *ifp;
register struct mbuf **m0;
struct sockaddr *dst;
register struct rtentry *rt;
char *frame_type;
char *dst_addr;
u_long dl_tag;
{
int s, isr;
register struct ifqueue *ifq = 0;
register struct mbuf *m = *m0;
if ((m->m_flags & M_PKTHDR) == 0)
panic("faithoutput no HDR");
#if NBPFILTER > 0
if (dst && dst->sa_family == AF_UNSPEC) {
dst->sa_family = *(mtod(m, int *));
m->m_len -= sizeof(int);
m->m_pkthdr.len -= sizeof(int);
m->m_data += sizeof(int);
}
if (ifp->if_bpf) {
struct mbuf m0;
u_int af = dst->sa_family;
m0.m_next = m;
m0.m_len = 4;
m0.m_data = (char *)⁡
#if HAVE_OLD_BPF
bpf_mtap(ifp, &m0);
#else
bpf_mtap(ifp->if_bpf, &m0);
#endif
}
#endif
if (rt && rt->rt_flags & (RTF_REJECT|RTF_BLACKHOLE)) {
m_freem(m);
return (EJUSTRETURN);
}
ifp->if_opackets++;
ifp->if_obytes += m->m_pkthdr.len;
switch (dst->sa_family) {
#if INET
case AF_INET:
ifq = &ipintrq;
isr = NETISR_IP;
break;
#endif
#if INET6
case AF_INET6:
ifq = &ip6intrq;
isr = NETISR_IPV6;
break;
#endif
default:
kprintf("faith_pre_output: m=%x family is unknown...(0x%x\n", m, dst->sa_family);
m_freem(m);
return EAFNOSUPPORT;
}
m->m_pkthdr.rcvif = ifp;
s = splimp();
if (IF_QFULL(ifq)) {
IF_DROP(ifq);
m_freem(m);
splx(s);
return (EJUSTRETURN);
}
IF_ENQUEUE(ifq, m);
schednetisr(isr);
ifp->if_ipackets++;
ifp->if_ibytes += m->m_pkthdr.len;
splx(s);
return (EJUSTRETURN);
}
static void
faithrtrequest(cmd, rt, sa)
int cmd;
struct rtentry *rt;
struct sockaddr *sa;
{
if (rt) {
rt->rt_rmx.rmx_mtu = rt->rt_ifp->if_mtu;
rt->rt_rmx.rmx_recvpipe =
rt->rt_rmx.rmx_sendpipe = 3 * FAITHMTU;
}
}
static int
faithioctl(ifp, cmd, data)
register struct ifnet *ifp;
#if defined(__FreeBSD__) && __FreeBSD__ < 3
int cmd;
#else
u_long cmd;
#endif
caddr_t data;
{
register struct ifaddr *ifa;
register struct ifreq *ifr = (struct ifreq *)data;
register int error = 0;
switch (cmd) {
case SIOCSIFADDR:
ifp->if_flags |= IFF_UP | IFF_RUNNING;
ifa = (struct ifaddr *)data;
ifa->ifa_rtrequest = faithrtrequest;
break;
case SIOCADDMULTI:
case SIOCDELMULTI:
if (ifr == 0) {
error = EAFNOSUPPORT;
break;
}
switch (ifr->ifr_addr.sa_family) {
#if INET
case AF_INET:
break;
#endif
#if INET6
case AF_INET6:
break;
#endif
default:
error = EAFNOSUPPORT;
break;
}
break;
#ifdef SIOCSIFMTU
#ifndef __OpenBSD__
case SIOCSIFMTU:
ifp->if_mtu = ifr->ifr_mtu;
break;
#endif
#endif
case SIOCSIFFLAGS:
break;
default:
error = EINVAL;
}
return (error);
}
#endif