src/rohc/c_udp_lite.c

/*
    ROHC Project 2003 at Lulea University of Technology, Sweden.
    Authors: Andreas Vernersson <andver-8@student.luth.se>
             Daniel Pettersson <danpet-7@student.luth.se>
             Erik Soderstrom <soderstrom@yahoo.com>
             Fredrik Lindstrom <frelin-9@student.luth.se>
             Johan Stenmark <johste-8@student.luth.se>
             Martin Juhlin <juhlin@users.sourceforge.net>
             Mikael Larsson <larmik-9@student.luth.se>
             Robert Maxe <robmax-1@student.luth.se>
             
    Copyright (C) 2003 Andreas Vernersson, Daniel Pettersson, 
    Erik Soderström, Fredrik Lindström, Johan Stenmark, 
    Martin Juhlin, Mikael Larsson, Robert Maxe.  

    This program is free software; you can redistribute it and/or modify
    it under the terms of the GNU General Public License as published by
    the Free Software Foundation; either version 2 of the License, or
    (at your option) any later version.

    This program is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    GNU General Public License for more details.

    You should have received a copy of the GNU General Public License
    along with this program; if not, write to the Free Software
    Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
*/    
/*
Implementation of the udp-lite profile (compressor)
*/

#include <linux/ip.h>

#include "rohc.h"
#include "comp.h"
#include "c_util.h"


static const char *udp_lite_packet_types[] = {
        "IR", "IRDYN", "OU-0", "OU-1", "OU-2"
};


static const char *udp_lite_extension_types[] = {
        "NOEXT", "EXT0", "EXT1", "EXT2", "EXT3"
};

#define UDP_LITE_PRNR 254

#define MAX_LITE_COUNT 2

/*
Structure that contain counters, flags and structures that need to saved between different
packages. A context have a structure like this for the two first ip-headers.
*/
struct sc_udp_lite_header
{
        struct sc_wlsb *ip_id_window;
        struct iphdr old_ip;

        int tos_count, ttl_count, df_count, protocol_count;
        int rnd_count, nbo_count;
        int old_rnd,old_nbo;
        int id_delta;

};
/*
Structure that contain variables that are temporar, i.e. they will only be jused in this
packet, they have to be reinitilized every time a new packet arrive.
*/
struct udp_lite_tmp_variables{
        // The following variables are set in encode
        int nr_of_ip_hdr;
        unsigned short changed_fields;
        unsigned short changed_fields2;
        int send_static;
        int send_dynamic;
        int nr_ip_id_bits;
        int nr_sn_bits;
        int nr_ip_id_bits2;
        int packet_type;
        int max_size;

        int udp_size;
};

/*
Structure that contain counters, flags and structures that need to saved between different
packages. Every context have one of these
*/
struct sc_udp_lite_context {
        unsigned int sn;
        struct sc_wlsb *sn_window;

        int ir_count, fo_count, so_count;
        int go_back_fo_count, go_back_ir_count, ir_dyn_count;
        //int udp_checksum_change_count;
        int cfp,cfi;
        unsigned char FK;
        int coverage_equal_count, coverage_inferred_count;
        int tmp_coverage;
        int sent_ce_on_count, sent_ce_off_count, sent_ce_only_count;

        struct sc_udp_lite_header ip_flags, ip2_flags;
        struct udphdr old_udp_lite;

        struct udp_lite_tmp_variables tmp_variables;
        int is_initialized; // if ip2 is initialized

};


static void udp_lite_decide_state(int send_udp_dynamic, struct sc_context *context);

static void c_udp_lite_update_variables(struct sc_context *context,const struct iphdr *ip,
        const struct iphdr *ip2);

static int udp_lite_decide_packet(struct sc_context *context);

static int udp_lite_decide_FO_packet(struct sc_context *context);

static int udp_lite_decide_SO_packet(const struct sc_context *context);

static void udp_lite_periodic_down_transition(struct sc_context *context);

static int udp_lite_code_packet(struct sc_udp_lite_context *udp_lite_profile,const struct iphdr *ip,
                const struct iphdr *ip2,const struct udphdr *udp_lite,unsigned char *dest, struct sc_context *context);


int udp_lite_code_IR_packet(struct sc_udp_lite_context *udp_lite_profile,const struct iphdr *ip,
        const struct iphdr *ip2,const struct udphdr *udp_lite,unsigned char *dest,
        struct sc_context *context,int counter,int first_position);
static int udp_lite_code_IR_DYN_packet(struct sc_udp_lite_context *udp_lite_profile,const struct iphdr *ip,
                const struct iphdr *ip2,const struct udphdr *udp_lite,unsigned char *dest,
                 struct sc_context *context,int counter,int first_position);


static int udp_lite_code_static_part(struct sc_context *context,struct sc_udp_lite_header *ip_hdr_profile,const struct iphdr *ip,
                        unsigned char *dest, int counter);

static int udp_lite_code_static_udp_part(struct sc_context *context,
        const struct udphdr *udp_lite,
        unsigned char *dest,
        int counter);

static int udp_lite_code_dynamic_part(struct sc_context *context,struct sc_udp_lite_header *ip_hdr_profile,const struct iphdr *ip,
                        unsigned char *dest, int counter,int *rnd, int *nbo);

static int udp_lite_code_dynamic_udp_part(struct sc_context *context,
        const struct udphdr *udp_lite,
        unsigned char *dest,
        int counter);

static int udp_lite_code_UO0_packet(struct sc_context *context,const struct iphdr *ip,
                                unsigned char *dest, int counter,int first_position);

static int udp_lite_code_UO1_packet(struct sc_context *context,const struct iphdr *ip,
                                unsigned char *dest, int counter,int first_position );

static int udp_lite_code_UO2_packet(struct sc_context *context,struct sc_udp_lite_context *udp_lite_profile,
                        const struct iphdr *ip,const struct iphdr *ip2,unsigned char *dest, int counter,int first_position);

static int udp_lite_code_EXT0_packet(struct sc_context *context,const struct iphdr *ip,
                                unsigned char *dest, int counter);

static int udp_lite_code_EXT1_packet(struct sc_context *context,const struct iphdr *ip,
                                unsigned char *dest, int counter);

static int udp_lite_code_EXT2_packet(struct sc_context *context,struct sc_udp_lite_context *udp_lite_profile,
                                const struct iphdr *ip,
                                unsigned char *dest, int counter);

static int udp_lite_code_EXT3_packet(struct sc_context *context,struct sc_udp_lite_context *udp_lite_profile,
                        const struct iphdr *ip,const struct iphdr *ip2,
                        unsigned char *dest, int counter);

static int udp_lite_header_flags(struct sc_context *context,unsigned short changed_fields,struct sc_udp_lite_header *ip_hdr_profile,int counter,
                boolean is_outer,int nr_ip_id_bits,const struct iphdr *ip,unsigned char *dest,int context_rnd,int context_nbo);

static int udp_lite_header_fields(struct sc_context *context,unsigned short changed_fields,struct sc_udp_lite_header *ip_hdr_profile,int counter,
                boolean is_outer,int nr_ip_id_bits,const struct iphdr *ip,unsigned char *dest,int context_rnd);

static int udp_lite_decide_extension(struct sc_context *context);


static int udp_lite_changed_static_both_hdr(struct sc_context *context,
        const struct iphdr *ip, const struct iphdr *ip2);

static int udp_lite_changed_static_one_hdr(unsigned short udp_lite_changed_fields,struct sc_udp_lite_header *ip_header, const struct iphdr *ip,
        struct sc_context *context);


static int udp_lite_changed_dynamic_both_hdr(struct sc_context *context,
        const struct iphdr *ip, const struct iphdr *ip2);

static int udp_lite_changed_dynamic_one_hdr(unsigned short udp_lite_changed_fields,struct sc_udp_lite_header *ip_hdr_profile, const struct iphdr *ip,
                        int context_rnd,int context_nbo,struct sc_context *context);

static int udp_lite_changed_udp_dynamic(struct sc_context *context,const struct udphdr *udp_lite);

static boolean udp_lite_is_changed(unsigned short udp_lite_changed_fields,unsigned short check_field);

static unsigned short udp_lite_changed_fields(struct sc_udp_lite_header *ip_hdr_profile,const struct iphdr *ip);

static void udp_lite_change_state(struct sc_context *, C_STATE);
static void udp_lite_change_mode(struct sc_context *, C_MODE);

static void udp_lite_check_ip_identification(struct sc_udp_lite_header *ip_hdr_profile, const struct iphdr *ip,int *context_rnd, int *context_nbo);

static void udp_lite_initiate_coverage_context(struct sc_udp_lite_context *udp_lite_profile,
        const struct udphdr *udp_lite,  unsigned char *dest, struct sc_context *context);

static boolean udp_lite_send_ce_packet(struct sc_udp_lite_context *udp_lite_profile,
        const struct udphdr *udp_lite, unsigned char *dest,
        struct sc_context *context);

/*
Initilize one ip-header context
*/
void c_udp_lite_init_context(struct sc_udp_lite_header *ip_header,const struct iphdr *ip,int context_rnd,int context_nbo)
{
        ip_header -> ip_id_window = c_create_wlsb(16,C_WINDOW_WIDTH,0);
        ip_header->old_ip = *ip;
        ip_header->old_rnd = context_rnd;
        ip_header->old_nbo = context_nbo;
        ip_header->tos_count = MAX_FO_COUNT;
        ip_header->ttl_count = MAX_FO_COUNT;
        ip_header->df_count = MAX_FO_COUNT;
        ip_header->protocol_count = MAX_FO_COUNT;
        ip_header->rnd_count = MAX_FO_COUNT;
        ip_header->nbo_count = MAX_FO_COUNT;
}

/*
Initilize all temp variables
*/
void c_udp_lite_init_tmp_variables(struct udp_lite_tmp_variables *udp_lite_tmp_variables){
        udp_lite_tmp_variables->nr_of_ip_hdr = -1;
        udp_lite_tmp_variables->changed_fields = -1;
        udp_lite_tmp_variables->changed_fields2 = -1;
        udp_lite_tmp_variables->send_static = -1;
        udp_lite_tmp_variables->send_dynamic = -1;
        udp_lite_tmp_variables->nr_ip_id_bits = -1;
        udp_lite_tmp_variables->nr_sn_bits = -1;
        udp_lite_tmp_variables->nr_ip_id_bits2 = -1;
        udp_lite_tmp_variables->packet_type = -1;
        udp_lite_tmp_variables->max_size = -1;
        udp_lite_tmp_variables->udp_size = -1;

}

/*
Function to allocate for a new context, it aslo initilize alot of variables.
This function is one of the functions that must exist for the framework to
work. Please notice that a pointer to this function has to exist in the
sc_profile struct thatwe have in the bottom of this file.
*/
int c_udp_lite_create(struct sc_context *context, const struct iphdr *ip)
{
        struct sc_udp_lite_context *udp_lite_profile;
        struct udphdr *udp_lite;
        struct iphdr *ip2;
        context->profile_context = kmalloc(sizeof(struct sc_udp_lite_context),GFP_ATOMIC);
        if (context->profile_context == 0) {
          rohc_debugf(0,"c_udp_lite_create(): no mem for profile context\n");
          return 0;
        }
        udp_lite_profile = (struct sc_udp_lite_context *)context->profile_context;
        udp_lite_profile->sn = 0;

        udp_lite_profile -> sn_window = c_create_wlsb(16,C_WINDOW_WIDTH,-1);

        udp_lite_profile->cfp = 0;
        udp_lite_profile->cfi = 0;
        udp_lite_profile->FK = 0;
        udp_lite_profile->coverage_equal_count = 0;
        udp_lite_profile->coverage_inferred_count = 0;
        udp_lite_profile->sent_ce_only_count = 0;
        udp_lite_profile->sent_ce_on_count = MAX_IR_COUNT;
        udp_lite_profile->sent_ce_off_count = MAX_IR_COUNT;


        udp_lite_profile->ir_count = 0;
        udp_lite_profile->fo_count = 0;
        udp_lite_profile->so_count = 0;


        if (ip->protocol == UDP_LITE_PRNR){
                udp_lite = (struct udphdr *)(ip+1);
        }else if(ip->protocol == 4){
                ip2=(struct iphdr *)ip+1;
                if(ip2->protocol == UDP_LITE_PRNR){
                        udp_lite = (struct udphdr *)(ip+2);
                }
        }
        //udp_lite_profile->old_udp_lite = *udp_lite;

        udp_lite_profile->go_back_fo_count = 0;
        udp_lite_profile->go_back_ir_count = 0;
        udp_lite_profile->ir_dyn_count = 0;
        c_udp_lite_init_context(&udp_lite_profile->ip_flags,ip,context->rnd,context->nbo);
        c_udp_lite_init_tmp_variables(&udp_lite_profile->tmp_variables);
        udp_lite_profile->is_initialized = 0;
        return 1;
}

