Subversion Repositories shark

/* Emulates Linux sk buffers using hartik net buffers... */

#include <kernel/kern.h>
#include <semaphore.h>

#include "../net/netbuff.h"
#include "../net/eth_priv.h"

#include"linux/skbuff.h"

#define LOWLEV_TX_BUFFERS 50
#define LOWLEV_RX_BUFFERS 50
struct netbuff rxbuff;
struct netbuff lowlevel_txbuff;

void skb_init(void)
{
        netbuff_init(&lowlevel_txbuff, LOWLEV_TX_BUFFERS, ETH_MAX_LEN);
        netbuff_init(&rxbuff, LOWLEV_RX_BUFFERS, ETH_MAX_LEN);
}

struct sk_buff *dev_alloc_skb(unsigned int len)
{
        struct sk_buff *skb;

        kern_cli();
        skb = kern_alloc(sizeof(struct sk_buff));
        kern_sti();
       
        skb->data = netbuff_get(&rxbuff, NON_BLOCK);
        if (skb->data == NULL) {
                        return NULL;
        }
        skb->head = skb->data;
        skb->tail = skb->data;
        skb->len = 0;
        skb->truesize = len;

        return skb;
}

void skb_reserve(struct sk_buff *skb, int len)
{
        /* changed by PJ ... before it did nothing... */
        skb->data+=len;
        skb->tail+=len;
}

unsigned char *skb_put(struct sk_buff *skb, int len)
{
        unsigned char *tmp=skb->tail;
       
        skb->tail+=len;
        skb->len+=len;
       
        return tmp;
}

void skb_queue_head_init(struct sk_buff_head *list)
{    
        list->prev = (struct sk_buff *)list;
        list->next = (struct sk_buff *)list;
        list->qlen = 0;
}

struct sk_buff *skb_realloc_headroom(struct sk_buff *skb, int newheadroom)
{
        struct sk_buff *n;
        unsigned long offset;
        int headroom = skb_headroom(skb);

        /* Allocate the copy buffer */

        n = alloc_skb(skb->truesize + newheadroom-headroom, GFP_ATOMIC);
        if (n == NULL)
                return NULL;

        skb_reserve(n, newheadroom);

        /*
        *      Shift between the two data areas in bytes
        */

        offset = n->data - skb->data;

        /* Set the tail pointer and length */
        skb_put(n, skb->len);

        /* Copy the bytes */
        memcpy(n->data, skb->data, skb->len);
        n->list = NULL;
        // n->sk = NULL;
        // n->priority = skb->priority;
        n->protocol = skb->protocol;
        n->dev = skb->dev;
        // n->dst = dst_clone(skb->dst);
        // n->h.raw = skb->h.raw+offset;
        // n->nh.raw = skb->nh.raw+offset;
        // n->mac.raw = skb->mac.raw+offset;
        memcpy(n->cb, skb->cb, sizeof(skb->cb));
        n->used = skb->used;
        // n->is_clone = 0;
        // atomic_set(&n->users, 1);
        // n->pkt_type = skb->pkt_type;
        // n->stamp = skb->stamp;
        // n->destructor = NULL;
        // n->security = skb->security;
#ifdef CONFIG_IP_FIREWALL
        n->fwmark = skb->fwmark;
#endif

        return n;
}