Home | History | Annotate | Line # | Download | only in altq
altq_fifoq.c revision 1.2.2.2
      1  1.2.2.2  bouyer /*	$NetBSD: altq_fifoq.c,v 1.2.2.2 2001/01/05 17:39:36 bouyer Exp $	*/
      2  1.2.2.2  bouyer /*	$KAME: altq_fifoq.c,v 1.7 2000/12/14 08:12:45 thorpej Exp $	*/
      3  1.2.2.2  bouyer 
      4  1.2.2.2  bouyer /*
      5  1.2.2.2  bouyer  * Copyright (C) 1997-2000
      6  1.2.2.2  bouyer  *	Sony Computer Science Laboratories Inc.  All rights reserved.
      7  1.2.2.2  bouyer  *
      8  1.2.2.2  bouyer  * Redistribution and use in source and binary forms, with or without
      9  1.2.2.2  bouyer  * modification, are permitted provided that the following conditions
     10  1.2.2.2  bouyer  * are met:
     11  1.2.2.2  bouyer  * 1. Redistributions of source code must retain the above copyright
     12  1.2.2.2  bouyer  *    notice, this list of conditions and the following disclaimer.
     13  1.2.2.2  bouyer  * 2. Redistributions in binary form must reproduce the above copyright
     14  1.2.2.2  bouyer  *    notice, this list of conditions and the following disclaimer in the
     15  1.2.2.2  bouyer  *    documentation and/or other materials provided with the distribution.
     16  1.2.2.2  bouyer  *
     17  1.2.2.2  bouyer  * THIS SOFTWARE IS PROVIDED BY SONY CSL AND CONTRIBUTORS ``AS IS'' AND
     18  1.2.2.2  bouyer  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     19  1.2.2.2  bouyer  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     20  1.2.2.2  bouyer  * ARE DISCLAIMED.  IN NO EVENT SHALL SONY CSL OR CONTRIBUTORS BE LIABLE
     21  1.2.2.2  bouyer  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     22  1.2.2.2  bouyer  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     23  1.2.2.2  bouyer  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     24  1.2.2.2  bouyer  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     25  1.2.2.2  bouyer  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     26  1.2.2.2  bouyer  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     27  1.2.2.2  bouyer  * SUCH DAMAGE.
     28  1.2.2.2  bouyer  */
     29  1.2.2.2  bouyer 
     30  1.2.2.2  bouyer #if defined(__FreeBSD__) || defined(__NetBSD__)
     31  1.2.2.2  bouyer #include "opt_altq.h"
     32  1.2.2.2  bouyer #endif /* __FreeBSD__ || __NetBSD__ */
     33  1.2.2.2  bouyer #ifdef ALTQ_FIFOQ  /* fifoq is enabled by ALTQ_FIFOQ option in opt_altq.h */
     34  1.2.2.2  bouyer 
     35  1.2.2.2  bouyer /*
     36  1.2.2.2  bouyer  * FIFOQ is an altq sample implementation.  There will be little
     37  1.2.2.2  bouyer  * need to use FIFOQ as an alternative queueing scheme.
     38  1.2.2.2  bouyer  * But this code is provided as a template for those who want to
     39  1.2.2.2  bouyer  * write their own queueing schemes.
     40  1.2.2.2  bouyer  */
     41  1.2.2.2  bouyer 
     42  1.2.2.2  bouyer #include <sys/param.h>
     43  1.2.2.2  bouyer #include <sys/malloc.h>
     44  1.2.2.2  bouyer #include <sys/mbuf.h>
     45  1.2.2.2  bouyer #include <sys/socket.h>
     46  1.2.2.2  bouyer #include <sys/sockio.h>
     47  1.2.2.2  bouyer #include <sys/systm.h>
     48  1.2.2.2  bouyer #include <sys/proc.h>
     49  1.2.2.2  bouyer #include <sys/errno.h>
     50  1.2.2.2  bouyer #include <sys/kernel.h>
     51  1.2.2.2  bouyer 
     52  1.2.2.2  bouyer #include <net/if.h>
     53  1.2.2.2  bouyer #include <net/if_types.h>
     54  1.2.2.2  bouyer #include <netinet/in.h>
     55  1.2.2.2  bouyer 
     56  1.2.2.2  bouyer #include <altq/altq.h>
     57  1.2.2.2  bouyer #include <altq/altq_conf.h>
     58  1.2.2.2  bouyer #include <altq/altq_fifoq.h>
     59  1.2.2.2  bouyer 
     60  1.2.2.2  bouyer #define	FIFOQ_STATS	/* collect statistics */
     61  1.2.2.2  bouyer 
     62  1.2.2.2  bouyer /* fifoq_list keeps all fifoq_state_t's allocated. */
     63  1.2.2.2  bouyer static fifoq_state_t *fifoq_list = NULL;
     64  1.2.2.2  bouyer 
     65  1.2.2.2  bouyer /* internal function prototypes */
     66  1.2.2.2  bouyer static int		fifoq_enqueue __P((struct ifaltq *, struct mbuf *,
     67  1.2.2.2  bouyer 					   struct altq_pktattr *));
     68  1.2.2.2  bouyer static struct mbuf 	*fifoq_dequeue __P((struct ifaltq *, int));
     69  1.2.2.2  bouyer static int 		fifoq_detach __P((fifoq_state_t *));
     70  1.2.2.2  bouyer static int		fifoq_request __P((struct ifaltq *, int, void *));
     71  1.2.2.2  bouyer static void 		fifoq_purge __P((fifoq_state_t *));
     72  1.2.2.2  bouyer 
     73  1.2.2.2  bouyer /*
     74  1.2.2.2  bouyer  * fifoq device interface
     75  1.2.2.2  bouyer  */
     76  1.2.2.2  bouyer altqdev_decl(fifoq);
     77  1.2.2.2  bouyer 
     78  1.2.2.2  bouyer int
     79  1.2.2.2  bouyer fifoqopen(dev, flag, fmt, p)
     80  1.2.2.2  bouyer 	dev_t dev;
     81  1.2.2.2  bouyer 	int flag, fmt;
     82  1.2.2.2  bouyer 	struct proc *p;
     83  1.2.2.2  bouyer {
     84  1.2.2.2  bouyer 	/* everything will be done when the queueing scheme is attached. */
     85  1.2.2.2  bouyer 	return 0;
     86  1.2.2.2  bouyer }
     87  1.2.2.2  bouyer 
     88  1.2.2.2  bouyer /*
     89  1.2.2.2  bouyer  * there are 2 ways to act on close.
     90  1.2.2.2  bouyer  *   detach-all-on-close:
     91  1.2.2.2  bouyer  *	use for the daemon style approach.  if the daemon dies, all the
     92  1.2.2.2  bouyer  *	resource will be released.
     93  1.2.2.2  bouyer  *   no-action-on-close:
     94  1.2.2.2  bouyer  *	use for the command style approach.  (e.g.  fifoq on/off)
     95  1.2.2.2  bouyer  *
     96  1.2.2.2  bouyer  * note: close is called not on every close but when the last reference
     97  1.2.2.2  bouyer  *       is removed (only once with multiple simultaneous references.)
     98  1.2.2.2  bouyer  */
     99  1.2.2.2  bouyer int
    100  1.2.2.2  bouyer fifoqclose(dev, flag, fmt, p)
    101  1.2.2.2  bouyer 	dev_t dev;
    102  1.2.2.2  bouyer 	int flag, fmt;
    103  1.2.2.2  bouyer 	struct proc *p;
    104  1.2.2.2  bouyer {
    105  1.2.2.2  bouyer 	fifoq_state_t *q;
    106  1.2.2.2  bouyer 	int err, error = 0;
    107  1.2.2.2  bouyer 
    108  1.2.2.2  bouyer 	while ((q = fifoq_list) != NULL) {
    109  1.2.2.2  bouyer 		/* destroy all */
    110  1.2.2.2  bouyer 		err = fifoq_detach(q);
    111  1.2.2.2  bouyer 		if (err != 0 && error == 0)
    112  1.2.2.2  bouyer 			error = err;
    113  1.2.2.2  bouyer 	}
    114  1.2.2.2  bouyer 
    115  1.2.2.2  bouyer 	return error;
    116  1.2.2.2  bouyer }
    117  1.2.2.2  bouyer 
    118  1.2.2.2  bouyer int
    119  1.2.2.2  bouyer fifoqioctl(dev, cmd, addr, flag, p)
    120  1.2.2.2  bouyer 	dev_t dev;
    121  1.2.2.2  bouyer 	ioctlcmd_t cmd;
    122  1.2.2.2  bouyer 	caddr_t addr;
    123  1.2.2.2  bouyer 	int flag;
    124  1.2.2.2  bouyer 	struct proc *p;
    125  1.2.2.2  bouyer {
    126  1.2.2.2  bouyer 	fifoq_state_t *q;
    127  1.2.2.2  bouyer 	struct fifoq_interface *ifacep;
    128  1.2.2.2  bouyer 	struct ifnet *ifp;
    129  1.2.2.2  bouyer 	int	error = 0;
    130  1.2.2.2  bouyer 
    131  1.2.2.2  bouyer 	/* check super-user privilege */
    132  1.2.2.2  bouyer 	switch (cmd) {
    133  1.2.2.2  bouyer 	case FIFOQ_GETSTATS:
    134  1.2.2.2  bouyer 		break;
    135  1.2.2.2  bouyer 	default:
    136  1.2.2.2  bouyer #if (__FreeBSD_version > 400000)
    137  1.2.2.2  bouyer 		if ((error = suser(p)) != 0)
    138  1.2.2.2  bouyer 			return (error);
    139  1.2.2.2  bouyer #else
    140  1.2.2.2  bouyer 		if ((error = suser(p->p_ucred, &p->p_acflag)) != 0)
    141  1.2.2.2  bouyer 			return (error);
    142  1.2.2.2  bouyer #endif
    143  1.2.2.2  bouyer 		break;
    144  1.2.2.2  bouyer 	}
    145  1.2.2.2  bouyer 
    146  1.2.2.2  bouyer 	switch (cmd) {
    147  1.2.2.2  bouyer 	case FIFOQ_ENABLE:
    148  1.2.2.2  bouyer 		ifacep = (struct fifoq_interface *)addr;
    149  1.2.2.2  bouyer 		if ((q = altq_lookup(ifacep->fifoq_ifname, ALTQT_FIFOQ))
    150  1.2.2.2  bouyer 		    == NULL) {
    151  1.2.2.2  bouyer 			error = EBADF;
    152  1.2.2.2  bouyer 			break;
    153  1.2.2.2  bouyer 		}
    154  1.2.2.2  bouyer 		error = altq_enable(q->q_ifq);
    155  1.2.2.2  bouyer 		break;
    156  1.2.2.2  bouyer 
    157  1.2.2.2  bouyer 	case FIFOQ_DISABLE:
    158  1.2.2.2  bouyer 		ifacep = (struct fifoq_interface *)addr;
    159  1.2.2.2  bouyer 		if ((q = altq_lookup(ifacep->fifoq_ifname, ALTQT_FIFOQ))
    160  1.2.2.2  bouyer 		    == NULL) {
    161  1.2.2.2  bouyer 			error = EBADF;
    162  1.2.2.2  bouyer 			break;
    163  1.2.2.2  bouyer 		}
    164  1.2.2.2  bouyer 		error = altq_disable(q->q_ifq);
    165  1.2.2.2  bouyer 		break;
    166  1.2.2.2  bouyer 
    167  1.2.2.2  bouyer 	case FIFOQ_IF_ATTACH:
    168  1.2.2.2  bouyer 		ifp = ifunit(((struct fifoq_interface *)addr)->fifoq_ifname);
    169  1.2.2.2  bouyer 		if (ifp == NULL) {
    170  1.2.2.2  bouyer 			error = ENXIO;
    171  1.2.2.2  bouyer 			break;
    172  1.2.2.2  bouyer 		}
    173  1.2.2.2  bouyer 
    174  1.2.2.2  bouyer 		/* allocate and initialize fifoq_state_t */
    175  1.2.2.2  bouyer 		MALLOC(q, fifoq_state_t *, sizeof(fifoq_state_t),
    176  1.2.2.2  bouyer 		       M_DEVBUF, M_WAITOK);
    177  1.2.2.2  bouyer 		if (q == NULL) {
    178  1.2.2.2  bouyer 			error = ENOMEM;
    179  1.2.2.2  bouyer 			break;
    180  1.2.2.2  bouyer 		}
    181  1.2.2.2  bouyer 		bzero(q, sizeof(fifoq_state_t));
    182  1.2.2.2  bouyer 
    183  1.2.2.2  bouyer 		q->q_ifq = &ifp->if_snd;
    184  1.2.2.2  bouyer 		q->q_head = q->q_tail = NULL;
    185  1.2.2.2  bouyer 		q->q_len = 0;
    186  1.2.2.2  bouyer 		q->q_limit = FIFOQ_LIMIT;
    187  1.2.2.2  bouyer 
    188  1.2.2.2  bouyer 		/*
    189  1.2.2.2  bouyer 		 * set FIFOQ to this ifnet structure.
    190  1.2.2.2  bouyer 		 */
    191  1.2.2.2  bouyer 		error = altq_attach(q->q_ifq, ALTQT_FIFOQ, q,
    192  1.2.2.2  bouyer 				    fifoq_enqueue, fifoq_dequeue, fifoq_request,
    193  1.2.2.2  bouyer 				    NULL, NULL);
    194  1.2.2.2  bouyer 		if (error) {
    195  1.2.2.2  bouyer 			FREE(q, M_DEVBUF);
    196  1.2.2.2  bouyer 			break;
    197  1.2.2.2  bouyer 		}
    198  1.2.2.2  bouyer 
    199  1.2.2.2  bouyer 		/* add this state to the fifoq list */
    200  1.2.2.2  bouyer 		q->q_next = fifoq_list;
    201  1.2.2.2  bouyer 		fifoq_list = q;
    202  1.2.2.2  bouyer 		break;
    203  1.2.2.2  bouyer 
    204  1.2.2.2  bouyer 	case FIFOQ_IF_DETACH:
    205  1.2.2.2  bouyer 		ifacep = (struct fifoq_interface *)addr;
    206  1.2.2.2  bouyer 		if ((q = altq_lookup(ifacep->fifoq_ifname, ALTQT_FIFOQ))
    207  1.2.2.2  bouyer 		    == NULL) {
    208  1.2.2.2  bouyer 			error = EBADF;
    209  1.2.2.2  bouyer 			break;
    210  1.2.2.2  bouyer 		}
    211  1.2.2.2  bouyer 		error = fifoq_detach(q);
    212  1.2.2.2  bouyer 		break;
    213  1.2.2.2  bouyer 
    214  1.2.2.2  bouyer 	case FIFOQ_GETSTATS:
    215  1.2.2.2  bouyer 		do {
    216  1.2.2.2  bouyer 			struct fifoq_getstats *q_stats;
    217  1.2.2.2  bouyer 
    218  1.2.2.2  bouyer 			q_stats = (struct fifoq_getstats *)addr;
    219  1.2.2.2  bouyer 			if ((q = altq_lookup(q_stats->iface.fifoq_ifname,
    220  1.2.2.2  bouyer 					     ALTQT_FIFOQ)) == NULL) {
    221  1.2.2.2  bouyer 				error = EBADF;
    222  1.2.2.2  bouyer 				break;
    223  1.2.2.2  bouyer 			}
    224  1.2.2.2  bouyer 
    225  1.2.2.2  bouyer 			q_stats->q_len		= q->q_len;
    226  1.2.2.2  bouyer 			q_stats->q_limit 	= q->q_limit;
    227  1.2.2.2  bouyer 			q_stats->xmit_cnt	= q->q_stats.xmit_cnt;
    228  1.2.2.2  bouyer 			q_stats->drop_cnt 	= q->q_stats.drop_cnt;
    229  1.2.2.2  bouyer 			q_stats->period   	= q->q_stats.period;
    230  1.2.2.2  bouyer 		} while (0);
    231  1.2.2.2  bouyer 		break;
    232  1.2.2.2  bouyer 
    233  1.2.2.2  bouyer 	case FIFOQ_CONFIG:
    234  1.2.2.2  bouyer 		do {
    235  1.2.2.2  bouyer 			struct fifoq_conf *fc;
    236  1.2.2.2  bouyer 			int limit;
    237  1.2.2.2  bouyer 
    238  1.2.2.2  bouyer 			fc = (struct fifoq_conf *)addr;
    239  1.2.2.2  bouyer 			if ((q = altq_lookup(fc->iface.fifoq_ifname,
    240  1.2.2.2  bouyer 					     ALTQT_FIFOQ)) == NULL) {
    241  1.2.2.2  bouyer 				error = EBADF;
    242  1.2.2.2  bouyer 				break;
    243  1.2.2.2  bouyer 			}
    244  1.2.2.2  bouyer 			limit = fc->fifoq_limit;
    245  1.2.2.2  bouyer 			if (limit < 0)
    246  1.2.2.2  bouyer 				limit = 0;
    247  1.2.2.2  bouyer 			q->q_limit = limit;
    248  1.2.2.2  bouyer 			fc->fifoq_limit = limit;
    249  1.2.2.2  bouyer 		} while (0);
    250  1.2.2.2  bouyer 		break;
    251  1.2.2.2  bouyer 
    252  1.2.2.2  bouyer 	default:
    253  1.2.2.2  bouyer 		error = EINVAL;
    254  1.2.2.2  bouyer 		break;
    255  1.2.2.2  bouyer 	}
    256  1.2.2.2  bouyer 	return error;
    257  1.2.2.2  bouyer }
    258  1.2.2.2  bouyer 
    259  1.2.2.2  bouyer /*
    260  1.2.2.2  bouyer  * fifoq support routines
    261  1.2.2.2  bouyer  */
    262  1.2.2.2  bouyer 
    263  1.2.2.2  bouyer /*
    264  1.2.2.2  bouyer  * enqueue routine:
    265  1.2.2.2  bouyer  *
    266  1.2.2.2  bouyer  *	returns: 0 when successfully queued.
    267  1.2.2.2  bouyer  *		 ENOBUFS when drop occurs.
    268  1.2.2.2  bouyer  */
    269  1.2.2.2  bouyer static int
    270  1.2.2.2  bouyer fifoq_enqueue(ifq, m, pktattr)
    271  1.2.2.2  bouyer 	struct ifaltq *ifq;
    272  1.2.2.2  bouyer 	struct mbuf *m;
    273  1.2.2.2  bouyer 	struct altq_pktattr *pktattr;
    274  1.2.2.2  bouyer {
    275  1.2.2.2  bouyer 	fifoq_state_t *q = (fifoq_state_t *)ifq->altq_disc;
    276  1.2.2.2  bouyer 
    277  1.2.2.2  bouyer 	/* if the queue is full, drop the incoming packet(drop-tail) */
    278  1.2.2.2  bouyer 	if (q->q_len >= q->q_limit) {
    279  1.2.2.2  bouyer #ifdef FIFOQ_STATS
    280  1.2.2.2  bouyer 		PKTCNTR_ADD(&q->q_stats.drop_cnt, m_pktlen(m));
    281  1.2.2.2  bouyer #endif
    282  1.2.2.2  bouyer 		m_freem(m);
    283  1.2.2.2  bouyer 		return (ENOBUFS);
    284  1.2.2.2  bouyer 	}
    285  1.2.2.2  bouyer 
    286  1.2.2.2  bouyer 	/* enqueue the packet at the taile of the queue */
    287  1.2.2.2  bouyer 	m->m_nextpkt = NULL;
    288  1.2.2.2  bouyer 	if (q->q_tail == NULL)
    289  1.2.2.2  bouyer 		q->q_head = m;
    290  1.2.2.2  bouyer 	else
    291  1.2.2.2  bouyer 		q->q_tail->m_nextpkt = m;
    292  1.2.2.2  bouyer 	q->q_tail = m;
    293  1.2.2.2  bouyer 	q->q_len++;
    294  1.2.2.2  bouyer 	ifq->ifq_len++;
    295  1.2.2.2  bouyer 	return 0;
    296  1.2.2.2  bouyer }
    297  1.2.2.2  bouyer 
    298  1.2.2.2  bouyer /*
    299  1.2.2.2  bouyer  * dequeue routine:
    300  1.2.2.2  bouyer  *	must be called in splimp.
    301  1.2.2.2  bouyer  *
    302  1.2.2.2  bouyer  *	returns: mbuf dequeued.
    303  1.2.2.2  bouyer  *		 NULL when no packet is available in the queue.
    304  1.2.2.2  bouyer  */
    305  1.2.2.2  bouyer /*
    306  1.2.2.2  bouyer  * ALTDQ_PEEK is provided for drivers which need to know the next packet
    307  1.2.2.2  bouyer  * to send in advance.
    308  1.2.2.2  bouyer  * when ALTDQ_PEEK is specified, the next packet to be dequeued is
    309  1.2.2.2  bouyer  * returned without dequeueing the packet.
    310  1.2.2.2  bouyer  * when ALTDQ_DEQUEUE is called *immediately after* an ALTDQ_PEEK
    311  1.2.2.2  bouyer  * operation, the same packet should be returned.
    312  1.2.2.2  bouyer  */
    313  1.2.2.2  bouyer static struct mbuf *
    314  1.2.2.2  bouyer fifoq_dequeue(ifq, op)
    315  1.2.2.2  bouyer 	struct ifaltq *ifq;
    316  1.2.2.2  bouyer 	int op;
    317  1.2.2.2  bouyer {
    318  1.2.2.2  bouyer 	fifoq_state_t *q = (fifoq_state_t *)ifq->altq_disc;
    319  1.2.2.2  bouyer 	struct mbuf *m = NULL;
    320  1.2.2.2  bouyer 
    321  1.2.2.2  bouyer 	if (op == ALTDQ_POLL)
    322  1.2.2.2  bouyer 		return (q->q_head);
    323  1.2.2.2  bouyer 
    324  1.2.2.2  bouyer 	if ((m = q->q_head) == NULL)
    325  1.2.2.2  bouyer 		return (NULL);
    326  1.2.2.2  bouyer 
    327  1.2.2.2  bouyer 	if ((q->q_head = m->m_nextpkt) == NULL)
    328  1.2.2.2  bouyer 		q->q_tail = NULL;
    329  1.2.2.2  bouyer 	m->m_nextpkt = NULL;
    330  1.2.2.2  bouyer 	q->q_len--;
    331  1.2.2.2  bouyer 	ifq->ifq_len--;
    332  1.2.2.2  bouyer #ifdef FIFOQ_STATS
    333  1.2.2.2  bouyer 	PKTCNTR_ADD(&q->q_stats.xmit_cnt, m_pktlen(m));
    334  1.2.2.2  bouyer 	if (q->q_len == 0)
    335  1.2.2.2  bouyer 		q->q_stats.period++;
    336  1.2.2.2  bouyer #endif
    337  1.2.2.2  bouyer 	return (m);
    338  1.2.2.2  bouyer }
    339  1.2.2.2  bouyer 
    340  1.2.2.2  bouyer static int
    341  1.2.2.2  bouyer fifoq_request(ifq, req, arg)
    342  1.2.2.2  bouyer 	struct ifaltq *ifq;
    343  1.2.2.2  bouyer 	int req;
    344  1.2.2.2  bouyer 	void *arg;
    345  1.2.2.2  bouyer {
    346  1.2.2.2  bouyer 	fifoq_state_t *q = (fifoq_state_t *)ifq->altq_disc;
    347  1.2.2.2  bouyer 
    348  1.2.2.2  bouyer 	switch (req) {
    349  1.2.2.2  bouyer 	case ALTRQ_PURGE:
    350  1.2.2.2  bouyer 		fifoq_purge(q);
    351  1.2.2.2  bouyer 		break;
    352  1.2.2.2  bouyer 	}
    353  1.2.2.2  bouyer 	return (0);
    354  1.2.2.2  bouyer }
    355  1.2.2.2  bouyer 
    356  1.2.2.2  bouyer 
    357  1.2.2.2  bouyer static int fifoq_detach(q)
    358  1.2.2.2  bouyer 	fifoq_state_t *q;
    359  1.2.2.2  bouyer {
    360  1.2.2.2  bouyer 	fifoq_state_t *tmp;
    361  1.2.2.2  bouyer 	int error = 0;
    362  1.2.2.2  bouyer 
    363  1.2.2.2  bouyer 	if (ALTQ_IS_ENABLED(q->q_ifq))
    364  1.2.2.2  bouyer 		altq_disable(q->q_ifq);
    365  1.2.2.2  bouyer 
    366  1.2.2.2  bouyer 	fifoq_purge(q);
    367  1.2.2.2  bouyer 
    368  1.2.2.2  bouyer 	if ((error = altq_detach(q->q_ifq)))
    369  1.2.2.2  bouyer 		return (error);
    370  1.2.2.2  bouyer 
    371  1.2.2.2  bouyer 	if (fifoq_list == q)
    372  1.2.2.2  bouyer 		fifoq_list = q->q_next;
    373  1.2.2.2  bouyer 	else {
    374  1.2.2.2  bouyer 		for (tmp = fifoq_list; tmp != NULL; tmp = tmp->q_next)
    375  1.2.2.2  bouyer 			if (tmp->q_next == q) {
    376  1.2.2.2  bouyer 				tmp->q_next = q->q_next;
    377  1.2.2.2  bouyer 				break;
    378  1.2.2.2  bouyer 			}
    379  1.2.2.2  bouyer 		if (tmp == NULL)
    380  1.2.2.2  bouyer 			printf("fifoq_detach: no state in fifoq_list!\n");
    381  1.2.2.2  bouyer 	}
    382  1.2.2.2  bouyer 
    383  1.2.2.2  bouyer 	FREE(q, M_DEVBUF);
    384  1.2.2.2  bouyer 	return (error);
    385  1.2.2.2  bouyer }
    386  1.2.2.2  bouyer 
    387  1.2.2.2  bouyer /*
    388  1.2.2.2  bouyer  * fifoq_purge
    389  1.2.2.2  bouyer  * should be called in splimp or after disabling the fifoq.
    390  1.2.2.2  bouyer  */
    391  1.2.2.2  bouyer static void fifoq_purge(q)
    392  1.2.2.2  bouyer 	fifoq_state_t *q;
    393  1.2.2.2  bouyer {
    394  1.2.2.2  bouyer 	struct mbuf *m;
    395  1.2.2.2  bouyer 
    396  1.2.2.2  bouyer 	while ((m = q->q_head) != NULL) {
    397  1.2.2.2  bouyer 		q->q_head = m->m_nextpkt;
    398  1.2.2.2  bouyer 		m_freem(m);
    399  1.2.2.2  bouyer 	}
    400  1.2.2.2  bouyer 	q->q_tail = NULL;
    401  1.2.2.2  bouyer 	q->q_len = 0;
    402  1.2.2.2  bouyer 	if (ALTQ_IS_ENABLED(q->q_ifq))
    403  1.2.2.2  bouyer 		q->q_ifq->ifq_len = 0;
    404  1.2.2.2  bouyer }
    405  1.2.2.2  bouyer 
    406  1.2.2.2  bouyer #ifdef KLD_MODULE
    407  1.2.2.2  bouyer 
    408  1.2.2.2  bouyer static struct altqsw fifoq_sw =
    409  1.2.2.2  bouyer 	{"fifoq", fifoqopen, fifoqclose, fifoqioctl};
    410  1.2.2.2  bouyer 
    411  1.2.2.2  bouyer ALTQ_MODULE(altq_fifoq, ALTQT_FIFOQ, &fifoq_sw);
    412  1.2.2.2  bouyer 
    413  1.2.2.2  bouyer #endif /* KLD_MODULE */
    414  1.2.2.2  bouyer 
    415  1.2.2.2  bouyer #endif /* ALTQ_FIFOQ */
    416