/*
Function to deallocate a context.

This function is one of the functions that must exist for the framework to
work. Please notice that a pointer to this function has to exist in the
sc_profile struct thatwe have in the bottom of this file.
*/
void c_udp_lite_destroy(struct sc_context *context){
        struct sc_udp_lite_context *udp_lite_profile = (struct sc_udp_lite_context *)context->profile_context;
        c_destroy_wlsb(udp_lite_profile->ip_flags.ip_id_window);
        c_destroy_wlsb(udp_lite_profile->sn_window);

        if (context->profile_context != 0)
          kfree(context->profile_context);

}

/*
The function are jused by the framework to check if a package belongs to this context
We check that its not framgmented. It is the source and destination addresses in the
ip-headers that decides if the package belong to this context, for udp the source and
destination ports also have to be the same for the package to be in the same context
as a cid.

This function is one of the functions that must exist for the framework to
work. Please notice that a pointer to this function has to exist in the
sc_profile struct that we have in the bottom of this file.
*/
int c_udp_lite_check_context(struct sc_context *context, const struct iphdr *ip)
{
        boolean is_ip_same;
        boolean is_ip2_same;
        boolean is_udp_same;
        struct sc_udp_lite_context *udp_lite_profile = (struct sc_udp_lite_context *)context->profile_context;
        struct udphdr *udp_lite;
        struct iphdr *ip2;
        int reserved, dont_fragment, more_fragments, fragment_offset;
        unsigned short fragment;

        fragment = ntohs(ip->frag_off);

        reserved = (fragment >> 15);
        dont_fragment = (fragment >> 14) & 1;
        more_fragments = (fragment >> 13) & 1;
        fragment_offset = fragment & ((1<<14)-1);
        if(reserved != 0 || more_fragments != 0 || fragment_offset != 0) {
                rohc_debugf(0,"Fragment error (%d, %d, %d, %d)\n", reserved, dont_fragment, more_fragments, fragment_offset);
                return -1;
        }
        is_ip_same = (udp_lite_profile->ip_flags.old_ip.saddr == ip->saddr) && (udp_lite_profile->ip_flags.old_ip.daddr == ip->daddr);
        // 1
        // udp 17
        if (ip->protocol == UDP_LITE_PRNR){
                udp_lite = (struct udphdr *)(ip+1);
                is_udp_same = ((udp_lite_profile->old_udp_lite.source == udp_lite->source) &&
                                (udp_lite_profile->old_udp_lite.dest == udp_lite->dest));
                return (is_ip_same && is_udp_same);

        }else if(ip->protocol == 4){
                ip2=(struct iphdr *)ip+1;
                if(ip2->protocol == UDP_LITE_PRNR){
                        udp_lite = (struct udphdr *)(ip+2);
                        is_udp_same = ((udp_lite_profile->old_udp_lite.source == udp_lite->source) &&
                                        (udp_lite_profile->old_udp_lite.dest == udp_lite->dest));
                        is_ip2_same = (udp_lite_profile->ip2_flags.old_ip.saddr == ip2->saddr) &&
                                        (udp_lite_profile->ip2_flags.old_ip.daddr == ip2->daddr);
                        return (is_ip_same && is_ip2_same && is_udp_same);

                }
                else{
                        return 0;
                }

        }else{
                return 0;
        }

}


// Change the mode of this context
void udp_lite_change_mode(struct sc_context *c, C_MODE new_mode) {
        if(c->c_mode != new_mode){
                c->c_mode = new_mode;
                udp_lite_change_state(c, IR);
        }
}

// Change the state of this context
void udp_lite_change_state(struct sc_context *c, C_STATE new_state)
{
        struct sc_udp_lite_context *ip = (struct sc_udp_lite_context *)c->profile_context;

        // Reset counters only if different state
        if (c->c_state != new_state) {
                ip->ir_count = 0;
                ip->fo_count = 0;
                ip->so_count = 0;
        }

        c->c_state = new_state;
}

/*
Encode packages to a pattern decided by several different factors.
1. Checks if we have double ip-headers
2. Check if the ip identification field are random and if it has network byte order
3. Decide what state we have, ir,fo or so
4. Decide how many bits needed to send ip-id and sn fields and most imortant updating
   the sliding windows.
5. Decide what packet to send.
6. Code the packet.


This function is one of the functions that must exist for the framework to
work. Please notice that a pointer to this function has to exist in the
sc_profile struct that we have in the bottom of this file.
*/
int c_udp_lite_encode(struct sc_context *context,
        const struct iphdr *ip,
        int packet_size,
    unsigned char *dest,
        int max_size,
        int *payload_offset)

{
        int size;
        int send_udp_dynamic;
        int reserved, dont_fragment, more_fragments, fragment_offset;
        unsigned short fragment;

        struct sc_udp_lite_context *udp_lite_profile = (struct sc_udp_lite_context *)context->profile_context;

        struct iphdr *ip2=(struct iphdr *)ip+1;
        struct udphdr *udp_lite;
        udp_lite_profile->tmp_variables.nr_ip_id_bits2 = 0;
        udp_lite_profile->tmp_variables.changed_fields2=0;
        udp_lite_profile->tmp_variables.packet_type = c_IR;
        udp_lite_profile->tmp_variables.max_size = max_size;
        // 1
        // udp UDP_LITE_PRNR
        if (ip->protocol == UDP_LITE_PRNR){
                ip2 = NULL;
                udp_lite_profile->tmp_variables.nr_of_ip_hdr = 1;
                //hÃ¤r kanske vi ska frÃ¥ga andreas
                udp_lite = (struct udphdr *)(ip+1);
                udp_lite_profile->tmp_variables.udp_size = packet_size - sizeof(struct iphdr);
                *payload_offset = 28;
        }else if(ip->protocol == 4){
                udp_lite_profile->tmp_variables.udp_size = packet_size - 2 * sizeof(struct iphdr);
                if(!udp_lite_profile->is_initialized){
                        c_udp_lite_init_context(&udp_lite_profile->ip2_flags,ip2,context->rnd2,context->nbo2);
                        udp_lite_profile->is_initialized = 1;
                }
                if(ip2->protocol == UDP_LITE_PRNR){
                        udp_lite = (struct udphdr *)(ip+2);
                        *payload_offset = 48;
                        udp_lite_profile->tmp_variables.nr_of_ip_hdr = 2;
                }
                else{
                        return -1;
                }
        }else{
                return -1;
        }

        if (udp_lite_profile == 0) {
          rohc_debugf(0,"c_udp_lite_encode(): udp_lite_profile==null\n");
          return 0;
        }
        
        fragment = ntohs(ip->frag_off);

        reserved = (fragment >> 15);
        dont_fragment = (fragment >> 14) & 1;
        more_fragments = (fragment >> 13) & 1;
        fragment_offset = fragment & ((1<<14)-1);
        if(reserved != 0 || more_fragments != 0 || fragment_offset != 0) {
                rohc_debugf(0,"Fragment error (%d, %d, %d, %d)\n", reserved, dont_fragment, more_fragments, fragment_offset);
                return -1;
        }


        // 2. Check NBO and RND of IP-ID
        if (udp_lite_profile->sn != 0){ // skip first packet
                udp_lite_check_ip_identification(&udp_lite_profile->ip_flags,ip,&context->rnd, &context->nbo);
                if(udp_lite_profile->tmp_variables.nr_of_ip_hdr > 1){
                        udp_lite_check_ip_identification(&udp_lite_profile->ip2_flags,ip2,&context->rnd2, &context->nbo2);
                }
        }
        // Update the sequence number every time we encode something.
        udp_lite_profile->sn = udp_lite_profile->sn + 1;
        udp_lite_profile->tmp_variables.changed_fields = udp_lite_changed_fields(&udp_lite_profile->ip_flags,ip);
        if(udp_lite_profile->tmp_variables.nr_of_ip_hdr > 1){
                udp_lite_profile->tmp_variables.changed_fields2 = udp_lite_changed_fields(&udp_lite_profile->ip2_flags,ip2);
        }

        udp_lite_profile->tmp_variables.send_static = udp_lite_changed_static_both_hdr(context,ip,ip2);
        udp_lite_profile->tmp_variables.send_dynamic = udp_lite_changed_dynamic_both_hdr(context,ip,ip2);
        send_udp_dynamic = udp_lite_changed_udp_dynamic(context,udp_lite);

        rohc_debugf(2,"send_static = %d, send_dynamic = %d\n", udp_lite_profile->tmp_variables.send_static,
                                udp_lite_profile->tmp_variables.send_dynamic);
        // 3
        udp_lite_decide_state(send_udp_dynamic,context);
        rohc_debugf(2,"ip->id=%d context->sn=%d\n", ntohs(ip->id), udp_lite_profile->sn);

        // 4
        c_udp_lite_update_variables(context,ip,ip2);

        // 5
        udp_lite_profile->tmp_variables.packet_type = udp_lite_decide_packet(context);

        // 6
        size = udp_lite_code_packet(udp_lite_profile,ip,ip2,udp_lite,dest,context);

        if(size < 0)
                return -1;

        if (udp_lite_profile->tmp_variables.packet_type == c_UO2) {
                int extension = udp_lite_decide_extension(context);

                rohc_debugf(1, "ROHC-UDP_LITE %s (%s): %d -> %d\n", udp_lite_packet_types[udp_lite_profile->tmp_variables.packet_type],
                        udp_lite_extension_types[extension],*payload_offset, size);
        } else {
                rohc_debugf(1, "ROHC-UDP_LITE %s: from %d -> %d\n", udp_lite_packet_types[udp_lite_profile->tmp_variables.packet_type],
                        *payload_offset, size);
        }


        udp_lite_profile->ip_flags.old_ip = *ip;

        udp_lite_profile->ip_flags.old_rnd = context->rnd;
        udp_lite_profile->ip_flags.old_nbo = context->nbo;

        if(udp_lite_profile->tmp_variables.nr_of_ip_hdr > 1){
                udp_lite_profile->ip2_flags.old_ip = *ip2;
                udp_lite_profile->ip2_flags.old_rnd = context->rnd2;
                udp_lite_profile->ip2_flags.old_nbo = context->nbo2;
        }

        if (udp_lite_profile->tmp_variables.packet_type == c_IR)
                context->num_send_ir ++;
        else if (udp_lite_profile->tmp_variables.packet_type == c_IRDYN)
                context->num_send_ir_dyn ++;

        return size;
}


