2004-04-22 08:10:48 +08:00
|
|
|
/*
|
|
|
|
* Copyright (c) 1995 Danny Gasparovski.
|
|
|
|
*
|
|
|
|
* Please read the file COPYRIGHT for the
|
|
|
|
* terms and conditions of the copyright.
|
|
|
|
*/
|
|
|
|
|
2016-06-23 01:11:19 +08:00
|
|
|
#include "slirp.h"
|
2004-04-22 08:10:48 +08:00
|
|
|
|
2008-10-01 02:18:27 +08:00
|
|
|
static void
|
2008-08-18 04:21:51 +08:00
|
|
|
ifs_insque(struct mbuf *ifm, struct mbuf *ifmhead)
|
2004-04-22 08:10:48 +08:00
|
|
|
{
|
|
|
|
ifm->ifs_next = ifmhead->ifs_next;
|
|
|
|
ifmhead->ifs_next = ifm;
|
|
|
|
ifm->ifs_prev = ifmhead;
|
|
|
|
ifm->ifs_next->ifs_prev = ifm;
|
|
|
|
}
|
|
|
|
|
2008-10-01 02:18:27 +08:00
|
|
|
static void
|
2008-08-18 04:21:51 +08:00
|
|
|
ifs_remque(struct mbuf *ifm)
|
2004-04-22 08:10:48 +08:00
|
|
|
{
|
|
|
|
ifm->ifs_prev->ifs_next = ifm->ifs_next;
|
|
|
|
ifm->ifs_next->ifs_prev = ifm->ifs_prev;
|
|
|
|
}
|
|
|
|
|
|
|
|
void
|
2009-06-24 20:42:31 +08:00
|
|
|
if_init(Slirp *slirp)
|
2004-04-22 08:10:48 +08:00
|
|
|
{
|
2016-02-23 05:29:21 +08:00
|
|
|
slirp->if_fastq.qh_link = slirp->if_fastq.qh_rlink = &slirp->if_fastq;
|
|
|
|
slirp->if_batchq.qh_link = slirp->if_batchq.qh_rlink = &slirp->if_batchq;
|
2004-04-22 08:10:48 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* if_output: Queue packet into an output queue.
|
2007-09-17 05:08:06 +08:00
|
|
|
* There are 2 output queue's, if_fastq and if_batchq.
|
2004-04-22 08:10:48 +08:00
|
|
|
* Each output queue is a doubly linked list of double linked lists
|
|
|
|
* of mbufs, each list belonging to one "session" (socket). This
|
|
|
|
* way, we can output packets fairly by sending one packet from each
|
|
|
|
* session, instead of all the packets from one session, then all packets
|
2007-09-17 05:08:06 +08:00
|
|
|
* from the next session, etc. Packets on the if_fastq get absolute
|
2004-04-22 08:10:48 +08:00
|
|
|
* priority, but if one session hogs the link, it gets "downgraded"
|
|
|
|
* to the batchq until it runs out of packets, then it'll return
|
|
|
|
* to the fastq (eg. if the user does an ls -alR in a telnet session,
|
|
|
|
* it'll temporarily get downgraded to the batchq)
|
|
|
|
*/
|
|
|
|
void
|
2009-03-07 23:32:56 +08:00
|
|
|
if_output(struct socket *so, struct mbuf *ifm)
|
2004-04-22 08:10:48 +08:00
|
|
|
{
|
2009-06-24 20:42:31 +08:00
|
|
|
Slirp *slirp = ifm->slirp;
|
2004-04-22 08:10:48 +08:00
|
|
|
struct mbuf *ifq;
|
|
|
|
int on_fastq = 1;
|
2007-09-17 05:08:06 +08:00
|
|
|
|
2004-04-22 08:10:48 +08:00
|
|
|
DEBUG_CALL("if_output");
|
2015-08-29 15:12:35 +08:00
|
|
|
DEBUG_ARG("so = %p", so);
|
|
|
|
DEBUG_ARG("ifm = %p", ifm);
|
2007-09-17 05:08:06 +08:00
|
|
|
|
2004-04-22 08:10:48 +08:00
|
|
|
/*
|
|
|
|
* First remove the mbuf from m_usedlist,
|
|
|
|
* since we're gonna use m_next and m_prev ourselves
|
|
|
|
* XXX Shouldn't need this, gotta change dtom() etc.
|
|
|
|
*/
|
|
|
|
if (ifm->m_flags & M_USEDLIST) {
|
|
|
|
remque(ifm);
|
|
|
|
ifm->m_flags &= ~M_USEDLIST;
|
|
|
|
}
|
2007-09-17 05:08:06 +08:00
|
|
|
|
2004-04-22 08:10:48 +08:00
|
|
|
/*
|
2007-09-17 16:09:54 +08:00
|
|
|
* See if there's already a batchq list for this session.
|
2004-04-22 08:10:48 +08:00
|
|
|
* This can include an interactive session, which should go on fastq,
|
|
|
|
* but gets too greedy... hence it'll be downgraded from fastq to batchq.
|
|
|
|
* We mustn't put this packet back on the fastq (or we'll send it out of order)
|
|
|
|
* XXX add cache here?
|
|
|
|
*/
|
2017-09-21 04:42:05 +08:00
|
|
|
if (so) {
|
|
|
|
for (ifq = (struct mbuf *) slirp->if_batchq.qh_rlink;
|
|
|
|
(struct quehead *) ifq != &slirp->if_batchq;
|
|
|
|
ifq = ifq->ifq_prev) {
|
|
|
|
if (so == ifq->ifq_so) {
|
|
|
|
/* A match! */
|
|
|
|
ifm->ifq_so = so;
|
|
|
|
ifs_insque(ifm, ifq->ifs_prev);
|
|
|
|
goto diddit;
|
|
|
|
}
|
2004-04-22 08:10:48 +08:00
|
|
|
}
|
|
|
|
}
|
2007-09-17 05:08:06 +08:00
|
|
|
|
2004-04-22 08:10:48 +08:00
|
|
|
/* No match, check which queue to put it on */
|
|
|
|
if (so && (so->so_iptos & IPTOS_LOWDELAY)) {
|
2016-02-23 05:29:21 +08:00
|
|
|
ifq = (struct mbuf *) slirp->if_fastq.qh_rlink;
|
2004-04-22 08:10:48 +08:00
|
|
|
on_fastq = 1;
|
|
|
|
/*
|
|
|
|
* Check if this packet is a part of the last
|
|
|
|
* packet's session
|
|
|
|
*/
|
|
|
|
if (ifq->ifq_so == so) {
|
|
|
|
ifm->ifq_so = so;
|
|
|
|
ifs_insque(ifm, ifq->ifs_prev);
|
|
|
|
goto diddit;
|
|
|
|
}
|
2012-02-29 16:27:33 +08:00
|
|
|
} else {
|
2016-02-23 05:29:21 +08:00
|
|
|
ifq = (struct mbuf *) slirp->if_batchq.qh_rlink;
|
2012-02-29 16:27:33 +08:00
|
|
|
}
|
2007-09-17 05:08:06 +08:00
|
|
|
|
2004-04-22 08:10:48 +08:00
|
|
|
/* Create a new doubly linked list for this session */
|
|
|
|
ifm->ifq_so = so;
|
|
|
|
ifs_init(ifm);
|
|
|
|
insque(ifm, ifq);
|
2007-09-17 05:08:06 +08:00
|
|
|
|
2004-04-22 08:10:48 +08:00
|
|
|
diddit:
|
|
|
|
if (so) {
|
|
|
|
/* Update *_queued */
|
|
|
|
so->so_queued++;
|
|
|
|
so->so_nqueued++;
|
|
|
|
/*
|
|
|
|
* Check if the interactive session should be downgraded to
|
|
|
|
* the batchq. A session is downgraded if it has queued 6
|
|
|
|
* packets without pausing, and at least 3 of those packets
|
|
|
|
* have been sent over the link
|
|
|
|
* (XXX These are arbitrary numbers, probably not optimal..)
|
|
|
|
*/
|
2007-09-17 05:08:06 +08:00
|
|
|
if (on_fastq && ((so->so_nqueued >= 6) &&
|
2004-04-22 08:10:48 +08:00
|
|
|
(so->so_nqueued - so->so_queued) >= 3)) {
|
2007-09-17 16:09:54 +08:00
|
|
|
|
2004-04-22 08:10:48 +08:00
|
|
|
/* Remove from current queue... */
|
|
|
|
remque(ifm->ifs_next);
|
2007-09-17 16:09:54 +08:00
|
|
|
|
2004-04-22 08:10:48 +08:00
|
|
|
/* ...And insert in the new. That'll teach ya! */
|
2009-06-24 20:42:31 +08:00
|
|
|
insque(ifm->ifs_next, &slirp->if_batchq);
|
2004-04-22 08:10:48 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* This prevents us from malloc()ing too many mbufs
|
|
|
|
*/
|
2009-06-24 20:42:31 +08:00
|
|
|
if_start(ifm->slirp);
|
2004-04-22 08:10:48 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
2017-09-21 04:42:04 +08:00
|
|
|
* Send one packet from each session.
|
2004-04-22 08:10:48 +08:00
|
|
|
* If there are packets on the fastq, they are sent FIFO, before
|
2017-09-21 04:42:04 +08:00
|
|
|
* everything else. Then we choose the first packet from each
|
|
|
|
* batchq session (socket) and send it.
|
|
|
|
* For example, if there are 3 ftp sessions fighting for bandwidth,
|
2004-04-22 08:10:48 +08:00
|
|
|
* one packet will be sent from the first session, then one packet
|
2017-09-21 04:42:04 +08:00
|
|
|
* from the second session, then one packet from the third.
|
2004-04-22 08:10:48 +08:00
|
|
|
*/
|
2012-02-17 23:35:36 +08:00
|
|
|
void if_start(Slirp *slirp)
|
2004-04-22 08:10:48 +08:00
|
|
|
{
|
2018-11-22 06:06:28 +08:00
|
|
|
uint64_t now = slirp->cb->clock_get_ns();
|
2017-09-21 04:42:04 +08:00
|
|
|
bool from_batchq = false;
|
2012-03-06 07:00:07 +08:00
|
|
|
struct mbuf *ifm, *ifm_next, *ifqt;
|
2007-09-17 05:08:06 +08:00
|
|
|
|
2012-02-17 23:35:36 +08:00
|
|
|
DEBUG_CALL("if_start");
|
2007-09-17 05:08:06 +08:00
|
|
|
|
2012-03-06 02:50:39 +08:00
|
|
|
if (slirp->if_start_busy) {
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
slirp->if_start_busy = true;
|
|
|
|
|
2017-09-21 04:42:04 +08:00
|
|
|
struct mbuf *batch_head = NULL;
|
|
|
|
if (slirp->if_batchq.qh_link != &slirp->if_batchq) {
|
|
|
|
batch_head = (struct mbuf *) slirp->if_batchq.qh_link;
|
|
|
|
}
|
|
|
|
|
2016-02-23 05:29:21 +08:00
|
|
|
if (slirp->if_fastq.qh_link != &slirp->if_fastq) {
|
|
|
|
ifm_next = (struct mbuf *) slirp->if_fastq.qh_link;
|
2017-09-21 04:42:04 +08:00
|
|
|
} else if (batch_head) {
|
|
|
|
/* Nothing on fastq, pick up from batchq */
|
|
|
|
ifm_next = batch_head;
|
|
|
|
from_batchq = true;
|
2012-03-06 07:00:07 +08:00
|
|
|
} else {
|
|
|
|
ifm_next = NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
while (ifm_next) {
|
|
|
|
ifm = ifm_next;
|
|
|
|
|
|
|
|
ifm_next = ifm->ifq_next;
|
2016-02-23 05:29:21 +08:00
|
|
|
if ((struct quehead *) ifm_next == &slirp->if_fastq) {
|
2012-03-06 07:00:07 +08:00
|
|
|
/* No more packets in fastq, switch to batchq */
|
2017-09-21 04:42:04 +08:00
|
|
|
ifm_next = batch_head;
|
|
|
|
from_batchq = true;
|
2012-03-06 07:00:07 +08:00
|
|
|
}
|
2016-02-23 05:29:21 +08:00
|
|
|
if ((struct quehead *) ifm_next == &slirp->if_batchq) {
|
2012-03-06 07:00:07 +08:00
|
|
|
/* end of batchq */
|
|
|
|
ifm_next = NULL;
|
2012-02-17 23:35:36 +08:00
|
|
|
}
|
2012-02-17 23:26:38 +08:00
|
|
|
|
|
|
|
/* Try to send packet unless it already expired */
|
|
|
|
if (ifm->expiration_date >= now && !if_encap(slirp, ifm)) {
|
2016-03-15 17:31:19 +08:00
|
|
|
/* Packet is delayed due to pending ARP or NDP resolution */
|
2012-02-17 23:35:36 +08:00
|
|
|
continue;
|
2012-02-17 23:26:38 +08:00
|
|
|
}
|
|
|
|
|
2012-02-17 23:35:36 +08:00
|
|
|
/* Remove it from the queue */
|
|
|
|
ifqt = ifm->ifq_prev;
|
|
|
|
remque(ifm);
|
2007-09-17 05:08:06 +08:00
|
|
|
|
2012-02-17 23:35:36 +08:00
|
|
|
/* If there are more packets for this session, re-queue them */
|
|
|
|
if (ifm->ifs_next != ifm) {
|
2012-03-06 07:00:07 +08:00
|
|
|
struct mbuf *next = ifm->ifs_next;
|
|
|
|
|
|
|
|
insque(next, ifqt);
|
2012-02-17 23:35:36 +08:00
|
|
|
ifs_remque(ifm);
|
2012-03-06 07:00:07 +08:00
|
|
|
if (!from_batchq) {
|
|
|
|
ifm_next = next;
|
2012-02-29 16:27:33 +08:00
|
|
|
}
|
2012-02-17 23:35:36 +08:00
|
|
|
}
|
2007-09-17 05:08:06 +08:00
|
|
|
|
2012-02-17 23:35:36 +08:00
|
|
|
/* Update so_queued */
|
|
|
|
if (ifm->ifq_so && --ifm->ifq_so->so_queued == 0) {
|
|
|
|
/* If there's no more queued, reset nqueued */
|
|
|
|
ifm->ifq_so->so_nqueued = 0;
|
|
|
|
}
|
2007-09-17 05:08:06 +08:00
|
|
|
|
2012-02-17 23:26:38 +08:00
|
|
|
m_free(ifm);
|
2012-02-17 23:35:36 +08:00
|
|
|
}
|
2011-08-02 00:18:37 +08:00
|
|
|
|
2012-03-06 02:50:39 +08:00
|
|
|
slirp->if_start_busy = false;
|
2004-04-22 08:10:48 +08:00
|
|
|
}
|