#include "carp.h"
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/mbuf.h>
#include <sys/socket.h>
#include <sys/timeout.h>
#include <sys/syslog.h>
#include <sys/queue.h>
#include <sys/pool.h>
#include <net/if.h>
#include <net/if_var.h>
#include <net/if_dl.h>
#include <net/route.h>
#include <net/if_types.h>
#include <net/netisr.h>
#include <netinet/in.h>
#include <netinet/if_ether.h>
#include <netinet/ip_var.h>
#if NCARP > 0
#include <netinet/ip_carp.h>
#endif
struct llinfo_arp {
LIST_ENTRY(llinfo_arp) la_list;
struct rtentry *la_rt;
struct refcnt la_refcnt;
struct mbuf_queue la_mq;
time_t la_refreshed;
int la_asked;
};
#define LA_HOLD_QUEUE 10
#define LA_HOLD_TOTAL 100
struct llinfo_arp_iterator {
LIST_ENTRY(llinfo_arp) la_list;
struct rtentry *la_rt;
};
int arpt_prune = (5 * 60);
int arpt_keep = (20 * 60);
int arpt_down = 20;
struct mbuf *arppullup(struct mbuf *m);
void arpinvalidate(struct rtentry *);
void arptfree(struct rtentry *);
void arptimer(void *);
struct rtentry *arplookup(struct in_addr *, int, int, unsigned int);
void in_arpinput(struct ifnet *, struct mbuf *);
void in_revarpinput(struct ifnet *, struct mbuf *);
int arpcache(struct ifnet *, struct ether_arp *, struct rtentry *);
void arpreply(struct ifnet *, struct mbuf *, struct in_addr *, uint8_t *,
unsigned int);
struct niqueue arpinq = NIQUEUE_INITIALIZER(50, NETISR_ARP);
struct mutex arp_mtx = MUTEX_INITIALIZER(IPL_SOFTNET);
LIST_HEAD(, llinfo_arp) arp_list = LIST_HEAD_INITIALIZER(arp_list);
struct pool arp_pool;
int arp_maxtries = 5;
unsigned int la_hold_total;
#ifdef NFSCLIENT
struct in_addr revarp_myip, revarp_srvip;
int revarp_finished;
unsigned int revarp_ifidx;
#endif
static struct llinfo_arp *
arpiterator(struct llinfo_arp *la, struct llinfo_arp_iterator *iter)
{
struct llinfo_arp *tmp;
MUTEX_ASSERT_LOCKED(&arp_mtx);
if (la)
tmp = LIST_NEXT((struct llinfo_arp *)iter, la_list);
else
tmp = LIST_FIRST(&arp_list);
while (tmp && tmp->la_rt == NULL)
tmp = LIST_NEXT(tmp, la_list);
if (la) {
LIST_REMOVE((struct llinfo_arp *)iter, la_list);
if (refcnt_rele(&la->la_refcnt))
pool_put(&arp_pool, la);
}
if (tmp) {
LIST_INSERT_AFTER(tmp, (struct llinfo_arp *)iter, la_list);
refcnt_take(&tmp->la_refcnt);
}
return tmp;
}
void
arptimer(void *arg)
{
struct timeout *to = arg;
struct llinfo_arp_iterator iter = { .la_rt = NULL };
struct llinfo_arp *la = NULL;
time_t uptime;
uptime = getuptime();
timeout_add_sec(to, arpt_prune);
mtx_enter(&arp_mtx);
while ((la = arpiterator(la, &iter)) != NULL) {
struct rtentry *rt = la->la_rt;
if (rt->rt_expire && rt->rt_expire < uptime) {
rtref(rt);
mtx_leave(&arp_mtx);
NET_LOCK();
arptfree(rt);
NET_UNLOCK();
rtfree(rt);
mtx_enter(&arp_mtx);
}
}
mtx_leave(&arp_mtx);
}
void
arpinit(void)
{
static struct timeout arptimer_to;
pool_init(&arp_pool, sizeof(struct llinfo_arp), 0,
IPL_SOFTNET, 0, "arp", NULL);
timeout_set_flags(&arptimer_to, arptimer, &arptimer_to,
KCLOCK_NONE, TIMEOUT_PROC | TIMEOUT_MPSAFE);
timeout_add_sec(&arptimer_to, arpt_prune);
}
void
arp_rtrequest(struct ifnet *ifp, int req, struct rtentry *rt)
{
struct sockaddr *gate = rt->rt_gateway;
struct llinfo_arp *la;
time_t uptime;
NET_ASSERT_LOCKED();
if (ISSET(rt->rt_flags,
RTF_GATEWAY|RTF_BROADCAST|RTF_MULTICAST|RTF_MPLS))
return;
uptime = getuptime();
switch (req) {
case RTM_ADD:
if (rt->rt_flags & RTF_CLONING) {
rt->rt_expire = 0;
break;
}
if ((rt->rt_flags & RTF_LOCAL) && rt->rt_llinfo == NULL)
rt->rt_expire = 0;
if (rt->rt_flags & (RTF_ANNOUNCE|RTF_LOCAL))
arprequest(ifp,
&satosin(rt_key(rt))->sin_addr.s_addr,
&satosin(rt_key(rt))->sin_addr.s_addr,
(u_char *)LLADDR(satosdl(gate)));
case RTM_RESOLVE:
if (gate->sa_family != AF_LINK ||
gate->sa_len < sizeof(struct sockaddr_dl)) {
log(LOG_DEBUG, "%s: bad gateway value: %s\n", __func__,
ifp->if_xname);
break;
}
satosdl(gate)->sdl_type = ifp->if_type;
satosdl(gate)->sdl_index = ifp->if_index;
la = pool_get(&arp_pool, PR_NOWAIT | PR_ZERO);
if (la == NULL) {
log(LOG_DEBUG, "%s: pool get failed\n", __func__);
break;
}
mtx_enter(&arp_mtx);
if (rt->rt_llinfo != NULL) {
mtx_leave(&arp_mtx);
pool_put(&arp_pool, la);
break;
}
refcnt_init(&la->la_refcnt);
mq_init(&la->la_mq, LA_HOLD_QUEUE, IPL_SOFTNET);
rt->rt_llinfo = (caddr_t)la;
la->la_rt = rt;
rt->rt_flags |= RTF_LLINFO;
LIST_INSERT_HEAD(&arp_list, la, la_list);
if ((rt->rt_flags & RTF_LOCAL) == 0)
rt->rt_expire = uptime;
mtx_leave(&arp_mtx);
break;
case RTM_DELETE:
mtx_enter(&arp_mtx);
la = (struct llinfo_arp *)rt->rt_llinfo;
if (la == NULL) {
mtx_leave(&arp_mtx);
break;
}
LIST_REMOVE(la, la_list);
rt->rt_llinfo = NULL;
rt->rt_flags &= ~RTF_LLINFO;
atomic_sub_int(&la_hold_total, mq_purge(&la->la_mq));
mtx_leave(&arp_mtx);
if (refcnt_rele(&la->la_refcnt))
pool_put(&arp_pool, la);
break;
case RTM_INVALIDATE:
if (!ISSET(rt->rt_flags, RTF_LOCAL))
arpinvalidate(rt);
break;
}
}
void
arprequest(struct ifnet *ifp, u_int32_t *sip, u_int32_t *tip, u_int8_t *enaddr)
{
struct mbuf *m;
struct ether_header *eh;
struct ether_arp *ea;
struct sockaddr sa;
if ((m = m_gethdr(M_DONTWAIT, MT_DATA)) == NULL)
return;
m->m_len = sizeof(*ea);
m->m_pkthdr.len = sizeof(*ea);
m->m_pkthdr.ph_rtableid = ifp->if_rdomain;
m->m_pkthdr.pf.prio = ifp->if_llprio;
m_align(m, sizeof(*ea));
ea = mtod(m, struct ether_arp *);
eh = (struct ether_header *)sa.sa_data;
memset(ea, 0, sizeof(*ea));
memcpy(eh->ether_dhost, etherbroadcastaddr, sizeof(eh->ether_dhost));
eh->ether_type = htons(ETHERTYPE_ARP);
ea->arp_hrd = htons(ARPHRD_ETHER);
ea->arp_pro = htons(ETHERTYPE_IP);
ea->arp_hln = sizeof(ea->arp_sha);
ea->arp_pln = sizeof(ea->arp_spa);
ea->arp_op = htons(ARPOP_REQUEST);
memcpy(eh->ether_shost, enaddr, sizeof(eh->ether_shost));
memcpy(ea->arp_sha, enaddr, sizeof(ea->arp_sha));
memcpy(ea->arp_spa, sip, sizeof(ea->arp_spa));
memcpy(ea->arp_tpa, tip, sizeof(ea->arp_tpa));
sa.sa_family = pseudo_AF_HDRCMPLT;
sa.sa_len = sizeof(sa);
m->m_flags |= M_BCAST;
ifp->if_output(ifp, m, &sa, NULL);
}
void
arpreply(struct ifnet *ifp, struct mbuf *m, struct in_addr *sip, uint8_t *eaddr,
unsigned int rdomain)
{
struct ether_header *eh;
struct ether_arp *ea;
struct sockaddr sa;
m_resethdr(m);
m->m_pkthdr.ph_rtableid = rdomain;
ea = mtod(m, struct ether_arp *);
ea->arp_op = htons(ARPOP_REPLY);
ea->arp_pro = htons(ETHERTYPE_IP);
memcpy(ea->arp_tha, ea->arp_sha, sizeof(ea->arp_sha));
memcpy(ea->arp_tpa, ea->arp_spa, sizeof(ea->arp_spa));
memcpy(ea->arp_sha, eaddr, sizeof(ea->arp_sha));
memcpy(ea->arp_spa, sip, sizeof(ea->arp_spa));
eh = (struct ether_header *)sa.sa_data;
memcpy(eh->ether_dhost, ea->arp_tha, sizeof(eh->ether_dhost));
memcpy(eh->ether_shost, eaddr, sizeof(eh->ether_shost));
eh->ether_type = htons(ETHERTYPE_ARP);
sa.sa_family = pseudo_AF_HDRCMPLT;
sa.sa_len = sizeof(sa);
ifp->if_output(ifp, m, &sa, NULL);
}
int
arpresolve(struct ifnet *ifp, struct rtentry *rt0, struct mbuf *m,
struct sockaddr *dst, u_char *desten)
{
struct arpcom *ac = (struct arpcom *)ifp;
struct llinfo_arp *la;
struct sockaddr_dl *sdl;
struct rtentry *rt = NULL;
char addr[INET_ADDRSTRLEN];
time_t uptime;
int refresh = 0, reject = 0;
if (m->m_flags & M_BCAST) {
memcpy(desten, etherbroadcastaddr, sizeof(etherbroadcastaddr));
return (0);
}
if (m->m_flags & M_MCAST) {
ETHER_MAP_IP_MULTICAST(&satosin(dst)->sin_addr, desten);
return (0);
}
uptime = getuptime();
rt = rt_getll(rt0);
if (rt == NULL || (ISSET(rt->rt_flags, RTF_REJECT) &&
(rt->rt_expire == 0 || rt->rt_expire > uptime))) {
m_freem(m);
return (rt == rt0 ? EHOSTDOWN : EHOSTUNREACH);
}
if (!ISSET(rt->rt_flags, RTF_LLINFO)) {
log(LOG_DEBUG, "%s: %s: route contains no arp information\n",
__func__, inet_ntop(AF_INET, &satosin(rt_key(rt))->sin_addr,
addr, sizeof(addr)));
goto bad;
}
sdl = satosdl(rt->rt_gateway);
if (sdl->sdl_alen > 0 && sdl->sdl_alen != ETHER_ADDR_LEN) {
log(LOG_DEBUG, "%s: %s: incorrect arp information\n", __func__,
inet_ntop(AF_INET, &satosin(dst)->sin_addr,
addr, sizeof(addr)));
goto bad;
}
if ((rt->rt_expire == 0 || rt->rt_expire > uptime) &&
sdl->sdl_family == AF_LINK && sdl->sdl_alen != 0) {
memcpy(desten, LLADDR(sdl), sdl->sdl_alen);
if (rt->rt_expire != 0 &&
rt->rt_expire - atomic_load_int(&arpt_keep) / 8 < uptime) {
mtx_enter(&arp_mtx);
la = (struct llinfo_arp *)rt->rt_llinfo;
if (la != NULL) {
if (la->la_refreshed + 30 < uptime) {
la->la_refreshed = uptime;
refresh = 1;
}
}
mtx_leave(&arp_mtx);
}
if (refresh) {
arprequest(ifp,
&satosin(rt->rt_ifa->ifa_addr)->sin_addr.s_addr,
&satosin(dst)->sin_addr.s_addr,
ac->ac_enaddr);
}
return (0);
}
if (ifp->if_flags & (IFF_NOARP|IFF_STATICARP))
goto bad;
mtx_enter(&arp_mtx);
la = (struct llinfo_arp *)rt->rt_llinfo;
if (la == NULL) {
mtx_leave(&arp_mtx);
goto bad;
}
if (atomic_inc_int_nv(&la_hold_total) <= LA_HOLD_TOTAL) {
if (mq_push(&la->la_mq, m) != 0)
atomic_dec_int(&la_hold_total);
} else {
atomic_sub_int(&la_hold_total, mq_purge(&la->la_mq) + 1);
m_freem(m);
}
#ifdef DIAGNOSTIC
if (rt->rt_expire == 0) {
printf("%s: unresolved and rt_expire == 0\n", __func__);
rt->rt_expire = uptime;
}
#endif
if (rt->rt_expire) {
reject = ~RTF_REJECT;
if (la->la_asked == 0 || rt->rt_expire != uptime) {
rt->rt_expire = uptime;
if (la->la_asked++ < arp_maxtries)
refresh = 1;
else {
reject = RTF_REJECT;
rt->rt_expire += atomic_load_int(&arpt_down);
la->la_asked = 0;
la->la_refreshed = 0;
atomic_sub_int(&la_hold_total,
mq_purge(&la->la_mq));
}
}
}
mtx_leave(&arp_mtx);
if (reject == RTF_REJECT && !ISSET(rt->rt_flags, RTF_REJECT)) {
KERNEL_LOCK();
SET(rt->rt_flags, RTF_REJECT);
KERNEL_UNLOCK();
}
if (reject == ~RTF_REJECT && ISSET(rt->rt_flags, RTF_REJECT)) {
KERNEL_LOCK();
CLR(rt->rt_flags, RTF_REJECT);
KERNEL_UNLOCK();
}
if (refresh)
arprequest(ifp, &satosin(rt->rt_ifa->ifa_addr)->sin_addr.s_addr,
&satosin(dst)->sin_addr.s_addr, ac->ac_enaddr);
return (EAGAIN);
bad:
m_freem(m);
return (EINVAL);
}
struct mbuf *
arppullup(struct mbuf *m)
{
struct arphdr *ar;
int len;
#ifdef DIAGNOSTIC
if ((m->m_flags & M_PKTHDR) == 0)
panic("arp without packet header");
#endif
len = sizeof(struct arphdr);
if (m->m_len < len && (m = m_pullup(m, len)) == NULL)
return NULL;
ar = mtod(m, struct arphdr *);
if (ntohs(ar->ar_hrd) != ARPHRD_ETHER ||
ntohs(ar->ar_pro) != ETHERTYPE_IP ||
ar->ar_hln != ETHER_ADDR_LEN ||
ar->ar_pln != sizeof(struct in_addr)) {
m_freem(m);
return NULL;
}
len += 2 * (ar->ar_hln + ar->ar_pln);
if (m->m_len < len && (m = m_pullup(m, len)) == NULL)
return NULL;
return m;
}
void
arpinput(struct ifnet *ifp, struct mbuf *m, struct netstack *ns)
{
if ((m = arppullup(m)) == NULL)
return;
niq_enqueue(&arpinq, m);
}
void
arpintr(void)
{
struct mbuf_list ml;
struct mbuf *m;
struct ifnet *ifp;
niq_delist(&arpinq, &ml);
while ((m = ml_dequeue(&ml)) != NULL) {
ifp = if_get(m->m_pkthdr.ph_ifidx);
if (ifp != NULL)
in_arpinput(ifp, m);
else
m_freem(m);
if_put(ifp);
}
}
void
in_arpinput(struct ifnet *ifp, struct mbuf *m)
{
struct ether_arp *ea;
struct rtentry *rt = NULL;
struct sockaddr_in sin;
struct in_addr isaddr, itaddr;
char addr[INET_ADDRSTRLEN];
int op, target = 0;
unsigned int rdomain;
rdomain = rtable_l2(m->m_pkthdr.ph_rtableid);
ea = mtod(m, struct ether_arp *);
op = ntohs(ea->arp_op);
if ((op != ARPOP_REQUEST) && (op != ARPOP_REPLY))
goto out;
memcpy(&itaddr, ea->arp_tpa, sizeof(itaddr));
memcpy(&isaddr, ea->arp_spa, sizeof(isaddr));
memset(&sin, 0, sizeof(sin));
sin.sin_len = sizeof(sin);
sin.sin_family = AF_INET;
if (ETHER_IS_MULTICAST(ea->arp_sha) &&
ETHER_IS_BROADCAST(ea->arp_sha)) {
inet_ntop(AF_INET, &isaddr, addr, sizeof(addr));
log(LOG_ERR, "arp: ether address is broadcast for IP address "
"%s!\n", addr);
goto out;
}
if (!memcmp(ea->arp_sha, LLADDR(ifp->if_sadl), sizeof(ea->arp_sha)))
goto out;
sin.sin_addr = itaddr;
rt = rtalloc(sintosa(&sin), 0, rdomain);
if (rtisvalid(rt) && ISSET(rt->rt_flags, RTF_LOCAL) &&
rt->rt_ifidx == ifp->if_index)
target = 1;
rtfree(rt);
rt = NULL;
#if NCARP > 0
if (target && op == ARPOP_REQUEST && ifp->if_type == IFT_CARP &&
!carp_iamatch(ifp))
goto out;
#endif
rt = arplookup(&isaddr, target, 0, rdomain);
if (rtisvalid(rt) && ISSET(rt->rt_flags, RTF_LOCAL) &&
rt->rt_ifidx == ifp->if_index && isaddr.s_addr != INADDR_ANY) {
inet_ntop(AF_INET, &isaddr, addr, sizeof(addr));
log(LOG_ERR, "duplicate IP address %s sent from ethernet "
"address %s\n", addr, ether_sprintf(ea->arp_sha));
itaddr = isaddr;
} else if (rt != NULL) {
if (arpcache(ifp, ea, rt))
goto out;
}
if (op == ARPOP_REQUEST) {
uint8_t *eaddr;
if (target) {
eaddr = LLADDR(ifp->if_sadl);
} else {
rtfree(rt);
rt = arplookup(&itaddr, 0, SIN_PROXY, rdomain);
if ((rt == NULL) || (rt->rt_ifidx != ifp->if_index))
goto out;
eaddr = LLADDR(satosdl(rt->rt_gateway));
}
arpreply(ifp, m, &itaddr, eaddr, rdomain);
rtfree(rt);
return;
}
out:
rtfree(rt);
m_freem(m);
}
int
arpcache(struct ifnet *ifp, struct ether_arp *ea, struct rtentry *rt)
{
struct llinfo_arp *la = (struct llinfo_arp *)rt->rt_llinfo;
struct sockaddr_dl *sdl = satosdl(rt->rt_gateway);
struct in_addr *spa = (struct in_addr *)ea->arp_spa;
char addr[INET_ADDRSTRLEN];
struct ifnet *rifp;
time_t uptime;
int changed = 0;
NET_ASSERT_LOCKED_EXCLUSIVE();
KASSERT(sdl != NULL);
if (la == NULL)
return (0);
uptime = getuptime();
if (sdl->sdl_alen > 0) {
if (memcmp(ea->arp_sha, LLADDR(sdl), sdl->sdl_alen)) {
if (ISSET(rt->rt_flags, RTF_PERMANENT_ARP|RTF_LOCAL)) {
inet_ntop(AF_INET, spa, addr, sizeof(addr));
log(LOG_WARNING, "arp: attempt to overwrite "
"permanent entry for %s by %s on %s\n", addr,
ether_sprintf(ea->arp_sha), ifp->if_xname);
return (-1);
} else if (rt->rt_ifidx != ifp->if_index) {
#if NCARP > 0
if (ifp->if_type != IFT_CARP)
#endif
{
rifp = if_get(rt->rt_ifidx);
if (rifp == NULL)
return (-1);
inet_ntop(AF_INET, spa, addr,
sizeof(addr));
log(LOG_WARNING, "arp: attempt to "
"overwrite entry for %s on %s by "
"%s on %s\n", addr, rifp->if_xname,
ether_sprintf(ea->arp_sha),
ifp->if_xname);
if_put(rifp);
}
return (-1);
} else {
inet_ntop(AF_INET, spa, addr, sizeof(addr));
log(LOG_INFO, "arp info overwritten for %s by "
"%s on %s\n", addr,
ether_sprintf(ea->arp_sha), ifp->if_xname);
rt->rt_expire = 1;
}
changed = 1;
}
} else if (!if_isconnected(ifp, rt->rt_ifidx)) {
rifp = if_get(rt->rt_ifidx);
if (rifp == NULL)
return (-1);
inet_ntop(AF_INET, spa, addr, sizeof(addr));
log(LOG_WARNING, "arp: attempt to add entry for %s on %s by %s"
" on %s\n", addr, rifp->if_xname,
ether_sprintf(ea->arp_sha), ifp->if_xname);
if_put(rifp);
return (-1);
}
sdl->sdl_alen = sizeof(ea->arp_sha);
memcpy(LLADDR(sdl), ea->arp_sha, sizeof(ea->arp_sha));
if (rt->rt_expire)
rt->rt_expire = uptime + atomic_load_int(&arpt_keep);
rt->rt_flags &= ~RTF_REJECT;
if (la->la_asked || changed) {
rtm_send(rt, RTM_RESOLVE, 0, ifp->if_rdomain);
}
la->la_asked = 0;
la->la_refreshed = 0;
if_output_mq(ifp, &la->la_mq, &la_hold_total, rt_key(rt), rt);
return (0);
}
void
arpinvalidate(struct rtentry *rt)
{
struct llinfo_arp *la;
struct sockaddr_dl *sdl = satosdl(rt->rt_gateway);
mtx_enter(&arp_mtx);
la = (struct llinfo_arp *)rt->rt_llinfo;
if (la == NULL) {
mtx_leave(&arp_mtx);
return;
}
atomic_sub_int(&la_hold_total, mq_purge(&la->la_mq));
sdl->sdl_alen = 0;
la->la_asked = 0;
mtx_leave(&arp_mtx);
}
void
arptfree(struct rtentry *rt)
{
struct ifnet *ifp;
NET_ASSERT_LOCKED_EXCLUSIVE();
if (!ISSET(rt->rt_flags, RTF_LLINFO))
return;
KASSERT(!ISSET(rt->rt_flags, RTF_LOCAL));
arpinvalidate(rt);
ifp = if_get(rt->rt_ifidx);
if (ifp == NULL)
return;
if (!ISSET(rt->rt_flags, RTF_STATIC|RTF_CACHED))
rtdeletemsg(rt, ifp, ifp->if_rdomain);
if_put(ifp);
}
struct rtentry *
arplookup(struct in_addr *inp, int create, int proxy, u_int tableid)
{
struct rtentry *rt;
struct sockaddr_inarp sin;
int flags;
memset(&sin, 0, sizeof(sin));
sin.sin_len = sizeof(sin);
sin.sin_family = AF_INET;
sin.sin_addr.s_addr = inp->s_addr;
sin.sin_other = proxy ? SIN_PROXY : 0;
flags = (create) ? RT_RESOLVE : 0;
rt = rtalloc((struct sockaddr *)&sin, flags, tableid);
if (!rtisvalid(rt) || ISSET(rt->rt_flags, RTF_GATEWAY) ||
!ISSET(rt->rt_flags, RTF_LLINFO) ||
rt->rt_gateway->sa_family != AF_LINK) {
rtfree(rt);
return (NULL);
}
if (proxy && !ISSET(rt->rt_flags, RTF_ANNOUNCE)) {
while ((rt = rtable_iterate(rt)) != NULL) {
if (ISSET(rt->rt_flags, RTF_ANNOUNCE)) {
break;
}
}
}
return (rt);
}
int
arpproxy(struct in_addr in, unsigned int rtableid)
{
struct sockaddr_dl *sdl;
struct rtentry *rt;
struct ifnet *ifp;
int found = 0;
rt = arplookup(&in, 0, SIN_PROXY, rtableid);
if (!rtisvalid(rt)) {
rtfree(rt);
return (0);
}
sdl = satosdl(rt->rt_gateway);
if (sdl->sdl_alen != ETHER_ADDR_LEN) {
rtfree(rt);
return (0);
}
ifp = if_get(rt->rt_ifidx);
if (ifp == NULL) {
rtfree(rt);
return (0);
}
if (!memcmp(LLADDR(sdl), LLADDR(ifp->if_sadl), sdl->sdl_alen))
found = 1;
if_put(ifp);
rtfree(rt);
return (found);
}
void
revarpinput(struct ifnet *ifp, struct mbuf *m, struct netstack *ns)
{
if ((m = arppullup(m)) == NULL)
return;
in_revarpinput(ifp, m);
}
void
in_revarpinput(struct ifnet *ifp, struct mbuf *m)
{
struct ether_arp *ar;
int op;
ar = mtod(m, struct ether_arp *);
op = ntohs(ar->arp_op);
switch (op) {
case ARPOP_REQUEST:
case ARPOP_REPLY:
niq_enqueue(&arpinq, m);
return;
case ARPOP_REVREPLY:
break;
case ARPOP_REVREQUEST:
default:
goto out;
}
#ifdef NFSCLIENT
if (revarp_ifidx == 0)
goto out;
if (revarp_ifidx != m->m_pkthdr.ph_ifidx)
goto out;
if (revarp_finished)
goto wake;
if (memcmp(ar->arp_tha, LLADDR(ifp->if_sadl), sizeof(ar->arp_tha)))
goto out;
memcpy(&revarp_srvip, ar->arp_spa, sizeof(revarp_srvip));
memcpy(&revarp_myip, ar->arp_tpa, sizeof(revarp_myip));
revarp_finished = 1;
wake:
wakeup((caddr_t)&revarp_myip);
#endif
out:
m_freem(m);
}
#ifdef NFSCLIENT
void
revarprequest(struct ifnet *ifp)
{
struct sockaddr sa;
struct mbuf *m;
struct ether_header *eh;
struct ether_arp *ea;
struct arpcom *ac = (struct arpcom *)ifp;
if ((m = m_gethdr(M_DONTWAIT, MT_DATA)) == NULL)
return;
m->m_len = sizeof(*ea);
m->m_pkthdr.len = sizeof(*ea);
m->m_pkthdr.ph_rtableid = ifp->if_rdomain;
m->m_pkthdr.pf.prio = ifp->if_llprio;
m_align(m, sizeof(*ea));
ea = mtod(m, struct ether_arp *);
eh = (struct ether_header *)sa.sa_data;
memset(ea, 0, sizeof(*ea));
memcpy(eh->ether_dhost, etherbroadcastaddr, sizeof(eh->ether_dhost));
eh->ether_type = htons(ETHERTYPE_REVARP);
ea->arp_hrd = htons(ARPHRD_ETHER);
ea->arp_pro = htons(ETHERTYPE_IP);
ea->arp_hln = sizeof(ea->arp_sha);
ea->arp_pln = sizeof(ea->arp_spa);
ea->arp_op = htons(ARPOP_REVREQUEST);
memcpy(eh->ether_shost, ac->ac_enaddr, sizeof(ea->arp_tha));
memcpy(ea->arp_sha, ac->ac_enaddr, sizeof(ea->arp_sha));
memcpy(ea->arp_tha, ac->ac_enaddr, sizeof(ea->arp_tha));
sa.sa_family = pseudo_AF_HDRCMPLT;
sa.sa_len = sizeof(sa);
m->m_flags |= M_BCAST;
ifp->if_output(ifp, m, &sa, NULL);
}
int
revarpwhoarewe(struct ifnet *ifp, struct in_addr *serv_in,
struct in_addr *clnt_in)
{
int result, count = 20;
if (revarp_finished)
return EIO;
revarp_ifidx = ifp->if_index;
while (count--) {
revarprequest(ifp);
result = tsleep_nsec(&revarp_myip, PSOCK, "revarp",
MSEC_TO_NSEC(500));
if (result != EWOULDBLOCK)
break;
}
revarp_ifidx = 0;
if (!revarp_finished)
return ENETUNREACH;
memcpy(serv_in, &revarp_srvip, sizeof(*serv_in));
memcpy(clnt_in, &revarp_myip, sizeof(*clnt_in));
return 0;
}
int
revarpwhoami(struct in_addr *in, struct ifnet *ifp)
{
struct in_addr server;
return (revarpwhoarewe(ifp, &server, in));
}
#endif