/*
Function that update the profile when feedback has arrived.

This function is one of the functions that must exist for the framework to
work. Please notice that a pointer to this function has to exist in the
sc_profile struct that we have in the bottom of this file.
*/
void c_udp_lite_feedback(struct sc_context *context, struct sc_feedback *feedback)
{
        struct sc_udp_lite_context *ip_context = (struct sc_udp_lite_context *)context->profile_context;
        unsigned char *p = feedback->data + feedback->specific_offset;

        if (feedback->type == 1) { // ack
                unsigned int sn = p[0];

                c_ack_sn_wlsb(ip_context->ip_flags.ip_id_window, sn);
                c_ack_sn_wlsb(ip_context->sn_window, sn);

        } else if (feedback->type == 2) { // FEEDBACK-2
                unsigned int crc = 0, crc_used=0;

                int sn_not_valid = 0;
                unsigned char mode = (p[0]>>4) & 3;
                unsigned int sn = ((p[0] & 15) << 8) + p[1];
                int remaining = feedback->specific_size-2;

                p+=2;

                while (remaining > 0) {
                        int opt = p[0]>>4;
                        int optlen = p[0] & 0x0f;

                        switch (opt) {
                        case 1: // CRC
                                crc = p[1];
                                crc_used = 1;
                                p[1] = 0; // set to zero for crc computation..
                        break;
                        //case 2: // Reject
                        //break;
                        case 3: // SN-Not-Valid
                                sn_not_valid=1;
                        break;
                        case 4: // SN  -- TODO: how is several SN options combined?
                                sn = (sn<<8) + p[1];
                        break;
                        //case 7: // Loss
                        //break;
                        default:
                                rohc_debugf(0,"c_udp_lite_feedback(): Unknown feedback type: %d\n", opt);
                        break;
                        }

                        remaining -= 1 + optlen;
                        p += 1 + optlen;
                }

                if (crc_used) { // check crc..
                        if (crc_calculate(CRC_TYPE_8, feedback->data, feedback->size ) != crc) {
                                rohc_debugf(0,"c_udp_lite_feedback(): crc check failed..(size=%d)\n", feedback->size);
                                return;
                        }
                }

                if (mode != 0) {
                        if (crc_used) {
                                udp_lite_change_mode(context, mode);
                                rohc_debugf(1,"c_udp_lite_feedback(): changing mode to %d\n", mode);
                        } else {
                                rohc_debugf(0,"c_udp_lite_feedback(): mode change requested but no crc was given..\n");
                        }
                }

                switch (feedback->acktype) {
                case ACK:
                        if (sn_not_valid == 0) {
                                c_ack_sn_wlsb(ip_context->ip_flags.ip_id_window, sn);
                                c_ack_sn_wlsb(ip_context->sn_window, sn);
                        }
                break;

                case NACK:
                        if (context->c_state == SO){
                                change_state(context, FO);
                                ip_context->ir_dyn_count = 0;
                        }
                        if(context->c_state == FO){
                                ip_context->ir_dyn_count = 0;
                        }
                break;

                case STATIC_NACK:
                        udp_lite_change_state(context, IR);
                break;

                case RESERVED:
                        rohc_debugf(0, "c_udp_lite_feedback(): reserved field used\n");
                break;
                }

        } else {
                rohc_debugf(0,"c_udp_lite_feedback(): Feedback type not implemented (%d)\n", feedback->type);
        }

}

/*
Decide the state that that should be used for this packet
The three states are:
IR (initialization and refresh).
FO (first order).
SO (second order).
*/
void udp_lite_decide_state(int send_udp_dynamic, struct sc_context *context)
{
        struct sc_udp_lite_context *udp_lite_profile = (struct sc_udp_lite_context *)context->profile_context;
        int send_static = udp_lite_profile->tmp_variables.send_static;
        int send_dynamic = udp_lite_profile->tmp_variables.send_dynamic;
        if(context->c_state == IR && send_dynamic
                && udp_lite_profile->ir_count >= MAX_IR_COUNT){
                udp_lite_change_state(context, FO);
        }else if(context->c_state == IR && send_static
                && udp_lite_profile->ir_count >= MAX_IR_COUNT){
                udp_lite_change_state(context, FO);
        }else if (context->c_state == IR && udp_lite_profile->ir_count >= MAX_IR_COUNT) {
                udp_lite_change_state(context, SO);
        }else if (context->c_state == FO && send_dynamic
                && udp_lite_profile->fo_count >= MAX_FO_COUNT) {
                udp_lite_change_state(context, FO);
        }else if (context->c_state == FO && send_static
                && udp_lite_profile->fo_count >= MAX_FO_COUNT) {
                udp_lite_change_state(context, FO);
        }else if (context->c_state == FO && udp_lite_profile->fo_count >= MAX_FO_COUNT) {
                udp_lite_change_state(context, SO);
        }else if(context->c_state == SO && send_dynamic){
                udp_lite_change_state(context, FO);
        }else if(context->c_state == SO && send_static){
                udp_lite_change_state(context, FO);
        }
        if(context->c_mode == U){
                udp_lite_periodic_down_transition(context);
        }

}

/*
A function just to update some variables, only used in encode. Everything in this
function could be in encode but to make it more readable we have it here instead.
*/
void c_udp_lite_update_variables(struct sc_context *context,
        const struct iphdr *ip,
        const struct iphdr *ip2)
{
        struct sc_udp_lite_context *udp_lite_profile = (struct sc_udp_lite_context *)context->profile_context;
        if (context->nbo)
                udp_lite_profile->ip_flags.id_delta = (ntohs(ip->id) - udp_lite_profile->sn);
        else
                udp_lite_profile->ip_flags.id_delta = ip->id - udp_lite_profile->sn;

        if(udp_lite_profile->tmp_variables.nr_of_ip_hdr > 1){
                if (context->nbo2)
                        udp_lite_profile->ip2_flags.id_delta = (ntohs(ip2->id) - udp_lite_profile->sn);
                else
                        udp_lite_profile->ip2_flags.id_delta = ip2->id - udp_lite_profile->sn;
        }


        rohc_debugf(2,"Get k\n");
        rohc_debugf(2,"id_delta: %d\n",udp_lite_profile->ip_flags.id_delta);
        rohc_debugf(2,"Given that sn: %d\n",udp_lite_profile->sn);
        udp_lite_profile->tmp_variables.nr_ip_id_bits = c_get_k_wlsb(udp_lite_profile->ip_flags.ip_id_window, udp_lite_profile->ip_flags.id_delta);
        udp_lite_profile->tmp_variables.nr_sn_bits = c_get_k_wlsb(udp_lite_profile->sn_window, udp_lite_profile->sn);

        rohc_debugf(2,"Adding\n");
        c_add_wlsb(udp_lite_profile->ip_flags.ip_id_window, udp_lite_profile->sn, 0, udp_lite_profile->ip_flags.id_delta); // TODO: replace 0 with time(0)
        c_add_wlsb(udp_lite_profile->sn_window, udp_lite_profile->sn, 0, udp_lite_profile->sn); // TODO: replace 0 with time(0)

        rohc_debugf(2,"ip_id bits=%d\n", udp_lite_profile->tmp_variables.nr_ip_id_bits);
        rohc_debugf(2,"sn bits=%d\n", udp_lite_profile->tmp_variables.nr_sn_bits);
        if(udp_lite_profile->tmp_variables.nr_of_ip_hdr > 1){
                udp_lite_profile->tmp_variables.nr_ip_id_bits2 = c_get_k_wlsb(udp_lite_profile->ip2_flags.ip_id_window, udp_lite_profile->ip2_flags.id_delta);
                rohc_debugf(2,"ip_id bits2=%d\n", udp_lite_profile->tmp_variables.nr_ip_id_bits2);
                c_add_wlsb(udp_lite_profile->ip2_flags.ip_id_window, udp_lite_profile->sn, 0, udp_lite_profile->ip2_flags.id_delta); // TODO: replace 0 with time(0)
        }
}

/*Function that change state periodicly after a certain number of packets */
void udp_lite_periodic_down_transition(struct sc_context *context)
{
        struct sc_udp_lite_context *udp_lite_profile = (struct sc_udp_lite_context *)context->profile_context;
        if(udp_lite_profile->go_back_fo_count == CHANGE_TO_FO_COUNT){
                udp_lite_profile->go_back_fo_count = 0;
                udp_lite_profile->ir_dyn_count = 0;
                udp_lite_change_state(context, FO);

        } else if(udp_lite_profile->go_back_ir_count == CHANGE_TO_IR_COUNT){
                udp_lite_profile->go_back_ir_count = 0;
                udp_lite_change_state(context, IR);
        }
        if (context->c_state == SO)
                udp_lite_profile->go_back_fo_count++;
        if(context->c_state == SO || context->c_state == FO)
                udp_lite_profile->go_back_ir_count++;
}

/*
Decide what packet to send in the different states,
In IR state, ir packets are used. In FO and SO the functions udp_lite_decide_FO_packet and udp_lite_decide_SO_packet is used.
*/
int udp_lite_decide_packet(struct sc_context *context)
{
        struct sc_udp_lite_context *udp_lite_profile = (struct sc_udp_lite_context *)context->profile_context;
        int packet_type=IR;
        switch(context->c_state)
        {
                case IR:
                        rohc_debugf(2,"c_udp_lite_encode(): IR state\n");
                        udp_lite_profile->ir_count++;
                        packet_type = c_IR;
                        break;
                case FO:
                        rohc_debugf(2,"c_udp_lite_encode(): FO state\n");
                        udp_lite_profile->fo_count++;
                        packet_type = udp_lite_decide_FO_packet(context);
                        break;

                case SO:
                        rohc_debugf(2,"c_udp_lite_encode(): SO state\n");
                        udp_lite_profile->so_count++;
                        packet_type = udp_lite_decide_SO_packet(context);
                        break;
        }
        return packet_type;
}

/*
Decide which packet to send in first order state
The packets that can be used is IRDYN and UO2 packets.
*/
int udp_lite_decide_FO_packet(struct sc_context *context)
{
        struct sc_udp_lite_context *udp_lite_profile = (struct sc_udp_lite_context *)context->profile_context;
        if(udp_lite_profile->ir_dyn_count < MAX_FO_COUNT){
                udp_lite_profile->ir_dyn_count++;
                return c_IRDYN;
        }else if (udp_lite_profile->tmp_variables.send_static) { // if static field changed we must go back to ir
                return c_UO2;
        }else if((udp_lite_profile->tmp_variables.nr_of_ip_hdr == 1 && udp_lite_profile->tmp_variables.send_dynamic > 2)){
                return c_IRDYN;
        }else if((udp_lite_profile->tmp_variables.nr_of_ip_hdr > 1 && udp_lite_profile->tmp_variables.send_dynamic > 4)){
                return c_IRDYN;
        }
        else{
                return c_UO2;
        }

}

/*
Decide which packet to send in second order state
Packet that can be used are UO0, UO1, UO2 with or without extensions.
*/
int udp_lite_decide_SO_packet(const struct sc_context *context)
{
        struct sc_udp_lite_context *udp_lite_profile = (struct sc_udp_lite_context *)context->profile_context;
        int nr_ip_id_bits = udp_lite_profile->tmp_variables.nr_ip_id_bits;
        int nr_ip_id_bits2 = udp_lite_profile->tmp_variables.nr_ip_id_bits2;
        int nr_sn_bits = udp_lite_profile->tmp_variables.nr_sn_bits;
        if(udp_lite_profile->tmp_variables.nr_of_ip_hdr == 1){
                if(context->rnd == 1 && nr_sn_bits <= 4){
                        return c_UO0;
                }
                else if(nr_sn_bits <= 4 && nr_ip_id_bits == 0){
                        return c_UO0;
                }
                else if(nr_sn_bits == 5 && nr_ip_id_bits == 0){
                        return c_UO2;
                }
                else if(nr_sn_bits <= 5 && nr_ip_id_bits <= 6){
                        return c_UO1;
                }
                else{
                        return c_UO2;
                }
        }
        else{
                if(context->rnd == 1 && context->rnd2 == 1 && nr_sn_bits <= 4){
                        return c_UO0;
                }
                else if(nr_sn_bits <= 4 && (context->rnd == 1 || nr_ip_id_bits == 0)
                && (context->rnd2 == 1 || nr_ip_id_bits2 ==0)){

                        return c_UO0;
                }
                else if(nr_sn_bits <= 5 && nr_ip_id_bits <= 6 && (context->rnd2 == 1 || nr_ip_id_bits2 == 0)){
                        return c_UO1;
                }
                else{
                        return c_UO2;
                }
        }
}

