| version 1.24, 1995/08/12 23:59:36 |
version 1.25, 1995/11/21 01:07:34 |
|
|
| if (pr->pr_domain->dom_family == PF_INET && |
if (pr->pr_domain->dom_family == PF_INET && |
| pr->pr_protocol && pr->pr_protocol != IPPROTO_RAW) |
pr->pr_protocol && pr->pr_protocol != IPPROTO_RAW) |
| ip_protox[pr->pr_protocol] = pr - inetsw; |
ip_protox[pr->pr_protocol] = pr - inetsw; |
| ipq.next = ipq.prev = &ipq; |
LIST_INIT(&ipq); |
| ip_id = time.tv_sec & 0xffff; |
ip_id = time.tv_sec & 0xffff; |
| ipintrq.ifq_maxlen = ipqmaxlen; |
ipintrq.ifq_maxlen = ipqmaxlen; |
| TAILQ_INIT(&in_ifaddr); |
TAILQ_INIT(&in_ifaddr); |
|
|
| register struct mbuf *m; |
register struct mbuf *m; |
| register struct ipq *fp; |
register struct ipq *fp; |
| register struct in_ifaddr *ia; |
register struct in_ifaddr *ia; |
| int hlen, s; |
struct ipqent *ipqe; |
| |
int hlen, mff, s; |
| |
|
| next: |
next: |
| /* |
/* |
|
|
| * Look for queue of fragments |
* Look for queue of fragments |
| * of this datagram. |
* of this datagram. |
| */ |
*/ |
| for (fp = ipq.next; fp != &ipq; fp = fp->next) |
for (fp = ipq.lh_first; fp != NULL; fp = fp->ipq_q.le_next) |
| if (ip->ip_id == fp->ipq_id && |
if (ip->ip_id == fp->ipq_id && |
| ip->ip_src.s_addr == fp->ipq_src.s_addr && |
ip->ip_src.s_addr == fp->ipq_src.s_addr && |
| ip->ip_dst.s_addr == fp->ipq_dst.s_addr && |
ip->ip_dst.s_addr == fp->ipq_dst.s_addr && |
|
|
| |
|
| /* |
/* |
| * Adjust ip_len to not reflect header, |
* Adjust ip_len to not reflect header, |
| * set ip_mff if more fragments are expected, |
* set ipqe_mff if more fragments are expected, |
| * convert offset of this to bytes. |
* convert offset of this to bytes. |
| */ |
*/ |
| ip->ip_len -= hlen; |
ip->ip_len -= hlen; |
| ((struct ipasfrag *)ip)->ipf_mff &= ~1; |
mff = (ip->ip_off & IP_MF) != 0; |
| if (ip->ip_off & IP_MF) { |
if (mff) { |
| /* |
/* |
| * Make sure that fragments have a data length |
* Make sure that fragments have a data length |
| * that's a non-zero multiple of 8 bytes. |
* that's a non-zero multiple of 8 bytes. |
|
|
| ipstat.ips_badfrags++; |
ipstat.ips_badfrags++; |
| goto bad; |
goto bad; |
| } |
} |
| ((struct ipasfrag *)ip)->ipf_mff |= 1; |
|
| } |
} |
| ip->ip_off <<= 3; |
ip->ip_off <<= 3; |
| |
|
|
|
| * or if this is not the first fragment, |
* or if this is not the first fragment, |
| * attempt reassembly; if it succeeds, proceed. |
* attempt reassembly; if it succeeds, proceed. |
| */ |
*/ |
| if (((struct ipasfrag *)ip)->ipf_mff & 1 || ip->ip_off) { |
if (mff || ip->ip_off) { |
| ipstat.ips_fragments++; |
ipstat.ips_fragments++; |
| ip = ip_reass((struct ipasfrag *)ip, fp); |
MALLOC(ipqe, struct ipqent *, sizeof (struct ipqent), |
| |
M_IPQ, M_NOWAIT); |
| |
if (ipqe == NULL) { |
| |
ipstat.ips_rcvmemdrop++; |
| |
goto bad; |
| |
} |
| |
ipqe->ipqe_mff = mff; |
| |
ipqe->ipqe_ip = ip; |
| |
ip = ip_reass(ipqe, fp); |
| if (ip == 0) |
if (ip == 0) |
| goto next; |
goto next; |
| ipstat.ips_reassembled++; |
ipstat.ips_reassembled++; |
|
|
| * is given as fp; otherwise have to make a chain. |
* is given as fp; otherwise have to make a chain. |
| */ |
*/ |
| struct ip * |
struct ip * |
| ip_reass(ip, fp) |
ip_reass(ipqe, fp) |
| register struct ipasfrag *ip; |
register struct ipqent *ipqe; |
| register struct ipq *fp; |
register struct ipq *fp; |
| { |
{ |
| register struct mbuf *m = dtom(ip); |
register struct mbuf *m = dtom(ipqe->ipqe_ip); |
| register struct ipasfrag *q; |
register struct ipqent *nq, *p, *q; |
| |
struct ip *ip; |
| struct mbuf *t; |
struct mbuf *t; |
| int hlen = ip->ip_hl << 2; |
int hlen = ipqe->ipqe_ip->ip_hl << 2; |
| int i, next; |
int i, next; |
| |
|
| /* |
/* |
| Line 427 ip_reass(ip, fp) |
|
| Line 436 ip_reass(ip, fp) |
|
| if ((t = m_get(M_DONTWAIT, MT_FTABLE)) == NULL) |
if ((t = m_get(M_DONTWAIT, MT_FTABLE)) == NULL) |
| goto dropfrag; |
goto dropfrag; |
| fp = mtod(t, struct ipq *); |
fp = mtod(t, struct ipq *); |
| insque(fp, &ipq); |
LIST_INSERT_HEAD(&ipq, fp, ipq_q); |
| fp->ipq_ttl = IPFRAGTTL; |
fp->ipq_ttl = IPFRAGTTL; |
| fp->ipq_p = ip->ip_p; |
fp->ipq_p = ipqe->ipqe_ip->ip_p; |
| fp->ipq_id = ip->ip_id; |
fp->ipq_id = ipqe->ipqe_ip->ip_id; |
| fp->ipq_next = fp->ipq_prev = (struct ipasfrag *)fp; |
LIST_INIT(&fp->ipq_fragq); |
| fp->ipq_src = ((struct ip *)ip)->ip_src; |
fp->ipq_src = ipqe->ipqe_ip->ip_src; |
| fp->ipq_dst = ((struct ip *)ip)->ip_dst; |
fp->ipq_dst = ipqe->ipqe_ip->ip_dst; |
| q = (struct ipasfrag *)fp; |
p = NULL; |
| goto insert; |
goto insert; |
| } |
} |
| |
|
| /* |
/* |
| * Find a segment which begins after this one does. |
* Find a segment which begins after this one does. |
| */ |
*/ |
| for (q = fp->ipq_next; q != (struct ipasfrag *)fp; q = q->ipf_next) |
for (p = NULL, q = fp->ipq_fragq.lh_first; q != NULL; |
| if (q->ip_off > ip->ip_off) |
p = q, q = q->ipqe_q.le_next) |
| |
if (q->ipqe_ip->ip_off > ipqe->ipqe_ip->ip_off) |
| break; |
break; |
| |
|
| /* |
/* |
| Line 450 ip_reass(ip, fp) |
|
| Line 460 ip_reass(ip, fp) |
|
| * our data already. If so, drop the data from the incoming |
* our data already. If so, drop the data from the incoming |
| * segment. If it provides all of our data, drop us. |
* segment. If it provides all of our data, drop us. |
| */ |
*/ |
| if (q->ipf_prev != (struct ipasfrag *)fp) { |
if (p != NULL) { |
| i = q->ipf_prev->ip_off + q->ipf_prev->ip_len - ip->ip_off; |
i = p->ipqe_ip->ip_off + p->ipqe_ip->ip_len - |
| |
ipqe->ipqe_ip->ip_off; |
| if (i > 0) { |
if (i > 0) { |
| if (i >= ip->ip_len) |
if (i >= ipqe->ipqe_ip->ip_len) |
| goto dropfrag; |
goto dropfrag; |
| m_adj(dtom(ip), i); |
m_adj(dtom(ipqe->ipqe_ip), i); |
| ip->ip_off += i; |
ipqe->ipqe_ip->ip_off += i; |
| ip->ip_len -= i; |
ipqe->ipqe_ip->ip_len -= i; |
| } |
} |
| } |
} |
| |
|
| Line 465 ip_reass(ip, fp) |
|
| Line 476 ip_reass(ip, fp) |
|
| * While we overlap succeeding segments trim them or, |
* While we overlap succeeding segments trim them or, |
| * if they are completely covered, dequeue them. |
* if they are completely covered, dequeue them. |
| */ |
*/ |
| while (q != (struct ipasfrag *)fp && ip->ip_off + ip->ip_len > q->ip_off) { |
for (; q != NULL && ipqe->ipqe_ip->ip_off + ipqe->ipqe_ip->ip_len > |
| i = (ip->ip_off + ip->ip_len) - q->ip_off; |
q->ipqe_ip->ip_off; q = nq) { |
| if (i < q->ip_len) { |
i = (ipqe->ipqe_ip->ip_off + ipqe->ipqe_ip->ip_len) - |
| q->ip_len -= i; |
q->ipqe_ip->ip_off; |
| q->ip_off += i; |
if (i < q->ipqe_ip->ip_len) { |
| m_adj(dtom(q), i); |
q->ipqe_ip->ip_len -= i; |
| |
q->ipqe_ip->ip_off += i; |
| |
m_adj(dtom(q->ipqe_ip), i); |
| break; |
break; |
| } |
} |
| q = q->ipf_next; |
nq = q->ipqe_q.le_next; |
| m_freem(dtom(q->ipf_prev)); |
m_freem(dtom(q->ipqe_ip)); |
| ip_deq(q->ipf_prev); |
LIST_REMOVE(q, ipqe_q); |
| |
FREE(q, M_IPQ); |
| } |
} |
| |
|
| insert: |
insert: |
|
|
| * Stick new segment in its place; |
* Stick new segment in its place; |
| * check for complete reassembly. |
* check for complete reassembly. |
| */ |
*/ |
| ip_enq(ip, q->ipf_prev); |
if (p == NULL) { |
| |
LIST_INSERT_HEAD(&fp->ipq_fragq, ipqe, ipqe_q); |
| |
} else { |
| |
LIST_INSERT_AFTER(p, ipqe, ipqe_q); |
| |
} |
| next = 0; |
next = 0; |
| for (q = fp->ipq_next; q != (struct ipasfrag *)fp; q = q->ipf_next) { |
for (p = NULL, q = fp->ipq_fragq.lh_first; q != NULL; |
| if (q->ip_off != next) |
p = q, q = q->ipqe_q.le_next) { |
| |
if (q->ipqe_ip->ip_off != next) |
| return (0); |
return (0); |
| next += q->ip_len; |
next += q->ipqe_ip->ip_len; |
| } |
} |
| if (q->ipf_prev->ipf_mff & 1) |
if (p->ipqe_mff) |
| return (0); |
return (0); |
| |
|
| /* |
/* |
| * Reassembly is complete; concatenate fragments. |
* Reassembly is complete; concatenate fragments. |
| */ |
*/ |
| q = fp->ipq_next; |
q = fp->ipq_fragq.lh_first; |
| m = dtom(q); |
ip = q->ipqe_ip; |
| |
m = dtom(q->ipqe_ip); |
| t = m->m_next; |
t = m->m_next; |
| m->m_next = 0; |
m->m_next = 0; |
| m_cat(m, t); |
m_cat(m, t); |
| q = q->ipf_next; |
nq = q->ipqe_q.le_next; |
| while (q != (struct ipasfrag *)fp) { |
FREE(q, M_IPQ); |
| t = dtom(q); |
for (q = nq; q != NULL; q = nq) { |
| q = q->ipf_next; |
t = dtom(q->ipqe_ip); |
| |
nq = q->ipqe_q.le_next; |
| |
FREE(q, M_IPQ); |
| m_cat(m, t); |
m_cat(m, t); |
| } |
} |
| |
|
|
|
| * dequeue and discard fragment reassembly header. |
* dequeue and discard fragment reassembly header. |
| * Make header visible. |
* Make header visible. |
| */ |
*/ |
| ip = fp->ipq_next; |
|
| ip->ip_len = next; |
ip->ip_len = next; |
| ip->ipf_mff &= ~1; |
ip->ip_src = fp->ipq_src; |
| ((struct ip *)ip)->ip_src = fp->ipq_src; |
ip->ip_dst = fp->ipq_dst; |
| ((struct ip *)ip)->ip_dst = fp->ipq_dst; |
LIST_REMOVE(fp, ipq_q); |
| remque(fp); |
|
| (void) m_free(dtom(fp)); |
(void) m_free(dtom(fp)); |
| m = dtom(ip); |
|
| m->m_len += (ip->ip_hl << 2); |
m->m_len += (ip->ip_hl << 2); |
| m->m_data -= (ip->ip_hl << 2); |
m->m_data -= (ip->ip_hl << 2); |
| /* some debugging cruft by sklower, below, will go away soon */ |
/* some debugging cruft by sklower, below, will go away soon */ |
|
|
| plen += m->m_len; |
plen += m->m_len; |
| t->m_pkthdr.len = plen; |
t->m_pkthdr.len = plen; |
| } |
} |
| return ((struct ip *)ip); |
return (ip); |
| |
|
| dropfrag: |
dropfrag: |
| ipstat.ips_fragdropped++; |
ipstat.ips_fragdropped++; |
| m_freem(m); |
m_freem(m); |
| |
FREE(ipqe, M_IPQ); |
| return (0); |
return (0); |
| } |
} |
| |
|
|
|
| ip_freef(fp) |
ip_freef(fp) |
| struct ipq *fp; |
struct ipq *fp; |
| { |
{ |
| register struct ipasfrag *q, *p; |
register struct ipqent *q, *p; |
| |
|
| for (q = fp->ipq_next; q != (struct ipasfrag *)fp; q = p) { |
for (q = fp->ipq_fragq.lh_first; q != NULL; q = p) { |
| p = q->ipf_next; |
p = q->ipqe_q.le_next; |
| ip_deq(q); |
m_freem(dtom(q->ipqe_ip)); |
| m_freem(dtom(q)); |
LIST_REMOVE(q, ipqe_q); |
| |
FREE(q, M_IPQ); |
| } |
} |
| remque(fp); |
LIST_REMOVE(fp, ipq_q); |
| (void) m_free(dtom(fp)); |
(void) m_free(dtom(fp)); |
| } |
} |
| |
|
| /* |
/* |
| * Put an ip fragment on a reassembly chain. |
|
| * Like insque, but pointers in middle of structure. |
|
| */ |
|
| void |
|
| ip_enq(p, prev) |
|
| register struct ipasfrag *p, *prev; |
|
| { |
|
| |
|
| p->ipf_prev = prev; |
|
| p->ipf_next = prev->ipf_next; |
|
| prev->ipf_next->ipf_prev = p; |
|
| prev->ipf_next = p; |
|
| } |
|
| |
|
| /* |
|
| * To ip_enq as remque is to insque. |
|
| */ |
|
| void |
|
| ip_deq(p) |
|
| register struct ipasfrag *p; |
|
| { |
|
| |
|
| p->ipf_prev->ipf_next = p->ipf_next; |
|
| p->ipf_next->ipf_prev = p->ipf_prev; |
|
| } |
|
| |
|
| /* |
|
| * IP timer processing; |
* IP timer processing; |
| * if a timer expires on a reassembly |
* if a timer expires on a reassembly |
| * queue, discard it. |
* queue, discard it. |
|
|
| void |
void |
| ip_slowtimo() |
ip_slowtimo() |
| { |
{ |
| register struct ipq *fp; |
register struct ipq *fp, *nfp; |
| int s = splsoftnet(); |
int s = splsoftnet(); |
| |
|
| fp = ipq.next; |
for (fp = ipq.lh_first; fp != NULL; fp = nfp) { |
| if (fp == 0) { |
nfp = fp->ipq_q.le_next; |
| splx(s); |
if (--fp->ipq_ttl == 0) { |
| return; |
|
| } |
|
| while (fp != &ipq) { |
|
| --fp->ipq_ttl; |
|
| fp = fp->next; |
|
| if (fp->prev->ipq_ttl == 0) { |
|
| ipstat.ips_fragtimeout++; |
ipstat.ips_fragtimeout++; |
| ip_freef(fp->prev); |
ip_freef(fp); |
| } |
} |
| } |
} |
| splx(s); |
splx(s); |
|
|
| ip_drain() |
ip_drain() |
| { |
{ |
| |
|
| while (ipq.next != &ipq) { |
while (ipq.lh_first != NULL) { |
| ipstat.ips_fragdropped++; |
ipstat.ips_fragdropped++; |
| ip_freef(ipq.next); |
ip_freef(ipq.lh_first); |
| } |
} |
| } |
} |
| |
|