Home | History | Annotate | Line # | Download | only in btpand 
      1 /*	$NetBSD: packet.c,v 1.2 2009/05/02 20:07:51 plunky Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 2008 Iain Hibbert
      5  * All rights reserved.
      6  *
      7  * Redistribution and use in source and binary forms, with or without
      8  * modification, are permitted provided that the following conditions
      9  * are met:
     10  * 1. Redistributions of source code must retain the above copyright
     11  *    notice, this list of conditions and the following disclaimer.
     12  * 2. Redistributions in binary form must reproduce the above copyright
     13  *    notice, this list of conditions and the following disclaimer in the
     14  *    documentation and/or other materials provided with the distribution.
     15  *
     16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     17  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     18  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     19  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     20  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     21  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     22  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     23  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     24  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     25  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     26  */
     27 
     28 #include <sys/cdefs.h>
     29 __RCSID("$NetBSD: packet.c,v 1.2 2009/05/02 20:07:51 plunky Exp $");
     30 
     31 #include "btpand.h"
     32 
     33 packet_t *
     34 packet_alloc(channel_t *chan)
     35 {
     36 	packet_t *pkt;
     37 
     38 	pkt = malloc(sizeof(packet_t) + chan->mru);
     39 	if (pkt == NULL) {
     40 		log_err("%s() failed: %m", __func__);
     41 		return NULL;
     42 	}
     43 
     44 	memset(pkt, 0, sizeof(packet_t));
     45 	STAILQ_INIT(&pkt->extlist);
     46 	pkt->ptr = pkt->buf;
     47 
     48 	pkt->chan = chan;
     49 	chan->refcnt++;
     50 
     51 	return pkt;
     52 }
     53 
     54 void
     55 packet_free(packet_t *pkt)
     56 {
     57 	exthdr_t *eh;
     58 
     59 	if (pkt->refcnt-- > 0)
     60 		return;
     61 
     62 	while ((eh = STAILQ_FIRST(&pkt->extlist)) != NULL) {
     63 		STAILQ_REMOVE_HEAD(&pkt->extlist, next);
     64 		free(eh);
     65 	}
     66 
     67 	pkt->chan->refcnt--;
     68 	if (pkt->chan->refcnt == 0)
     69 		channel_free(pkt->chan);
     70 
     71 	free(pkt);
     72 }
     73 
     74 void
     75 packet_adj(packet_t *pkt, size_t size)
     76 {
     77 
     78 	assert(pkt->refcnt == 0);
     79 	assert(pkt->len >= size);
     80 
     81 	pkt->ptr += size;
     82 	pkt->len -= size;
     83 }
     84 
     85 pkthdr_t *
     86 pkthdr_alloc(packet_t *pkt)
     87 {
     88 	pkthdr_t *ph;
     89 
     90 	ph = malloc(sizeof(pkthdr_t));
     91 	if (ph == NULL) {
     92 		log_err("%s() failed: %m", __func__);
     93 		return NULL;
     94 	}
     95 
     96 	ph->data = pkt;
     97 	pkt->refcnt++;
     98 
     99 	return ph;
    100 }
    101 
    102 void
    103 pkthdr_free(pkthdr_t *ph)
    104 {
    105 
    106 	packet_free(ph->data);
    107 	free(ph);
    108 }
    109