/*Code the given packet type*/

/*
Code the given packet type
Every given type has its own help function
The ir and ir-dyn packet are totally coded by their own functions. The general format
for other packets are coded in this function according to the following:

     0   1   2   3   4   5   6   7
    --- --- --- --- --- --- --- ---
1  :         Add-CID octet         :  if for small CIDs and CID 1-15
   +---+---+---+---+---+---+---+---+
2  | 1   1   1   1   1   0   F   K |  Outer packet type identifier
   +---+---+---+---+---+---+---+---+
   :                               :
3  /   0, 1, or 2 octets of CID    /  1-2 octets if large CIDs
   :                               :
   +---+---+---+---+---+---+---+---+
4  |   first octet of base header  |  (with type indication)
   +---+---+---+---+---+---+---+---+
5  /   remainder of base header    /  variable number of bits
   +---+---+---+---+---+---+---+---+
   :                               :
6  /     Extension (see 5.7.5)     /  extension, if X = 1 in base header
   :                               :
    --- --- --- --- --- --- --- ---
   :                               :
7  +   IP-ID of outer IPv4 header  +  2 octets, if value(RND2) = 1
   :                               :
    --- --- --- --- --- --- --- ---
8  /    AH data for outer list     /  variable (see 5.8.4.2)
    --- --- --- --- --- --- --- ---
   :                               :
9  +   GRE checksum (see 5.8.4.4)  +  2 octets, if GRE flag C = 1
   :                               :
    --- --- --- --- --- --- --- ---
   :                               :
10 +   IP-ID of inner IPv4 header  +  2 octets, if value(RND) = 1
   :                               :
    --- --- --- --- --- --- --- ---
11 /    AH data for inner list     /  variable (see 5.8.4.2)
    --- --- --- --- --- --- --- ---
   :                               :
12 +   GRE checksum (see 5.8.4.4)  +  2 octets, if GRE flag C = 1
   :                               :
    --- --- --- --- --- --- --- ---
   :            List of            :
13 /        Dynamic chains         /    variable, given by static chain
   :   for additional IP headers   :           (includes no SN)
    --- --- --- --- --- --- --- ---
   :                               :  2 octets,
14 +  UDP-Lite Checksum Coverage   +  if context(CFP) = 1 or
   :                               :  if packet type = CE
    --- --- --- --- --- --- --- ---
   :                               :
15 +         UDP Checksum          +  2 octets,
   :                               :
    --- --- --- --- --- --- --- ---
    
8, 9, 11, 12, 13 is not supported.
Each profile code 1, 2, 3, 4, 5, 6 is coded in each packets function
6, 9, 14, 15 is coded in this function
*/
int udp_lite_code_packet(struct sc_udp_lite_context *udp_lite_profile,
        const struct iphdr *ip,
        const struct iphdr *ip2,
        const struct udphdr *udp_lite,
        unsigned char *dest,
        struct sc_context *context)
{
        int counter = 0;
        int first_position;
        boolean send_ce_packet;
        //struct sc_udp_lite_context *udp_lite_profile = (struct sc_udp_lite_context *)context->profile_context;
        //Both 1 and 3, 2 will be put on first_position
        counter = code_cid_values(context,dest,udp_lite_profile->tmp_variables.max_size,&first_position);
        rohc_debugf(2,"counter=%d, first_position=%d .\n",counter,first_position);
        switch(udp_lite_profile->tmp_variables.packet_type){
                case c_IR:
                        rohc_debugf(2,"udp_lite_code_packet(): IR packet..\n");
                        return udp_lite_code_IR_packet(udp_lite_profile,ip,ip2,udp_lite,
                                dest,context,counter,first_position);
                        break;
                case c_IRDYN:
                        rohc_debugf(2,"udp_lite_code_packet(): IRDYN packet..\n");
                        return udp_lite_code_IR_DYN_packet(udp_lite_profile,ip,ip2,udp_lite,dest,
                                                context,counter,first_position);
                        break;
        }
        send_ce_packet = udp_lite_send_ce_packet(udp_lite_profile,udp_lite,dest,context);
        if(send_ce_packet){
                rohc_debugf(2,"Sending ce-packet..\n");
                // 2*
                dest[first_position] = (0xf8 | udp_lite_profile->FK);
                //Now the first_position will be on counter current position
                //and counter must be increased
                first_position = counter;
                counter++;
        }
        else{
                rohc_debugf(2,"Not ce-packet..\n");
        }


        switch(udp_lite_profile->tmp_variables.packet_type){
                case c_UO0:
                        rohc_debugf(2,"udp_lite_code_packet(): OU-0 packet..\n");
                        counter = udp_lite_code_UO0_packet(context, ip, dest, 
                                counter,first_position);
                        break;
                case c_UO1:
                        rohc_debugf(2,"udp_lite_code_packet(): OU-1 packet..\n");
                        counter = udp_lite_code_UO1_packet(context, ip, dest, 
                                counter,first_position);
                        break;

                case c_UO2:
                        rohc_debugf(2,"udp_lite_code_packet(): OU-2 packet..\n");
                        counter = udp_lite_code_UO2_packet(context,udp_lite_profile,ip,ip2,dest,counter,first_position);
                        break;
                default:
                        rohc_debugf(0,"udp_lite_code_packet(): Unknown packet..\n");
                        return -1;
        }
        rohc_debugf(2,"RND=%d RND2=%d\n",context->rnd, context->rnd2);

        // 10
        if(context->rnd == 1){
                memcpy(&dest[counter], &ip->id, 2);
                counter += 2;
        }

        // 7
        if(udp_lite_profile->tmp_variables.nr_of_ip_hdr > 1){
                if(context->rnd2 == 1){
                        memcpy(&dest[counter], &ip2->id, 2);
                        counter += 2;
                }
        }
        rohc_debugf(2,"cfp value: %d..\n", udp_lite_profile->cfp);
        // 14
        if((udp_lite_profile->cfp == 1) || send_ce_packet){
                memcpy(&dest[counter], &udp_lite->len, 2);

                counter += 2;
        }

        // 15
        memcpy(&dest[counter], &udp_lite->check, 2);
        counter += 2;
        

        return counter;

}


/*
Code the IR-packet to this pattern:

IR packet (5.7.7.1):

     0   1   2   3   4   5   6   7
    --- --- --- --- --- --- --- ---
1  |         Add-CID octet         |  if for small CIDs and CID != 0
   +---+---+---+---+---+---+---+---+
2  | 1   1   1   1   1   1   0 | D |
   +---+---+---+---+---+---+---+---+
   |                               |
3  /    0-2 octets of CID info     /  1-2 octets if for large CIDs
   |                               |
   +---+---+---+---+---+---+---+---+
4  |            Profile            |  1 octet
   +---+---+---+---+---+---+---+---+
5  |              CRC              |  1 octet
   +---+---+---+---+---+---+---+---+
   |                               |
6  |         Static chain          |  variable length
   |                               |
   +---+---+---+---+---+---+---+---+
   |                               |
7  |         Dynamic chain         |  present if D = 1, variable length
   |                               |
   +---+---+---+---+---+---+---+---+
   |                               |
   |           Payload             |  variable length
   |                               |
    - - - - - - - - - - - - - - - -

The numbers before every field is used to find where in the code we try
to code that field.
*/
int udp_lite_code_IR_packet(struct sc_udp_lite_context *udp_lite_profile,
        const struct iphdr *ip,
        const struct iphdr *ip2,
        const struct udphdr *udp_lite,
        unsigned char *dest,
        struct sc_context *context,
        int counter,
        int first_position)

{
        unsigned char type;
        int crc_position;


        udp_lite_initiate_coverage_context(udp_lite_profile,udp_lite,dest,context);

        rohc_debugf(2,"Coding IR packet (cid=%d)\n", context->cid);
        
        // 2
        type = 0xfc;
        //Always sends dynamic
        type += 1;


        dest[first_position] = type;
        // if large cid
        // Set profile_id and crc to zero so far
        // 3
        dest[counter] = context -> profile_id;
        counter++;

        // 5
        // Becuase we calculate the crc over the ir packet with the crc field set to zero
        // The real crc is calculated in the end of this function
        crc_position = counter;
        dest[counter] = 0;
        counter++;

        // 6
        counter = udp_lite_code_static_part(context,&udp_lite_profile->ip_flags,ip,dest, counter);

        if(udp_lite_profile->tmp_variables.nr_of_ip_hdr > 1){
                counter = udp_lite_code_static_part(context,&udp_lite_profile->ip2_flags,ip2,dest,counter);
        }
        if(counter < 0)
                return -1;
        counter = udp_lite_code_static_udp_part(context,udp_lite,dest,counter);

        // Add the dynamic part
        // Set type of service, time to live id, and some small flags
        //if(udp_lite_changed_dynamic_both_hdr(changed_fields,context) > 0){
        //rohc_debugf(1,"Crc length=%d\n", counter);


        // 7

        //Observe that if we don't wan't dynamic part in ir-packet we should not send the following
        //******************************************************************************************************
        counter = udp_lite_code_dynamic_part(context,&udp_lite_profile->ip_flags,ip,dest,counter,&context->rnd,&context->nbo);
        if(udp_lite_profile->tmp_variables.nr_of_ip_hdr > 1){
                counter = udp_lite_code_dynamic_part(context,&udp_lite_profile->ip2_flags,ip2,dest,counter,&context->rnd2,&context->nbo2);
        }
        if(counter < 0)
                return -1;
        counter = udp_lite_code_dynamic_udp_part(context,udp_lite,dest,counter);
        //******************************************************************************************************


        //}

        // 5 Count the crc and set the crc field to the checksum.
        rohc_debugf(2,"Crc length=%d\n", counter);
        dest[crc_position]= crc_calculate(CRC_TYPE_8,dest,counter);
        return counter;

}
/*
Code the IRDYN-packet to this pattern:

IR-dyn packet (5.7.7.2):

     0   1   2   3   4   5   6   7
    --- --- --- --- --- --- --- ---
1  :         Add-CID octet         : if for small CIDs and CID != 0
   +---+---+---+---+---+---+---+---+
2  | 1   1   1   1   1   0   0   0 | IR-DYN packet type
   +---+---+---+---+---+---+---+---+
   :                               :
3  /     0-2 octets of CID info    / 1-2 octets if for large CIDs
   :                               :
   +---+---+---+---+---+---+---+---+
4  |            Profile            | 1 octet
   +---+---+---+---+---+---+---+---+
5  |              CRC              | 1 octet
   +---+---+---+---+---+---+---+---+
   |                               |
6  /         Dynamic chain         / variable length
   |                               |
   +---+---+---+---+---+---+---+---+
   :                               :
   /           Payload             / variable length
   :                               :
    - - - - - - - - - - - - - - - -


The numbers before every field is used to find where in the code we try
to code that field.

*/
int udp_lite_code_IR_DYN_packet(struct sc_udp_lite_context *udp_lite_profile,
        const struct iphdr *ip,
        const struct iphdr *ip2,
        const struct udphdr *udp_lite,
        unsigned char *dest,
        struct sc_context *context,
        int counter,
        int first_position)
{
        int crc_position;
        udp_lite_initiate_coverage_context(udp_lite_profile,udp_lite,dest,context);
        // 2
        dest[first_position] = 0xf8;

        // 4
        dest[counter] = context -> profile_id;
        counter++;

        // 5
        // Becuase we calculate the crc over the ir packet with the crc field set to zero
        // The real crc is calculated in the end of this function
        crc_position = counter;
        dest[counter] = 0;
        counter++;

        // 6
        counter = udp_lite_code_dynamic_part(context,&udp_lite_profile->ip_flags,ip,dest,counter,&context->rnd,&context->nbo);
        if(udp_lite_profile->tmp_variables.nr_of_ip_hdr > 1){
                counter = udp_lite_code_dynamic_part(context,&udp_lite_profile->ip2_flags,ip2,dest,counter,&context->rnd2,&context->nbo2);
        }
        if(counter < 0)
                return -1;
        counter = udp_lite_code_dynamic_udp_part(context,udp_lite,dest,counter);

        // 5
        // Count the crc and set the crc field to the checksum.
        dest[crc_position]= crc_calculate(CRC_TYPE_8,dest,counter);
        return counter;
}


/*
Code the static part:
Static part IPv4 (5.7.7.4):

   +---+---+---+---+---+---+---+---+
1  |  Version = 4  |       0       |
   +---+---+---+---+---+---+---+---+
2  |           Protocol            |
   +---+---+---+---+---+---+---+---+
3  /        Source Address         /   4 octets
   +---+---+---+---+---+---+---+---+
4  /      Destination Address      /   4 octets
   +---+---+---+---+---+---+---+---+
*/
int udp_lite_code_static_part(struct sc_context *context,
        struct sc_udp_lite_header *ip_hdr_profile,
        const struct iphdr *ip,
        unsigned char *dest,
        int counter)
{

        // 1
        dest[counter] = 0x40;
        counter++;

        // 2
        dest[counter] = ip -> protocol; rohc_debugf(3,"code_IR, protocol=%d\n", dest[counter]);
        counter++;
        ip_hdr_profile -> protocol_count++;

        // 3
        memcpy(&dest[counter], &ip -> saddr, 4);
        counter += 4;

        // 4
        memcpy(&dest[counter], &ip -> daddr, 4);
        counter += 4;
        return counter;
}

/*
Static part of udp_lite header (5.7.7.5):

   +---+---+---+---+---+---+---+---+
1  /          Source Port          /   2 octets
   +---+---+---+---+---+---+---+---+
2  /       Destination Port        /   2 octets
   +---+---+---+---+---+---+---+---+
*/
int udp_lite_code_static_udp_part(struct sc_context *context,
        const struct udphdr *udp_lite,
        unsigned char *dest,
        int counter)
{
        // 1
        memcpy(&dest[counter], &udp_lite->source, 2);
        counter += 2;

        // 2
        memcpy(&dest[counter], &udp_lite->dest, 2);
        counter += 2;

        return counter;
}

/*
Code the dynamic part:
Dynamic part IPv4 (5.7.7.4):

   +---+---+---+---+---+---+---+---+
1  |        Type of Service        |
  +---+---+---+---+---+---+---+---+
2  |         Time to Live          |
   +---+---+---+---+---+---+---+---+
3  /        Identification         /   2 octets
   +---+---+---+---+---+---+---+---+
4  | DF|RND|NBO|         0         |
   +---+---+---+---+---+---+---+---+
5  / Generic extension header list /  variable length
   +---+---+---+---+---+---+---+---+
*/
int udp_lite_code_dynamic_part(struct sc_context *context,
        struct sc_udp_lite_header *ip_hdr_profile,
        const struct iphdr *ip,
        unsigned char *dest,
        int counter,
        int *rnd,
        int *nbo)
{

        unsigned char df_rnd_nbo = 0;
        int reserved, dont_fragment, more_fragments, fragment_offset;
        unsigned short fragment;

        // 1
        dest[counter] = ip -> tos;
        counter++;
        ip_hdr_profile->tos_count++;

        // 2
        dest[counter] = ip -> ttl;
        counter++;
        ip_hdr_profile->ttl_count++;

        // 3
        memcpy(&dest[counter], &ip->id, 2);
        counter += 2;

        // 4
        fragment = ntohs(ip->frag_off);

        reserved = (fragment >> 15);
        dont_fragment = (fragment >> 14) & 1;
        more_fragments = (fragment >> 13) & 1;
        fragment_offset = fragment & ((1<<14)-1);
        if(reserved != 0 || more_fragments != 0 || fragment_offset != 0) {
                rohc_debugf(0,"Fragment error (%d, %d, %d, %d)\n", reserved, dont_fragment, more_fragments, fragment_offset);
                return -1;
        }
        df_rnd_nbo = (dont_fragment << 7);
        ip_hdr_profile->df_count++;
        // Check random flags and network byte order flag in the context struct
        if(*rnd){
                df_rnd_nbo |= 0x40;
        }
        if(*nbo){
                df_rnd_nbo |= 0x20;
        }
        ip_hdr_profile->rnd_count++;
        ip_hdr_profile->nbo_count++;
        dest[counter] = df_rnd_nbo;
        counter++;

        // 5 is not supported

        return counter;
}

/*
Dynamic part of udp_lite header (5.7.7.5):

   +---+---+---+---+---+---+---+---+
1  /       Checksum Coverage       /   2 octets
   +---+---+---+---+---+---+---+---+
2  /           Checksum            /   2 octets
   +---+---+---+---+---+---+---+---+
3  |             SN                |   2 octets
   +---+---+---+---+---+---+---+---+
*/
int udp_lite_code_dynamic_udp_part(struct sc_context *context,
        const struct udphdr *udp_lite,
        unsigned char *dest,
        int counter)
{
        struct sc_udp_lite_context *udp_lite_profile = (struct sc_udp_lite_context *)context->profile_context;

        // 1

        memcpy(&dest[counter], &udp_lite->len,2);
        counter += 2;


        // 2
        memcpy(&dest[counter], &udp_lite->check, 2);
        counter += 2;


        // 3
        dest[counter] = (udp_lite_profile->sn) >> 8;
        counter++;
        dest[counter] = (udp_lite_profile->sn) & 0xff;
        counter++;
        return counter;
}
/*
Code UO0-packets according to the following pattern:

     0   1   2   3   4   5   6   7
    --- --- --- --- --- --- --- ---
1  :         Add-CID octet         :
   +---+---+---+---+---+---+---+---+
2  | 1   1   1   1   1   0   F   K |  Outer packet type identifier
   +---+---+---+---+---+---+---+---+
   :                               :
3  /   0, 1, or 2 octets of CID    /
   :                               :
   +---+---+---+---+---+---+---+---+

   UO-0 (5.7.1)

     0   1   2   3   4   5   6   7
   +---+---+---+---+---+---+---+---+
4  | 0 |      SN       |    CRC    |
   +===+===+===+===+===+===+===+===+
*/

int udp_lite_code_UO0_packet(struct sc_context *context,
        const struct iphdr *ip,
        unsigned char *dest,
        int counter,
        int first_position)
{
        struct sc_udp_lite_context *udp_lite_profile = (struct sc_udp_lite_context *)context->profile_context;
        unsigned char f_byte;


        int ch_sum;


        // 4
        f_byte = (udp_lite_profile -> sn) & 0xf;
        f_byte = f_byte << 3;
        if(udp_lite_profile->tmp_variables.nr_of_ip_hdr == 1)
                ch_sum= crc_calculate(CRC_TYPE_3,(unsigned char *)ip,sizeof(struct iphdr)+sizeof(struct udphdr));
        else
                ch_sum= crc_calculate(CRC_TYPE_3,(unsigned char *)ip,2*sizeof(struct iphdr)+sizeof(struct udphdr));
        f_byte = f_byte + ch_sum;
        dest[first_position] = f_byte;
        return counter;
}

/*
Code UO1-packets acording to the following pattern:

     0   1   2   3   4   5   6   7
    --- --- --- --- --- --- --- ---
1  :         Add-CID octet         :
   +---+---+---+---+---+---+---+---+
2  |   first octet of base header  |
   +---+---+---+---+---+---+---+---+
   :                               :
3  /   0, 1, or 2 octets of CID    /
   :                               :
   +---+---+---+---+---+---+---+---+

   OU-1 (5.11.3)

     0   1   2   3   4   5   6   7
   +---+---+---+---+---+---+---+---+
2  | 1   0 |         IP-ID         |
   +===+===+===+===+===+===+===+===+
4  |        SN         |    CRC    |
   +---+---+---+---+---+---+---+---+

*/
int udp_lite_code_UO1_packet(struct sc_context *context,
        const struct iphdr *ip,
        unsigned char *dest,
        int counter,
        int first_position)
{
        struct sc_udp_lite_context *udp_lite_profile = (struct sc_udp_lite_context *)context->profile_context;
        unsigned char f_byte;
        unsigned char s_byte;

        int ch_sum;

        f_byte = (udp_lite_profile -> ip_flags.id_delta) & 0x3f;
        f_byte |= 0x80;
        // Add the 5 bits of sn
        s_byte = (udp_lite_profile -> sn) & 0x1f;
        s_byte = s_byte << 3;
        if(udp_lite_profile->tmp_variables.nr_of_ip_hdr == 1)
                ch_sum= crc_calculate(CRC_TYPE_3,(unsigned char *)ip,sizeof(struct iphdr)+sizeof(struct udphdr));
        else
                ch_sum= crc_calculate(CRC_TYPE_3,(unsigned char *)ip,2*sizeof(struct iphdr)+sizeof(struct udphdr));
        s_byte |= ch_sum;
        dest[first_position] = f_byte;
        dest[counter] = s_byte;
        counter++;
        return counter;
}

/*
Code UO0-packets acording to the following pattern:

     0   1   2   3   4   5   6   7
    --- --- --- --- --- --- --- ---
1  :         Add-CID octet         :
   +---+---+---+---+---+---+---+---+
2  |   first octet of base header  |
   +---+---+---+---+---+---+---+---+
   :                               :
3  /   0, 1, or 2 octets of CID    /
   :                               :
   +---+---+---+---+---+---+---+---+

   OU-2 (5.11.3):

     0   1   2   3   4   5   6   7
   +---+---+---+---+---+---+---+---+
2  | 1   1   0 |        SN         |
   +===+===+===+===+===+===+===+===+
4  | X |            CRC            |
   +---+---+---+---+---+---+---+---+

   +---+---+---+---+---+---+---+---+
   :                               :
5  /           Extension           /
   :                               :
    --- --- --- --- --- --- --- ---
*/
int udp_lite_code_UO2_packet(struct sc_context *context,
        struct sc_udp_lite_context *udp_lite_profile,
        const struct iphdr *ip,
        const struct iphdr *ip2,
        unsigned char *dest,
        int counter,
        int first_position)
{

        unsigned char f_byte;
        unsigned char s_byte;
        int ch_sum;
        int extension;

        // 2
        f_byte = 0xc0;
        // Add the 4 bits of sn

        // 4
        if(udp_lite_profile->tmp_variables.nr_of_ip_hdr == 1)
                ch_sum= crc_calculate(CRC_TYPE_7,(unsigned char *)ip,sizeof(struct iphdr)+sizeof(struct udphdr));
        else
                ch_sum= crc_calculate(CRC_TYPE_7,(unsigned char *)ip,2*sizeof(struct iphdr)+sizeof(struct udphdr));
        s_byte = ch_sum;

        // 5
        extension = udp_lite_decide_extension(context);
        if(extension == c_NOEXT){
                rohc_debugf(1,"code_OU2_packet(): no extension\n");
                // 2
                f_byte |= ((udp_lite_profile -> sn) & 0x1f);
                dest[first_position] = f_byte;
                // 4
                dest[counter] = s_byte;
                counter++;
                return counter;
        }
        // 4
        //We have a extension
        s_byte |= 0x80;
        dest[counter] = s_byte;
        counter++;

        // 5
        if(extension == c_EXT0) {
                rohc_debugf(1,"code_OU2_packet(): using extension 0\n");
                // 2
                f_byte |= ((udp_lite_profile -> sn & 0xff) >> 3);
                dest[first_position] = f_byte;
                // 5
                counter = udp_lite_code_EXT0_packet(context,ip,dest,counter);
        } else if(extension == c_EXT1) {
                rohc_debugf(1,"code_OU2_packet(): using extension 1\n");
                // 2
                f_byte |= ((udp_lite_profile -> sn & 0xff) >> 3);
                dest[first_position] = f_byte;
                // 5
                counter = udp_lite_code_EXT1_packet(context,ip,dest,counter);
        } else if(extension == c_EXT2){
                rohc_debugf(1,"code_OU2_packet(): using extension 2\n");
                // 2
                f_byte |= ((udp_lite_profile -> sn & 0xff) >> 3);
                dest[first_position] = f_byte;
                // 5
                counter = udp_lite_code_EXT2_packet(context,udp_lite_profile,ip,dest,counter);
        }
        else if(extension == c_EXT3) {
                rohc_debugf(1,"code_OU2_packet(): using extension 3\n");
                // 2
                // check if s-field needs to be used
                if(udp_lite_profile->tmp_variables.nr_sn_bits > 5)
                        f_byte |= ((udp_lite_profile -> sn) >> 8);
                else
                        f_byte |= (udp_lite_profile -> sn & 0x1f);

                dest[first_position] = f_byte;
                // 5
                counter = udp_lite_code_EXT3_packet(context,udp_lite_profile,ip,ip2,dest,counter);
        } else {
                rohc_debugf(0,"code_OU2_packet(): Unknown extension (%d)..\n", extension);

        }
        return counter;
}


/*
Coding the extension 0 part of the uo0-packet

   Extension 0 (5.11.4):

      +---+---+---+---+---+---+---+---+
1     | 0   0 |    SN     |   IP-ID   |
      +---+---+---+---+---+---+---+---+

*/
int udp_lite_code_EXT0_packet(struct sc_context *context,const struct iphdr *ip,
                                unsigned char *dest, int counter)
{
        struct sc_udp_lite_context *udp_lite_profile = (struct sc_udp_lite_context *)context->profile_context;
        unsigned char f_byte;

        // 1
        f_byte = (udp_lite_profile -> sn) & 0x07;
        f_byte = f_byte << 3;
        f_byte |= (udp_lite_profile ->ip_flags. id_delta) & 0x07;
        dest[counter] = f_byte;
        counter++;
        return counter;

}
/*
Coding the extension 1 part of the uo1-packet

   Extension 1 (5.11.4):

      +---+---+---+---+---+---+---+---+
 1    | 0   1 |    SN     |   IP-ID   |
      +---+---+---+---+---+---+---+---+
 2    |             IP-ID             |
      +---+---+---+---+---+---+---+---+
*/
int udp_lite_code_EXT1_packet(struct sc_context *context,
        const struct iphdr *ip,
        unsigned char *dest,
        int counter)
{
        //Code for the extension
        struct sc_udp_lite_context *udp_lite_profile = (struct sc_udp_lite_context *)context->profile_context;
        unsigned char f_byte;
        unsigned char s_byte;
        unsigned short id;

        // 1
        f_byte = (udp_lite_profile -> sn) & 0x07;
        f_byte = f_byte << 3;
        id = (udp_lite_profile ->ip_flags. id_delta) & 0x0700;
        id = id >> 8;
        f_byte |= id;
        f_byte |= 0x40;

        // 2
        s_byte = (udp_lite_profile ->ip_flags. id_delta) & 0xff;
        dest[counter] = f_byte;
        counter++;
        dest[counter] = s_byte;
        counter++;
        return counter;
}


/*
Coding the extension 1 part of the uo1-packet

   Extension 2 (5.11.4):

      +---+---+---+---+---+---+---+---+
 1    | 1   0 |    SN     |   IP-ID2  |
      +---+---+---+---+---+---+---+---+
 2    |            IP-ID2             |
      +---+---+---+---+---+---+---+---+
 3    |             IP-ID             |
      +---+---+---+---+---+---+---+---+

         IP-ID2: For outer IP-ID field.
*/
int udp_lite_code_EXT2_packet(struct sc_context *context,
        struct sc_udp_lite_context *udp_lite_profile,
        const struct iphdr *ip,
        unsigned char *dest,
        int counter)
{
        //Code for the extension

        unsigned char f_byte;
        unsigned char s_byte;
        unsigned short id;

        //its a bit confusing here but ip-id2 in the packet
        //description means the first headers ip-id and ip-flags
        //mean the first header and ip2-flags means the second
        //ip-header
        // 1
        f_byte = (udp_lite_profile -> sn) & 0x07;
        f_byte = f_byte << 3;
        id = (udp_lite_profile->ip_flags.id_delta) & 0x0700;
        id = id >> 8;
        f_byte |= id;
        f_byte |= 0x80;
        dest[counter] = f_byte;
        counter++;

        // 2
        s_byte = (udp_lite_profile->ip_flags .id_delta) & 0xff;
        dest[counter] = s_byte;
        counter++;

        // 3
        dest[counter] = (udp_lite_profile ->ip2_flags.id_delta) & 0xff;
        counter++;
        return counter;
}

/*
Coding the extension 3 part of the uo2-packet

    Extension 3 (5.7.5 && 5.11.4):

      0     1     2     3     4     5     6     7
   +-----+-----+-----+-----+-----+-----+-----+-----+
1  |  1     1  |  S  |   Mode    |  I  | ip  | ip2 |
   +-----+-----+-----+-----+-----+-----+-----+-----+
2  |            Inner IP header flags        |     |  if ip = 1
   +-----+-----+-----+-----+-----+-----+-----+-----+
3  |            Outer IP header flags              |
   +-----+-----+-----+-----+-----+-----+-----+-----+
4  |                      SN                       |  if S = 1
   +-----+-----+-----+-----+-----+-----+-----+-----+
   |                                               |
5  /            Inner IP header fields             /  variable,
   |                                               |
   +-----+-----+-----+-----+-----+-----+-----+-----+
6  |                     IP-ID                     |  2 octets, if I = 1
   +-----+-----+-----+-----+-----+-----+-----+-----+
   |                                               |
7  /            Outer IP header fields             /  variable,
   |                                               |
   +-----+-----+-----+-----+-----+-----+-----+-----+

*/
int udp_lite_code_EXT3_packet(struct sc_context *context,
        struct sc_udp_lite_context *udp_lite_profile,
        const struct iphdr *ip,
        const struct iphdr *ip2,
        unsigned char *dest,
        int counter)
{
        //Code for the extension
        unsigned char f_byte;
        unsigned char changed_fields = udp_lite_profile->tmp_variables.changed_fields;
        unsigned char changed_fields2 = udp_lite_profile->tmp_variables.changed_fields2;
        int nr_ip_id_bits = udp_lite_profile->tmp_variables.nr_ip_id_bits;
        int nr_ip_id_bits2 = udp_lite_profile->tmp_variables.nr_ip_id_bits2;
        boolean have_inner = 0;
        boolean have_outer = 0;

        // 1
        f_byte = 0xc0;
        if(udp_lite_profile->tmp_variables.nr_sn_bits > 5){
                f_byte |= 0x20;
        }

        f_byte = f_byte | (context -> c_mode) << 3;
        //If random bit is set we have the ip-id field outside this function
        rohc_debugf(1,"rnd_count_up: %d \n",udp_lite_profile->ip_flags.rnd_count);


        ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
        if(udp_lite_profile->tmp_variables.nr_of_ip_hdr == 1){
                if ((nr_ip_id_bits > 0 && (context->rnd == 0))||(udp_lite_profile->ip_flags.rnd_count < MAX_FO_COUNT && context->rnd == 0)){
                        f_byte = f_byte | 0x04;
                }
                if(udp_lite_changed_dynamic_one_hdr(changed_fields,&udp_lite_profile->ip_flags,ip,context->rnd,context->nbo,context) ||
                  udp_lite_changed_static_one_hdr(changed_fields,&udp_lite_profile->ip_flags,ip,context))
                {
                        have_inner = 1;
                        f_byte = f_byte | 0x02;
                }
        }
        else{
                if ((nr_ip_id_bits > 0 && (context->rnd2 == 0))||(udp_lite_profile->ip2_flags.rnd_count < MAX_FO_COUNT && context->rnd2 == 0)){
                        f_byte = f_byte | 0x04;

                }
                if(udp_lite_changed_dynamic_one_hdr(changed_fields,&udp_lite_profile->ip_flags,ip,context->rnd,context->nbo,context) ||
                  udp_lite_changed_static_one_hdr(changed_fields,&udp_lite_profile->ip_flags,ip,context))
                {
                        have_outer = 1;
                        f_byte = f_byte | 0x01;
                }
                if(udp_lite_changed_dynamic_one_hdr(changed_fields2,&udp_lite_profile->ip2_flags,ip2,context->rnd2,context->nbo2,context) ||
                 udp_lite_changed_static_one_hdr(changed_fields2,&udp_lite_profile->ip2_flags,ip2,context))
                {
                        have_inner = 1;
                        f_byte = f_byte | 0x02;
                }

        }
        dest[counter] = f_byte;
        counter++;


        if(udp_lite_profile->tmp_variables.nr_of_ip_hdr == 1){
                // 2
                if(have_inner){
                        counter = udp_lite_header_flags(context,changed_fields,&udp_lite_profile->ip_flags,counter,0,
                                                nr_ip_id_bits,ip,dest,context->rnd,context->nbo);
                }
                // 4
                if(udp_lite_profile->tmp_variables.nr_sn_bits > 5){
                        dest[counter] = (udp_lite_profile -> sn) & 0xff;
                        counter++;
                }
                // 5
                if(have_inner){
                        counter = udp_lite_header_fields(context,changed_fields,&udp_lite_profile->ip_flags,counter,0,
                                                nr_ip_id_bits,ip,dest,context->rnd);
                }
                //6
                if(((nr_ip_id_bits > 0) && (context->rnd == 0)) || ((udp_lite_profile->ip_flags.rnd_count-1 < MAX_FO_COUNT) && (context->rnd == 0))){

                        memcpy(&dest[counter], &ip->id, 2);
                        counter+=2;
                }
        }
        else{
                // 2
                if(have_inner){
                        counter = udp_lite_header_flags(context,changed_fields2,&udp_lite_profile->ip2_flags,counter,0,
                                                nr_ip_id_bits2,ip2,dest,context->rnd2,context->nbo2);
                }
                // 3
                if(have_outer){
                        counter = udp_lite_header_flags(context,changed_fields,&udp_lite_profile->ip_flags,counter,1,
                                                nr_ip_id_bits,ip,dest,context->rnd,context->nbo);

                }
                // 4
                if(udp_lite_profile->tmp_variables.nr_sn_bits > 5){
                        dest[counter] = (udp_lite_profile -> sn) & 0xff;
                        counter++;
                }
                // 5
                if(have_inner){
                        counter = udp_lite_header_fields(context,changed_fields2,&udp_lite_profile->ip2_flags,counter,0,
                                                nr_ip_id_bits2,ip2,dest,context->rnd2);
                }
                //6
                if(((nr_ip_id_bits2 > 0) && (context->rnd2 == 0)) || ((udp_lite_profile->ip2_flags.rnd_count-1 < MAX_FO_COUNT) && (context->rnd2 == 0))){

                        memcpy(&dest[counter], &ip2->id, 2);
                        counter+=2;
                }

                // 7
                if(have_outer){
                        counter = udp_lite_header_fields(context,changed_fields,&udp_lite_profile->ip_flags,counter,1,
                                                nr_ip_id_bits,ip,dest,context->rnd);
                }
        }
        //No ip extension until list compression
        return counter;
        //////////////////////////////////////////////////////////////////////////////////////////////////////
}

/*
Function coding header flags:

   For inner flags:

   +-----+-----+-----+-----+-----+-----+-----+-----+
1  |            Inner IP header flags        |     |  if ip = 1
   | TOS | TTL | DF  | PR  | IPX | NBO | RND | 0** |  0** reserved
   +-----+-----+-----+-----+-----+-----+-----+-----+


   or for outer flags:

   +-----+-----+-----+-----+-----+-----+-----+-----+
2  |            Outer IP header flags              |
   | TOS2| TTL2| DF2 | PR2 |IPX2 |NBO2 |RND2 |  I2 |  if ip2 = 1
   +-----+-----+-----+-----+-----+-----+-----+-----+
*/
int udp_lite_header_flags(struct sc_context *context,
        unsigned short changed_fields,
        struct sc_udp_lite_header *ip_hdr_profile,
        int counter,
        boolean is_outer,
        int nr_ip_id_bits,
        const struct iphdr *ip,
        unsigned char *dest,
        int context_rnd,
        int context_nbo)
{
        int ip_h_f = 0;

        // 1 and 2
        if(udp_lite_is_changed(changed_fields,MOD_TOS) || (ip_hdr_profile->tos_count < MAX_FO_COUNT)){
                ip_h_f |= 0x80;
        }
        if(udp_lite_is_changed(changed_fields,MOD_TTL) || (ip_hdr_profile->ttl_count < MAX_FO_COUNT)){
                ip_h_f |= 0x40;
        }
        if(udp_lite_is_changed(changed_fields,MOD_PROTOCOL) || (ip_hdr_profile->protocol_count < MAX_FO_COUNT)){
                ip_h_f |= 0x10;
        }

        rohc_debugf(1,"DF=%d\n", GET_DF(ip->frag_off));
        ip_hdr_profile->df_count++;
        ip_h_f |= GET_DF(ip->frag_off) << 5;

        ip_hdr_profile->nbo_count++;
        ip_h_f |= (context_nbo) << 2;

        ip_hdr_profile->rnd_count++;
        ip_h_f |= (context_rnd) << 1;

        // Only 2
        if(is_outer){
                if ((nr_ip_id_bits > 0 && (context_rnd == 0))||(ip_hdr_profile->rnd_count-1 < MAX_FO_COUNT && context_rnd == 0) ){
                        ip_h_f |= 0x01;

                }
        }


        // 1 and 2
        dest[counter] = ip_h_f;
        counter++;

        return counter;
}

/*
Function coding header fields:

   For inner fields and outer fields (The function is called two times
   one for inner and one for outer with different arguments):

   +-----+-----+-----+-----+-----+-----+-----+-----+
1  |         Type of Service/Traffic Class         |  if TOS = 1
    ..... ..... ..... ..... ..... ..... ..... .....
2  |         Time to Live/Hop Limit                |  if TTL = 1
    ..... ..... ..... ..... ..... ..... ..... .....
3  |         Protocol/Next Header                  |  if PR = 1
    ..... ..... ..... ..... ..... ..... ..... .....
4  /         IP extension headers                  /  variable, if IPX = 1
    ..... ..... ..... ..... ..... ..... ..... .....

   Ip id is coded here for both inner and outer fields though it doesn't look that way
   in the extension 3 picture in 5.7.5 and 5.11.4 of rfc 3095
   +-----+-----+-----+-----+-----+-----+-----+-----+
5  |                  IP-ID                        |  2 octets, if I = 1
   +-----+-----+-----+-----+-----+-----+-----+-----+

4 is not supported.

*/
int udp_lite_header_fields(struct sc_context *context,
        unsigned short changed_fields,
        struct sc_udp_lite_header *ip_hdr_profile,
        int counter,
        boolean is_outer,
        int nr_ip_id_bits,
        const struct iphdr *ip,
        unsigned char *dest,
        int context_rnd)
{
        // 1
        if(udp_lite_is_changed(changed_fields,MOD_TOS) || (ip_hdr_profile->tos_count < MAX_FO_COUNT)){
                ip_hdr_profile->tos_count++;
                dest[counter] = ip->tos;
                counter++;
        }

        // 2
        if(udp_lite_is_changed(changed_fields,MOD_TTL) || (ip_hdr_profile->ttl_count < MAX_FO_COUNT)){
                ip_hdr_profile->ttl_count++;
                dest[counter] = ip->ttl;
                counter++;
        }

        // 3
        if(udp_lite_is_changed(changed_fields,MOD_PROTOCOL) || (ip_hdr_profile->protocol_count < MAX_FO_COUNT) ){
                ip_hdr_profile->protocol_count++;
                dest[counter] = ip->protocol;
                counter++;
        }

        // 5
        if(is_outer){
                if(((nr_ip_id_bits > 0) && (context_rnd == 0)) || ((ip_hdr_profile->rnd_count-1 < MAX_FO_COUNT) && (context_rnd == 0))){

                        memcpy(&dest[counter], &ip->id, 2);
                        counter+=2;

                }
        }


        return counter;
}


/*Decide what extension shall be used in the uo2 packet*/
int udp_lite_decide_extension(struct sc_context *context)
{
        struct sc_udp_lite_context *udp_lite_profile = (struct sc_udp_lite_context *)context->profile_context;
        int nr_ip_id_bits = udp_lite_profile->tmp_variables.nr_ip_id_bits;
        int nr_ip_id_bits2 = udp_lite_profile->tmp_variables.nr_ip_id_bits2;
        int nr_sn_bits = udp_lite_profile->tmp_variables.nr_sn_bits;
        //if (ip_context->ttl_count < MAX_FO_COUNT || ip_context->tos_count < MAX_FO_COUNT || ip_context->df_count < MAX_FO_COUNT)
        //      return c_EXT3;

        if(udp_lite_profile->tmp_variables.nr_of_ip_hdr == 1){
                if(udp_lite_profile->tmp_variables.send_static > 0){
                        rohc_debugf(2,"Vi har Ã¤ndrat static\n");
                        return c_EXT3;

                }
                if(udp_lite_profile->tmp_variables.send_dynamic > 0){
                        return c_EXT3;
                }
                if(nr_sn_bits < 5 && (nr_ip_id_bits == 0 || context->rnd == 1)){
                        return c_NOEXT;
                }
                else if(nr_sn_bits <= 8 && nr_ip_id_bits <= 3){
                        return c_EXT0;
                }
                else if(nr_sn_bits <= 8 && nr_ip_id_bits <= 11){
                        return c_EXT1;
                }
                else{
                        return c_EXT3;
                }
        }
        else{
                if(udp_lite_profile->tmp_variables.send_static > 0 || udp_lite_profile->tmp_variables.send_dynamic > 0){
                        return c_EXT3;

                }
                if(nr_sn_bits < 5 && (nr_ip_id_bits == 0 || context->rnd == 1)
                        && (nr_ip_id_bits2 == 0 || context->rnd2 == 1)){
                        return c_NOEXT;
                }
                else if(nr_sn_bits <= 8 && nr_ip_id_bits <= 3
                        && (nr_ip_id_bits2 == 0 || context->rnd2 == 1)){
                        return c_EXT0;
                }
                else if(nr_sn_bits <= 8 && nr_ip_id_bits <= 11
                        && (nr_ip_id_bits2 == 0 || context->rnd2 == 1)){
                        return c_EXT1;
                }
                else if(nr_sn_bits <= 3 && nr_ip_id_bits <= 11
                        && nr_ip_id_bits2 <= 8){
                        return c_EXT2;
                }

                else{
                        return c_EXT3;
                }
        }

}
/*
Check if the static part of the context has been changed in any of the two first headers
*/
int udp_lite_changed_static_both_hdr(struct sc_context *context,
        const struct iphdr *ip,
        const struct iphdr *ip2)
{
        struct sc_udp_lite_context *udp_lite_profile = (struct sc_udp_lite_context *)context->profile_context;
        unsigned char changed_fields = udp_lite_profile->tmp_variables.changed_fields;
        unsigned char changed_fields2 = udp_lite_profile->tmp_variables.changed_fields2;
        int return_value = 0;


        return_value = udp_lite_changed_static_one_hdr(changed_fields,&udp_lite_profile->ip_flags,ip,context);
        if(udp_lite_profile->tmp_variables.nr_of_ip_hdr > 1){
                return_value += udp_lite_changed_static_one_hdr(changed_fields2,&udp_lite_profile->ip2_flags,ip2,context);
        }
        return return_value;
}

/*
Check if the static part of the context has been changed in one of header
*/
int udp_lite_changed_static_one_hdr(unsigned short udp_lite_changed_fields,
        struct sc_udp_lite_header *ip_header,
        const struct iphdr *ip,
        struct sc_context *context)
{
        int return_value = 0;
        struct sc_udp_lite_context *org_udp_lite_profile = (struct sc_udp_lite_context *)context->profile_context;

        if (udp_lite_is_changed(udp_lite_changed_fields,MOD_PROTOCOL) || (ip_header->protocol_count < MAX_FO_COUNT)){
                rohc_debugf(2,"protocol_count %d\n",ip_header->protocol_count);
                if (udp_lite_is_changed(udp_lite_changed_fields,MOD_PROTOCOL)) {
                        ip_header->protocol_count = 0;
                        org_udp_lite_profile->fo_count = 0;
                }


                return_value += 1;
        }
        return return_value;

}


/*
Check if the dynamic parts are changed, it returns the number of
dynamic bytes that are changed in both of the two first headers
*/
int udp_lite_changed_dynamic_both_hdr(struct sc_context *context,
        const struct iphdr *ip,
        const struct iphdr *ip2)
{
        int return_value = 0;
        struct sc_udp_lite_context *udp_lite_profile = (struct sc_udp_lite_context *)context->profile_context;
        int changed_fields = udp_lite_profile->tmp_variables.changed_fields;
        int changed_fields2 = udp_lite_profile->tmp_variables.changed_fields2;

        return_value = udp_lite_changed_dynamic_one_hdr(changed_fields,&udp_lite_profile->ip_flags,ip,context->rnd,context->nbo,context);
        //rohc_debugf(1,"return_value = %d \n",return_value);
        if(udp_lite_profile->tmp_variables.nr_of_ip_hdr > 1){

                return_value += udp_lite_changed_dynamic_one_hdr(changed_fields2,&udp_lite_profile->ip2_flags,ip2,context->rnd2,context->nbo2,context);
        }
        return return_value;
}

/*
Check if the dynamic part of the context has been changed in one of header
*/
int udp_lite_changed_dynamic_one_hdr(unsigned short udp_lite_changed_fields,
        struct sc_udp_lite_header *ip_hdr_profile,
        const struct iphdr *ip,
        int context_rnd,
        int context_nbo,
        struct sc_context *context)
{
        int return_value = 0;
        int small_flags = 0;
        struct sc_udp_lite_context *org_udp_lite_profile = (struct sc_udp_lite_context *)context->profile_context;

        if (udp_lite_is_changed(udp_lite_changed_fields,MOD_TOS) || (ip_hdr_profile->tos_count < MAX_FO_COUNT)){

                if (udp_lite_is_changed(udp_lite_changed_fields,MOD_TOS)){
                        ip_hdr_profile->tos_count = 0;
                        org_udp_lite_profile->fo_count = 0;
                }

                return_value += 1;
        }
        if(udp_lite_is_changed(udp_lite_changed_fields,MOD_TTL) || (ip_hdr_profile->ttl_count < MAX_FO_COUNT)){
                if (udp_lite_is_changed(udp_lite_changed_fields,MOD_TTL)){
                        ip_hdr_profile->ttl_count = 0;
                        org_udp_lite_profile->fo_count = 0;
                }

                return_value += 1;
        }
        /*if(udp_lite_is_changed(udp_lite_changed_fields,MOD_FRAG_OFF)){
                udp_lite_profile->df_count = 0;
                return_value += 1;
        }*/
        if((GET_DF(ip->frag_off) != GET_DF(ip_hdr_profile->old_ip.frag_off)) || (ip_hdr_profile->df_count < MAX_FO_COUNT)){
                if (GET_DF(ip->frag_off) != GET_DF(ip_hdr_profile->old_ip.frag_off)){
                        ip_hdr_profile->ttl_count = 0;
                        org_udp_lite_profile->fo_count = 0;
                }
                return_value += 1;
        }

        rohc_debugf(2,"rnd_count=%d nbo_count=%d\n", ip_hdr_profile->rnd_count, ip_hdr_profile->nbo_count);
        if(context_rnd != ip_hdr_profile->old_rnd || ip_hdr_profile->rnd_count < MAX_FO_COUNT){

                if (context_rnd != ip_hdr_profile->old_rnd) {
                        rohc_debugf(1,"RND changed, reseting count..\n");
                        ip_hdr_profile->rnd_count = 0;
                        org_udp_lite_profile->fo_count = 0;
                }

                small_flags += 1;

        }
        rohc_debugf(2,"nbo = %d, old_nbo = %d \n",context_nbo,ip_hdr_profile->old_nbo);
        if(context_nbo != ip_hdr_profile->old_nbo || ip_hdr_profile->nbo_count < MAX_FO_COUNT){
                if (context_nbo != ip_hdr_profile->old_nbo) {
                        rohc_debugf(1,"NBO changed, reseting count..\n");
                        ip_hdr_profile->nbo_count = 0;
                        org_udp_lite_profile->fo_count = 0;
                }

                small_flags += 1;
        }
        if(small_flags > 0) {
                return_value += 1;
        }
        //rohc_debugf(1,"return_value = %d \n",return_value);
        rohc_debugf(2,"udp_lite_changed_dynamic_both_hdr()=%d\n", return_value);
        return return_value;


}

int udp_lite_changed_udp_dynamic(struct sc_context *context,const struct udphdr *udp_lite){
        return 0;
}


/*
Check if a specified field is changed, it is checked against the bitfield
created in the function udp_lite_changed_fields
*/
boolean udp_lite_is_changed(unsigned short udp_lite_changed_fields,unsigned short check_field)
{
        if((udp_lite_changed_fields & check_field) > 0)
                return 1;
        else
                return 0;
}
/*
This function returns a bitpattern, the bits that are set is changed
*/
unsigned short udp_lite_changed_fields(struct sc_udp_lite_header *ip_hdr_profile,const struct iphdr *ip)
{
        unsigned short ret_value = 0;

        //Kan version och header length bitordersskiftningar ha nÃ¥gon betydelse fÃ¶r oss??
        if(ip_hdr_profile -> old_ip.tos != ip -> tos)
                ret_value |= MOD_TOS;
        if(ip_hdr_profile -> old_ip.tot_len != ip -> tot_len)
                ret_value |= MOD_TOT_LEN;
        if(ip_hdr_profile -> old_ip.id != ip -> id)
                ret_value |= MOD_ID;
        if(ip_hdr_profile -> old_ip.frag_off != ip -> frag_off)
                ret_value |= MOD_FRAG_OFF;
        if(ip_hdr_profile -> old_ip.ttl != ip -> ttl)
                ret_value |= MOD_TTL;
        if(ip_hdr_profile -> old_ip.protocol != ip -> protocol)
                ret_value |= MOD_PROTOCOL;
        if(ip_hdr_profile -> old_ip.check != ip -> check)
                ret_value |= MOD_CHECK;
        if(ip_hdr_profile -> old_ip.saddr != ip -> saddr)
                ret_value |= MOD_SADDR;
        if(ip_hdr_profile -> old_ip.daddr != ip -> daddr)
                ret_value |= MOD_DADDR;

        return ret_value;
}
/*
Function to determine if the ip-identification has nbo and if it is random
*/
void udp_lite_check_ip_identification(struct sc_udp_lite_header *ip_hdr_profile,
        const struct iphdr *ip,
        int *context_rnd,
        int *context_nbo)
{

        int id1, id2;
        int nbo = -1;

        id1 = ntohs(ip_hdr_profile->old_ip.id);
        id2 = ntohs(ip->id);


        rohc_debugf(2,"1) id1=0x%04x id2=0x%04x\n", id1, id2);

        if (id2-id1 < IPID_MAX_DELTA && id2-id1 > 0)
        {
                nbo = 1;
        } else if ((id1 + IPID_MAX_DELTA > 0xffff) && (id2 < ((id1+IPID_MAX_DELTA) & 0xffff))) {
                nbo = 1;
        }

        if (nbo == -1) {
                // change byte ordering and check nbo=0
                id1 = (id1>>8) | ((id1<<8) & 0xff00);
                id2 = (id2>>8) | ((id2<<8) & 0xff00);

                rohc_debugf(2,"2) id1=0x%04x id2=0x%04x\n", id1, id2);

                if (id2-id1 < IPID_MAX_DELTA && id2-id1 > 0)
                {
                        nbo = 0;
                } else if ((id1 + IPID_MAX_DELTA > 0xffff) && (id2 < ((id1+IPID_MAX_DELTA) & 0xffff))) {
                        nbo = 0;
                }
        }

        if (nbo == -1) {
                rohc_debugf(2,"check_ip_id(): RND detected!\n");
                *context_rnd = 1;

        } else {
                rohc_debugf(2,"check_ip_id(): NBO=%d\n", nbo);
                *context_rnd = 0;
                *context_nbo = nbo;
        }

}
/*Function that set up how what context the compressor and decompressor will
have from the start */
void udp_lite_initiate_coverage_context(struct sc_udp_lite_context *udp_lite_profile,
        const struct udphdr *udp_lite,
        unsigned char *dest,
        struct sc_context *context)

{
        int packet_length = udp_lite_profile->tmp_variables.udp_size; //from packet
        if(udp_lite_profile->ir_count == 1){
                udp_lite_profile->cfp = 0;
                udp_lite_profile->cfi = 1;
        }

        rohc_debugf(2,"packet_length=%d\n", packet_length);
        rohc_debugf(2,"udp_lite->len=%d\n", ntohs(udp_lite->len));

        udp_lite_profile->cfp = (ntohs(udp_lite->len) != packet_length) || udp_lite_profile->cfp;
        udp_lite_profile->cfi = (ntohs(udp_lite->len) == packet_length) && udp_lite_profile->cfi;
        rohc_debugf(2,"cfp-value=%d\n", udp_lite_profile->cfp);
        rohc_debugf(2,"cfi-value=%d\n", udp_lite_profile->cfi);
        udp_lite_profile->tmp_coverage = udp_lite->len;
        udp_lite_profile->old_udp_lite = *udp_lite;
}

/*
The function check if we have to send a ce-packet,
OBSERVE!!!! that its also updates the FK variable in the profile structure.
This have to be noticed.
*/
boolean udp_lite_send_ce_packet(struct sc_udp_lite_context *udp_lite_profile,
        const struct udphdr *udp_lite,
        unsigned char *dest,
        struct sc_context *context)
{
        boolean inferred;
        boolean same;
        int packet_length = udp_lite_profile->tmp_variables.udp_size;

        inferred = ntohs(udp_lite->len) == packet_length;
        same = ntohs(udp_lite_profile->old_udp_lite.len) == ntohs(udp_lite->len);
        if(udp_lite_profile->sent_ce_only_count > 0)
                same = ntohs(udp_lite_profile->tmp_coverage) == ntohs(udp_lite->len);

        udp_lite_profile->tmp_coverage = udp_lite->len;
        if(same){
                udp_lite_profile->coverage_equal_count++;
                if(inferred)
                        udp_lite_profile->coverage_inferred_count++;


        }
        else{
                udp_lite_profile->coverage_equal_count = 0;
                if(inferred){
                        udp_lite_profile->coverage_inferred_count++;
                }
                else{
                        udp_lite_profile->coverage_inferred_count = 0;
                }
        }

        if(udp_lite_profile->cfp == 0 && udp_lite_profile->cfi == 1){
                if(inferred == 0){
                        if(udp_lite_profile->sent_ce_only_count < MAX_IR_COUNT){
                                udp_lite_profile->sent_ce_only_count++;
                                udp_lite_profile->FK = 0x01;
                                return 1;
                        }
                        else {
                                if(udp_lite_profile->coverage_equal_count > MAX_LITE_COUNT){
                                        udp_lite_profile->cfp = 0;
                                        udp_lite_profile->cfi = 0;
                                        udp_lite_profile->sent_ce_only_count = 0;
                                        udp_lite_profile->sent_ce_off_count = 1;
                                        udp_lite_profile->FK = 0x03;
                                        udp_lite_profile->old_udp_lite = *udp_lite;
                                        return 1;
                                }
                                else{
                                        udp_lite_profile->cfp = 1;
                                        udp_lite_profile->cfi = 0;
                                        udp_lite_profile->sent_ce_only_count = 0;
                                        udp_lite_profile->sent_ce_on_count = 1;
                                        udp_lite_profile->FK = 0x02;
                                        udp_lite_profile->old_udp_lite = *udp_lite;
                                        return 1;
                                }

                        }
                }

        }
        else if(udp_lite_profile->cfp == 0 && udp_lite_profile->cfi == 0){
                if(inferred || (!inferred && !same)){
                        if(udp_lite_profile->sent_ce_only_count < MAX_IR_COUNT){
                                udp_lite_profile->sent_ce_only_count++;
                                udp_lite_profile->FK = 0x01;
                                return 1;
                        }
                        else{
                                if(udp_lite_profile->coverage_inferred_count > MAX_LITE_COUNT){
                                        udp_lite_profile->cfp = 0;
                                        udp_lite_profile->cfi = 1;
                                        udp_lite_profile->sent_ce_only_count = 0;
                                        udp_lite_profile->sent_ce_off_count = 1;
                                        udp_lite_profile->FK = 0x03;
                                        udp_lite_profile->old_udp_lite = *udp_lite;
                                        return 1;
                                }
                                else{
                                        udp_lite_profile->cfp = 1;
                                        udp_lite_profile->cfi = 0;
                                        udp_lite_profile->sent_ce_only_count = 0;
                                        udp_lite_profile->sent_ce_on_count = 1;
                                        udp_lite_profile->FK = 0x02;
                                        udp_lite_profile->old_udp_lite = *udp_lite;
                                        return 1;
                                }
                        }
                }
        }

        else if(udp_lite_profile->cfp == 1){
                if(inferred || (inferred && same)){
                        if(udp_lite_profile->coverage_equal_count > MAX_LITE_COUNT){
                                udp_lite_profile->sent_ce_off_count = 1;
                                udp_lite_profile->sent_ce_only_count = 0;
                                udp_lite_profile->cfp = 0;
                                udp_lite_profile->cfi = 0;
                                udp_lite_profile->FK = 0x03;
                                udp_lite_profile->old_udp_lite = *udp_lite;
                                return 1;
                        }
                        else if(udp_lite_profile->coverage_inferred_count > MAX_LITE_COUNT){
                                udp_lite_profile->sent_ce_off_count = 1;
                                udp_lite_profile->sent_ce_only_count = 0;
                                udp_lite_profile->cfp = 0;
                                udp_lite_profile->cfi = 1;
                                udp_lite_profile->FK = 0x03;
                                udp_lite_profile->old_udp_lite = *udp_lite;
                                return 1;
                        }
                }
        }

        if(udp_lite_profile->sent_ce_off_count < MAX_IR_COUNT){
                udp_lite_profile->sent_ce_off_count++;
                udp_lite_profile->sent_ce_only_count = 0;
                udp_lite_profile->FK = 0x03;
                udp_lite_profile->old_udp_lite = *udp_lite;
                return 1;
        }else if(udp_lite_profile->sent_ce_on_count < MAX_IR_COUNT){
                udp_lite_profile->sent_ce_on_count++;
                udp_lite_profile->sent_ce_only_count = 0;
                udp_lite_profile->FK = 0x02;
                udp_lite_profile->old_udp_lite = *udp_lite;
                return 1;
        }

        udp_lite_profile->sent_ce_only_count = 0;
        return 0;

}

/*
A struct thate every function must have the first fieldtell what protocol this profile has.
The second row is the profile id-number, Then two strings that is for printing version and
description. And finally pointers to functions that have to exist in every profile.
*/
struct sc_profile c_udp_lite_profile = {
        UDP_LITE_PRNR,
        8, // Profile ID
        "1.0b", // Version
        "UDP-Lite / Compressor", // Description
        c_udp_lite_create,
        c_udp_lite_destroy,
        c_udp_lite_check_context,
        c_udp_lite_encode,
        c_udp_lite_feedback
};

Revision:	1.1
Committed:	Sun Feb 8 06:02:44 2004 UTC (20 years, 4 months ago) by pcg
Content type:	text/plain
Branch:	MAIN
CVS Tags:	ROHC-IMPORT-2004-02-08
Log Message:	* empty log message *