- redefined logger levels

[strongswan.git] / Source / charon / generator.c

/**
 * @file generator.c
 *
 * @brief Generic generator class used to generate IKEv2-header and payloads.
 *
 */

/*
 * Copyright (C) 2005 Jan Hutter, Martin Willi
 * Hochschule fuer Technik Rapperswil
 *
 * 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.  See <http://www.fsf.org/copyleft/gpl.txt>.
 *
 * 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.
 */

#include <stdlib.h>
#include <string.h>
#include <arpa/inet.h>
#include <stdio.h>


#include "generator.h"

#include "types.h"
#include "globals.h"
#include "utils/allocator.h"
#include "utils/linked_list.h"
#include "utils/logger_manager.h"
#include "payloads/payload.h"
#include "payloads/proposal_substructure.h"
#include "payloads/transform_substructure.h"
#include "payloads/sa_payload.h"
#include "payloads/ke_payload.h"
#include "payloads/notify_payload.h"
#include "payloads/nonce_payload.h"

/**
 * Private part of a generator_t object
 */
typedef struct private_generator_s private_generator_t;

struct private_generator_s {
        /**
         * Public part of a generator_t object
         */
         generator_t public;

        /* private functions and fields */


        /**
         * Generates a U_INT-Field type and writes it to buffer.
         *
         * @param this                                  private_generator_t object
         * @param int_type                              type of U_INT field (U_INT_4, U_INT_8, etc.)
         *                                                              ATTRIBUTE_TYPE is also generated in this function
         * @param offset                                offset of value in data struct
         * @param generator_contexts            generator_contexts_t object where the context is written or read from
         * @return                                              - SUCCESS if succeeded
         *                                                              - OUT_OF_RES if out of ressources
         */
        status_t (*generate_u_int_type) (private_generator_t *this,encoding_type_t int_type,u_int32_t offset);

        /**
         * Get size of current buffer in bytes.
         *
         * @param this                                  private_generator_t object
         * @return                                              Size of buffer in bytes
         */
        size_t (*get_current_buffer_size) (private_generator_t *this);
        
        /**
         * Get free space of current buffer in bytes.
         *
         * @param this                                  private_generator_t object
         * @return                                              space in buffer in bytes
         */
        size_t (*get_current_buffer_space) (private_generator_t *this);

        /**
         * Get length of data in buffer (in bytes).
         *
         * @param this                                  private_generator_t object
         * @return                                              length of data in bytes
         */     
        size_t (*get_current_data_length) (private_generator_t *this);

        /**
         * Get current offset in buffer (in bytes).
         *
         * @param this                                  private_generator_t object
         * @return                                              offset in bytes
         */     
        u_int32_t (*get_current_buffer_offset) (private_generator_t *this);
        
        /**
         * Generates a RESERVED BIT field or a RESERVED BYTE field and writes 
         * it to the buffer.
         *
         * @param this                                  private_generator_t object
         * @param generator_contexts            generator_contexts_t object where the context is written or read from
         * @param bits                                  number of bits to generate
         * @return                                              - SUCCESS if succeeded
         *                                                              - OUT_OF_RES if out of ressources
         *                                                              - FAILED if bit count not supported
         */
        status_t (*generate_reserved_field) (private_generator_t *this,int bits);
        
        /**
         * Generates a FLAG field
         *
         * @param this                                  private_generator_t object
         * @param generator_contexts            generator_contexts_t object where the context is written or read from
         * @param offset                                        offset of flag value in data struct
         * @return                                              - SUCCESS if succeeded
         *                                                              - OUT_OF_RES if out of ressources
         */
        status_t (*generate_flag) (private_generator_t *this,u_int32_t offset);
        
        /**
         * Writes the current buffer content into a chunk_t
         * 
         * Memory of specific chunk_t gets allocated.
         *
         * @param this                          calling private_generator_t object
         * @param data                          pointer of chunk_t to write to
         * @return 
         *                                                      - SUCCESSFUL if succeeded
         *                                                      - OUT_OF_RES otherwise
         */
        status_t (*write_chunk) (private_generator_t *this,chunk_t *data);
        
        /**
         * Generates a bytestream from a chunk_t
         *
         * @param this                                  private_generator_t object
         * @param offset                                        offset of chunk_t value in data struct
         * @return                                              - SUCCESS if succeeded
         *                                                              - OUT_OF_RES if out of ressources
         */
        status_t (*generate_from_chunk) (private_generator_t *this,u_int32_t offset);   

        /**
         * Makes sure enough space is available in buffer to store amount of bits.
     *
         * If buffer is to small to hold the specific amount of bits it 
         * is increased using reallocation function of allocator.
         *
         * @param this                          calling private_generator_t object
         * @param bits                          number of bits to make available in buffer
         * @return 
         *                                                      - SUCCESSFUL if succeeded
         *                                                      - OUT_OF_RES otherwise
         */
        status_t (*make_space_available) (private_generator_t *this,size_t bits);

        /**
         * Writes a specific amount of byte into the buffer.
         * 
         * If buffer is to small to hold the specific amount of bytes it 
         * is increased.
         *
         * @param this                          calling private_generator_t object
         * @param bytes                                 pointer to bytes to write
         * @param number_of_bytes       number of bytes to write into buffer
         * @return 
         *                                                      - SUCCESSFUL if succeeded
         *                                                      - OUT_OF_RES otherwise
         */
        status_t (*write_bytes_to_buffer) (private_generator_t *this,void * bytes,size_t number_of_bytes);
        
        
        /**
         * Writes a specific amount of byte into the buffer at a specific offset.
         * 
         * @warning buffer size is not check to hold the data if offset is to large.
         *
         * @param this                          calling private_generator_t object
         * @param bytes                                 pointer to bytes to write
         * @param number_of_bytes       number of bytes to write into buffer
         * @param offset                                offset to write the data into
         * @return 
         *                                                      - SUCCESSFUL if succeeded
         *                                                      - OUT_OF_RES otherwise
         */
        status_t (*write_bytes_to_buffer_at_offset) (private_generator_t *this,void * bytes,size_t number_of_bytes,u_int32_t offset);
        
        /**
         * Buffer used to generate the data into.
         */
        u_int8_t *buffer;

        /**
         * Current write position in buffer (one byte aligned).
         */
        u_int8_t *out_position;

        /**
         * Position of last byte in buffer.
         */
        u_int8_t *roof_position;

        /**
         * Current bit writing to in current byte (between 0 and 7).
         */
        size_t current_bit;

        /**
         * Associated data struct to read informations from.
         */
        void * data_struct;
        
        /*
         * Last payload length position offset in the buffer
         */
        u_int32_t last_payload_length_position_offset;
        
        /**
         * Offset of the header length field in the buffer
         */
        u_int32_t header_length_position_offset;
        
        /**
         * Last SPI size
         */
        u_int8_t last_spi_size;
        
        /*
         * Attribute format of the last generated transform attribute
         * 
         * Used to check if a variable value field is used or not for 
         * the transform attribute value.
         */
        bool attribute_format;
        
        /*
         * Depending on the value of attribute_format this field is used
         * to hold the length of the transform attribute in bytes
         */
        u_int16_t attribute_length;
        
        /**
         * Associated Logger
         */
        logger_t *logger;
};

/**
 * Implements private_generator_t's get_current_buffer_size function.
 * See #private_generator_s.get_current_buffer_size.
 */
static size_t get_current_buffer_size (private_generator_t *this)
{
        return ((this->roof_position) - (this->buffer));
}

/**
 * Implements private_generator_t's get_current_buffer_space function.
 * See #private_generator_s.get_current_buffer_space.
 */
static size_t get_current_buffer_space (private_generator_t *this)
{
        /* we know, one byte more */
        size_t space = (this->roof_position) - (this->out_position);
        return (space);
}

/**
 * Implements private_generator_t's get_current_buffer_space function.
 * See #private_generator_s.get_current_buffer_space.
 */
static size_t get_current_data_length (private_generator_t *this)
{
        return (this->out_position - this->buffer);
}

/**
 * Implements private_generator_t's get_current_buffer_offset function.
 * See #private_generator_s.get_current_buffer_offset.
 */
static u_int32_t get_current_buffer_offset (private_generator_t *this)
{
        return (this->out_position - this->buffer);
}


/**
 * Implements private_generator_t's generate_u_int_type function.
 * See #private_generator_s.generate_u_int_type.
 */
static status_t generate_u_int_type (private_generator_t *this,encoding_type_t int_type,u_int32_t offset)
{
        size_t number_of_bits = 0;
        status_t status;

        /* find out number of bits of each U_INT type to check for enough space 
           in buffer */
        switch (int_type)
        {
                        case U_INT_4:
                                number_of_bits = 4;
                                break;
                        case U_INT_8:
                                number_of_bits = 8;
                                break;
                        case U_INT_16:
                                number_of_bits = 16;
                                break;
                        case U_INT_32:
                                number_of_bits = 32;
                                break;
                        case U_INT_64:
                                number_of_bits = 64;
                                break;
                        case ATTRIBUTE_TYPE:
                                number_of_bits = 15;
                                break;
                        default:
                        return FAILED;
        }
        /* U_INT Types of multiple then 8 bits must be aligned */
        if (((number_of_bits % 8) == 0) && (this->current_bit != 0))
        {
                this->logger->log(this->logger,CONTROL|MORE,"U_INT Type %s is not 8 Bit aligned",       mapping_find(encoding_type_m,int_type));
                /* current bit has to be zero for values multiple of 8 bits */
                return FAILED;
        }
        
        /* make sure enough space is available in buffer */
        status = this->make_space_available(this,number_of_bits);
        if (status != SUCCESS)
        {
                return status;
        }
        /* now handle each u int type differently */
        switch (int_type)
        {
                        case U_INT_4:
                        {
                                if (this->current_bit == 0)
                                {
                                        /* highval of current byte in buffer has to be set to the new value*/
                                        u_int8_t high_val = *((u_int8_t *)(this->data_struct + offset)) << 4;
                                        /* lowval in buffer is not changed */
                                        u_int8_t low_val = *(this->out_position) & 0x0F;
                                        /* highval is set, low_val is not changed */
                                        *(this->out_position) = high_val | low_val;
                                        /* write position is not changed, just bit position is moved */
                                        this->current_bit = 4;
                                }
                                else if (this->current_bit == 4)
                                {
                                        /* highval in buffer is not changed */
                                        u_int high_val = *(this->out_position) & 0xF0;
                                        /* lowval of current byte in buffer has to be set to the new value*/
                                        u_int low_val = *((u_int8_t *)(this->data_struct + offset)) & 0x0F;
                                        *(this->out_position) = high_val | low_val;
                                        this->out_position++;
                                        this->current_bit = 0;

                                }
                                else
                                {
                                        this->logger->log(this->logger,CONTROL|MORE,"U_INT_4 Type is not 4 Bit aligned");
                                        /* 4 Bit integers must have a 4 bit alignment */
                                        return FAILED;
                                };
                                break;
                        }
                        case U_INT_8:
                        {
                                /* 8 bit values are written as they are */
                                *this->out_position = *((u_int8_t *)(this->data_struct + offset));
                                this->out_position++;
                                break;

                        }
                        case ATTRIBUTE_TYPE:
                        {
                                /* attribute type must not change first bit uf current byte ! */
                                if (this->current_bit != 1)
                                {
                                        this->logger->log(this->logger,CONTROL|MORE,"ATTRIBUTE FORMAT flag is not set");
                                        /* first bit has to be set! */
                                        return FAILED;
                                }
                                /* get value of attribute format flag */
                                u_int8_t attribute_format_flag = *(this->out_position) & 0x80;
                                /* get attribute type value as 16 bit integer*/
                                u_int16_t int16_val = htons(*((u_int16_t*)(this->data_struct + offset)));
                                /* last bit must be unset */
                                int16_val = int16_val & 0xFF7F;
                                
                                int16_val = int16_val | attribute_format_flag;
                                /* write bytes to buffer (set bit is overwritten)*/                             
                                this->write_bytes_to_buffer(this,&int16_val,sizeof(u_int16_t));
                                this->current_bit = 0;
                                break;
                                
                        }
                        case U_INT_16:
                        {
                                u_int16_t int16_val = htons(*((u_int16_t*)(this->data_struct + offset)));
                                this->write_bytes_to_buffer(this,&int16_val,sizeof(u_int16_t));
                                break;
                        }
                        case U_INT_32:
                        {
                                u_int32_t int32_val = htonl(*((u_int32_t*)(this->data_struct + offset)));
                                this->write_bytes_to_buffer(this,&int32_val,sizeof(u_int32_t));
                                break;
                        }
                        case U_INT_64:
                        {
                                /* 64 bit integers are written as two 32 bit integers */
                                u_int32_t int32_val_low = htonl(*((u_int32_t*)(this->data_struct + offset)));
                                u_int32_t int32_val_high = htonl(*((u_int32_t*)(this->data_struct + offset) + 1));
                                /* TODO add support for big endian machines */
                                this->write_bytes_to_buffer(this,&int32_val_high,sizeof(u_int32_t));
                                this->write_bytes_to_buffer(this,&int32_val_low,sizeof(u_int32_t));
                                break;
                        }

                        default:
                        this->logger->log(this->logger,CONTROL|MORE,"U_INT Type %s is not supported",   mapping_find(encoding_type_m,int_type));
                        return FAILED;
        }
        return SUCCESS;
}

/**
 * Implements private_generator_t's generate_reserved_field function.
 * See #private_generator_s.generate_reserved_field.
 */
static status_t generate_reserved_field (private_generator_t *this,int bits)
{
        status_t status;
        
        /* only one bit or 8 bit fields are supported */
        if ((bits != 1) && (bits != 8))
        {
                this->logger->log(this->logger,CONTROL|MORE,"Reserved field of %d bits cannot be generated",bits);
                return FAILED;
        }
        /* make sure enough space is available in buffer */
        status = this->make_space_available(this,bits);
        if (status != SUCCESS)
        {
                return status;
        }
        
        if (bits == 1)
        {       
                /* one bit processing */
                u_int8_t reserved_bit = ~(1 << (7 - this->current_bit));
                *(this->out_position) = *(this->out_position) & reserved_bit;
                if (this->current_bit == 0)
                {
                        /* memory must be zero */
                        *(this->out_position) = 0x00;
                }


                this->current_bit++;
                if (this->current_bit >= 8)
                {
                        this->current_bit = this->current_bit % 8;
                        this->out_position++;
                }
        }
        else
        {
                /* one byte processing*/
                if (this->current_bit > 0)
                {
                        this->logger->log(this->logger,CONTROL|MORE,"Reserved field cannot be written cause allignement of current bit is %d",this->current_bit);
                        return FAILED;
                }
                *(this->out_position) = 0x00;
                this->out_position++;
        }

        return SUCCESS;
                
                
}

/**
 * Implements private_generator_t's generate_flag function.
 * See #private_generator_s.generate_flag.
 */
static status_t generate_flag (private_generator_t *this,u_int32_t offset)
{
        status_t status;
        /* value of current flag */
        u_int8_t flag_value;
        /* position of flag in current byte */
        u_int8_t flag;
        
        /* if the value in the data_struct is TRUE, flag_value is set to 1, 0 otherwise */
        flag_value = (*((bool *) (this->data_struct + offset))) ? 1 : 0;
        /* get flag position */
        flag = (flag_value << (7 - this->current_bit));
        
        /* make sure one bit is available in buffer */
        status = this->make_space_available(this,1);
        if (status != SUCCESS)
        {
                return status;
        }
        if (this->current_bit == 0)
        {
                /* memory must be zero */
                *(this->out_position) = 0x00;
        }

        *(this->out_position) = *(this->out_position) | flag;

        this->current_bit++;
        if (this->current_bit >= 8)
        {
                this->current_bit = this->current_bit % 8;
                this->out_position++;
        }
        return SUCCESS;
}

/**
 * Implements private_generator_t's generate_from_chunk function.
 * See #private_generator_s.generate_from_chunk.
 */
static status_t generate_from_chunk (private_generator_t *this,u_int32_t offset)
{
        if (this->current_bit != 0)
        {
                this->logger->log(this->logger,CONTROL|MORE,"Chunks can only be taken if bits are alligned in buffer");
                return FAILED;
        }
        /* position in buffer */
        chunk_t *attribute_value = (chunk_t *)(this->data_struct + offset);
        
        /* use write_bytes_to_buffer function to do the job */
        return this->write_bytes_to_buffer(this,attribute_value->ptr,attribute_value->len);
        
}

/**
 * Implements private_generator_t's generator_context_make_space_available function.
 * See #private_generator_s.generator_context_make_space_available.
 */
static status_t make_space_available (private_generator_t *this, size_t bits)
{
        while (((this->get_current_buffer_space(this) * 8) - this->current_bit) < bits)
        {
                /* must increase buffer */
                u_int8_t *new_buffer;
                size_t old_buffer_size = this->get_current_buffer_size(this);
                size_t new_buffer_size = old_buffer_size + GENERATOR_DATA_BUFFER_INCREASE_VALUE;
                size_t out_position_offset = ((this->out_position) - (this->buffer));

                this->logger->log(this->logger,CONTROL|MORE,"Gen-Buffer is increased from %d to %d byte",old_buffer_size,new_buffer_size);
                
                /* Reallocate space for new buffer */
                new_buffer = allocator_realloc(this->buffer,new_buffer_size);
                if (new_buffer == NULL)
                {
                        this->logger->log(this->logger,CONTROL|MORE,"Fatal error: Reallocation of buffer failed!!!");
                        return OUT_OF_RES;
                }

                this->buffer = new_buffer;

                this->out_position = (this->buffer + out_position_offset);
                this->roof_position = (this->buffer + new_buffer_size);
        }
        return SUCCESS;
}

/**
 * Implements private_generator_t's write_bytes_to_buffer function.
 * See #private_generator_s.write_bytes_to_buffer.
 */
static status_t write_bytes_to_buffer (private_generator_t *this,void * bytes,size_t number_of_bytes)
{
        int i;
        status_t status;
        u_int8_t *read_position = (u_int8_t *) bytes;
        
        status = this->make_space_available(this,number_of_bytes * 8);
        if (status != SUCCESS)
        {
                return status;
        }

        for (i = 0; i < number_of_bytes; i++)
        {
                *(this->out_position) = *(read_position);
                read_position++;
                this->out_position++;
        }
        return status;
}

/**
 * Implements private_generator_t's write_bytes_to_buffer_at_offset function.
 * See #private_generator_s.write_bytes_to_buffer_at_offset.
 */
static status_t write_bytes_to_buffer_at_offset (private_generator_t *this,void * bytes,size_t number_of_bytes,u_int32_t offset)
{
        int i;
        status_t status;
        u_int8_t *read_position = (u_int8_t *) bytes;
        u_int8_t *write_position;
        u_int32_t free_space_after_offset = (this->get_current_buffer_size(this) - offset);

        /* check first if enough space for new data is available */     
        if (number_of_bytes > free_space_after_offset)
        {
                status = this->make_space_available(this,(number_of_bytes - free_space_after_offset) * 8);
        }
        
        write_position = this->buffer + offset;
        for (i = 0; i < number_of_bytes; i++)
        {
                *(write_position) = *(read_position);
                read_position++;
                write_position++;
        }
        return SUCCESS;
}

/**
 * Implements generator_t's write_chunk function.
 * See #generator_s.write_chunk.
 */
static status_t write_to_chunk (private_generator_t *this,chunk_t *data)
{
        size_t data_length = this->get_current_data_length(this);
        u_int32_t header_length_field = data_length;
        
        /* write length into header length field */
        if (this->header_length_position_offset > 0)
        {
                u_int32_t int32_val = htonl(header_length_field);
                this->write_bytes_to_buffer_at_offset(this,&int32_val,sizeof(u_int32_t),this->header_length_position_offset);
        }

        if (this->current_bit > 0)
        data_length++;
        data->ptr = allocator_alloc(data_length);
        if (data->ptr == NULL)
        {
                data->len = 0;
                this->logger->log(this->logger,CONTROL|MORE,"OUT OF Ressources to wrote data to chunk!!!!!");
                return OUT_OF_RES;
        }
        memcpy(data->ptr,this->buffer,data_length);
        data->len = data_length;
        return SUCCESS;
}

/**
 * Implements generator_t's generate_payload function.
 * See #generator_s.generate_payload.
 */
static status_t generate_payload (private_generator_t *this,payload_t *payload)
{
        int i;
        status_t status;
        this->data_struct = payload;
        size_t rule_count;
        encoding_rule_t *rules;
        payload_type_t payload_type;
        
        /* get payload type */
        payload_type = payload->get_type(payload);
        /* spi size has to get reseted */
        this->last_spi_size = 0;
        
        this->logger->log(this->logger,CONTROL,"Start generating payload of type %s",mapping_find(payload_type_m,payload_type));
        
        /* each payload has its own encoding rules */
        payload->get_encoding_rules(payload,&rules,&rule_count);

        for (i = 0; i < rule_count;i++)
        {
                status = SUCCESS;
                switch (rules[i].type)
                {
                        /* all u int values and ATTRIBUTE_TYPE are generated in generate_u_int_type */
                        case U_INT_4:
                        case U_INT_8:
                        case U_INT_16:
                        case U_INT_32:
                        case U_INT_64:
                        case ATTRIBUTE_TYPE:
                        {
                                status = this->generate_u_int_type(this,rules[i].type,rules[i].offset);
                                break;
                        }
                        case RESERVED_BIT:
                        {
                                status = this->generate_reserved_field(this,1);
                                break;
                        }
                        case RESERVED_BYTE:
                        {
                                status = this->generate_reserved_field(this,8);
                                break;
                        } 
                        case FLAG:
                        {
                                status = this->generate_flag(this,rules[i].offset);
                                break;
                        }
                        case PAYLOAD_LENGTH:
                        {
                                /* position of payload lenght field is temporary stored */
                                this->last_payload_length_position_offset = this->get_current_buffer_offset(this);
                                /* payload length is generated like an U_INT_16 */
                                status = this->generate_u_int_type(this,U_INT_16,rules[i].offset);
                                break;
                        }
                        case HEADER_LENGTH:
                        {
                                /* position of header length field is temporary stored */                       
                                this->header_length_position_offset = this->get_current_buffer_offset(this);    
                                /* header length is generated like an U_INT_32 */
                                status = this->generate_u_int_type(this,U_INT_32,rules[i].offset);
                                break;
                        }
                        case SPI_SIZE:
                                /* spi size is handled as 8 bit unsigned integer */
                                status = this->generate_u_int_type(this,U_INT_8,rules[i].offset);
                                /* last spi size is temporary stored */
                                this->last_spi_size = *((u_int8_t *)(this->data_struct + rules[i].offset));
                                break;
                        case SPI:
                        {
                                /* the SPI value is generated from chunk */
                                status = this->generate_from_chunk(this,rules[i].offset);
                                break;
                        }
                        case KEY_EXCHANGE_DATA:
                        {
                                /* the Key Exchange Data value is generated from chunk */
                                status = this->generate_from_chunk(this,rules[i].offset);
                                if (status != SUCCESS)
                                {
                                        this->logger->log(this->logger,CONTROL|MORE,"Could no write key exchange data from chunk");     
                                        return status;
                                }
                                
                                u_int32_t payload_length_position_offset = this->last_payload_length_position_offset;
                                /* Length of KE_PAYLOAD is calculated */
                                u_int16_t length_of_ke_payload = KE_PAYLOAD_HEADER_LENGTH + ((chunk_t *)(this->data_struct + rules[i].offset))->len;

                                u_int16_t int16_val = htons(length_of_ke_payload);                      
                                status = this->write_bytes_to_buffer_at_offset(this,&int16_val,sizeof(u_int16_t),payload_length_position_offset);
                                if (status != SUCCESS)
                                {
                                        this->logger->log(this->logger,CONTROL|MORE,"Could no write payload length into buffer");                                       
                                        return status;
                                }
                                break;
                        }               
                        case NOTIFICATION_DATA:
                        {
                                /* the Notification Data value is generated from chunk */
                                status = this->generate_from_chunk(this,rules[i].offset);
                                if (status != SUCCESS)
                                {
                                        this->logger->log(this->logger,CONTROL|MORE,"Could no write notification data from chunk");     
                                        return status;
                                }
                                
                                u_int32_t payload_length_position_offset = this->last_payload_length_position_offset;
                                /* Length of Notification PAYLOAD is calculated */
                                u_int16_t length_of_notify_payload = NOTIFY_PAYLOAD_HEADER_LENGTH + ((chunk_t *)(this->data_struct + rules[i].offset))->len;
                                length_of_notify_payload += this->last_spi_size;
                                u_int16_t int16_val = htons(length_of_notify_payload);

                                status = this->write_bytes_to_buffer_at_offset(this,&int16_val,sizeof(u_int16_t),payload_length_position_offset);
                                if (status != SUCCESS)
                                {
                                        this->logger->log(this->logger,CONTROL|MORE,"Could no write payload length into buffer");                                       
                                        return status;
                                }
                                break;
                        }               
                        case NONCE_DATA:
                        {
                                /* the Nonce Data value is generated from chunk */
                                status = this->generate_from_chunk(this,rules[i].offset);
                                if (status != SUCCESS)
                                {
                                        this->logger->log(this->logger,CONTROL|MORE,"Could no write nonce data from chunk");    
                                        return status;
                                }
                                
                                u_int32_t payload_length_position_offset = this->last_payload_length_position_offset;
                                /* Length of nonce PAYLOAD is calculated */
                                u_int16_t length_of_nonce_payload = NONCE_PAYLOAD_HEADER_LENGTH + ((chunk_t *)(this->data_struct + rules[i].offset))->len;
                                u_int16_t int16_val = htons(length_of_nonce_payload);

                                status = this->write_bytes_to_buffer_at_offset(this,&int16_val,sizeof(u_int16_t),payload_length_position_offset);
                                if (status != SUCCESS)
                                {
                                        this->logger->log(this->logger,CONTROL|MORE,"Could no write payload length into buffer");                                       
                                        return status;
                                }
                                break;
                        }
                        case PROPOSALS:
                        {
                                /* before iterative generate the transforms, store the current payload length position */
                                u_int32_t payload_length_position_offset = this->last_payload_length_position_offset;
                                /* Length of SA_PAYLOAD is calculated */
                                u_int16_t length_of_sa_payload = SA_PAYLOAD_HEADER_LENGTH;
                                u_int16_t int16_val;
                                /* proposals are stored in a linked list and so accessed */
                                linked_list_t *proposals = *((linked_list_t **)(this->data_struct + rules[i].offset));

                                this->logger->log(this->logger,CONTROL|MORE,"Generate Proposals");

                                linked_list_iterator_t *iterator;
                                /* create forward iterator */
                                status = proposals->create_iterator(proposals,&iterator,TRUE);
                                if (status != SUCCESS)
                                {
                                        this->logger->log(this->logger,CONTROL|MORE,"Could not iterator of proposals");
                                        return status;
                                }
                                /* every proposal is processed (iterative call )*/
                                while (iterator->has_next(iterator))
                                {
                                        payload_t *current_proposal;
                                        u_int32_t before_generate_position_offset;
                                        u_int32_t after_generate_position_offset;
                                        
                                        status = iterator->current(iterator,(void **)&current_proposal);
                                        if (status != SUCCESS)
                                        {
                                                iterator->destroy(iterator);    
                                                return status;
                                        }
                                        before_generate_position_offset = this->get_current_buffer_offset(this);
                                        status = this->public.generate_payload(&(this->public),current_proposal);
                                        after_generate_position_offset = this->get_current_buffer_offset(this);
                                        if (status != SUCCESS)
                                        {
                                                iterator->destroy(iterator);    
                                                return status;
                                        }
                                        
                                        /* increase size of transform */
                                        length_of_sa_payload += (after_generate_position_offset - before_generate_position_offset);
                                }
                                iterator->destroy(iterator);
                                this->logger->log(this->logger,CONTROL|MORE,"Length of Payload is %d, offset is %d",length_of_sa_payload,payload_length_position_offset);
                                
                                int16_val = htons(length_of_sa_payload);
                                status = this->write_bytes_to_buffer_at_offset(this,&int16_val,sizeof(u_int16_t),payload_length_position_offset);
                                if (status != SUCCESS)
                                {
                                        this->logger->log(this->logger,CONTROL|MORE,"Could no write payload length into buffer");                                       
                                        return status;
                                }
                                break;
                        }       

                        case TRANSFORMS:
                        {       
                                /* before iterative generate the transforms, store the current length position */
                                u_int32_t payload_length_position_offset = this->last_payload_length_position_offset;
                                u_int16_t length_of_proposal = PROPOSAL_SUBSTRUCTURE_HEADER_LENGTH + this->last_spi_size;
                                u_int16_t int16_val;
                                linked_list_t *transforms = *((linked_list_t **)(this->data_struct + rules[i].offset));
                                linked_list_iterator_t *iterator;
                                
                                this->logger->log(this->logger,CONTROL|MORE,"Generate Transforms");
                                
                                /* create forward iterator */
                                status = transforms->create_iterator(transforms,&iterator,TRUE);
                                if (status != SUCCESS)
                                {
                                        return status;
                                }
                                while (iterator->has_next(iterator))
                                {
                                        payload_t *current_transform;
                                        u_int32_t before_generate_position_offset;
                                        u_int32_t after_generate_position_offset;
                                        
                                        status = iterator->current(iterator,(void **)&current_transform);
                                        if (status != SUCCESS)
                                        {
                                                iterator->destroy(iterator);    
                                                return status;
                                        }
                                        
                                        before_generate_position_offset = this->get_current_buffer_offset(this);
                                        status = this->public.generate_payload(&(this->public),current_transform);
                                        after_generate_position_offset = this->get_current_buffer_offset(this);
                                        if (status != SUCCESS)
                                        {
                                                iterator->destroy(iterator);    
                                                return status;
                                        }
                                        
                                        /* increase size of transform */
                                        length_of_proposal += (after_generate_position_offset - before_generate_position_offset);
                                }
                                
                                iterator->destroy(iterator);
                                
                                this->logger->log(this->logger,CONTROL|MORE,"Length of Transform is %d, offset is %d",length_of_proposal,payload_length_position_offset);
                                
                                int16_val = htons(length_of_proposal);
                                this->write_bytes_to_buffer_at_offset(this,&int16_val,sizeof(u_int16_t),payload_length_position_offset);
                                
                                break;
                        }       
                        case TRANSFORM_ATTRIBUTES:
                        {
                                this->logger->log(this->logger,CONTROL|MORE,"Generate Transform attributes");
                                /* before iterative generate the transform attributes, store the current length position */
                                u_int32_t transform_length_position_offset = this->last_payload_length_position_offset;

                                u_int16_t length_of_transform = TRANSFORM_SUBSTRUCTURE_HEADER_LENGTH;
                                u_int16_t int16_val;
                                linked_list_t *transform_attributes =*((linked_list_t **)(this->data_struct + rules[i].offset));

                                linked_list_iterator_t *iterator;
                                /* create forward iterator */
                                status = transform_attributes->create_iterator(transform_attributes,&iterator,TRUE);
                                if (status != SUCCESS)
                                {
                                        return status;
                                }
                                while (iterator->has_next(iterator))
                                {
                                        payload_t *current_attribute;
                                        u_int32_t before_generate_position_offset;
                                        u_int32_t after_generate_position_offset;
                                        
                                        status = iterator->current(iterator,(void **)&current_attribute);
                                        if (status != SUCCESS)
                                        {
                                                iterator->destroy(iterator);    
                                                return status;
                                        }
                                        
                                        before_generate_position_offset = this->get_current_buffer_offset(this);
                                        this->public.generate_payload(&(this->public),current_attribute);
                                        after_generate_position_offset = this->get_current_buffer_offset(this);
                                        
                                        /* increase size of transform */
                                        length_of_transform += (after_generate_position_offset - before_generate_position_offset);
                                }
                                
                                iterator->destroy(iterator);
                                
                                this->logger->log(this->logger,CONTROL|MORE,"Length of Transform is %d, offset is %d",length_of_transform,transform_length_position_offset);
                                
                                int16_val = htons(length_of_transform);
                                this->write_bytes_to_buffer_at_offset(this,&int16_val,sizeof(u_int16_t),transform_length_position_offset);
                                
                                break;
                        }       
                        case ATTRIBUTE_FORMAT:
                        {
                                status = this->generate_flag(this,rules[i].offset);
                                /* Attribute format is a flag which is stored in context*/
                                this->attribute_format = *((bool *) (this->data_struct + rules[i].offset));
                                break;
                        }       

                        case ATTRIBUTE_LENGTH_OR_VALUE:
                        {
                                this->logger->log(this->logger,CONTROL|MORE,"Generate Attribute Length or Value field");
                                if (this->attribute_format == FALSE)
                                {
                                        status = this->generate_u_int_type(this,U_INT_16,rules[i].offset);
                                        /* this field hold the length of the attribute */
                                        this->attribute_length = *((u_int16_t *)(this->data_struct + rules[i].offset));
                                }
                                else
                                {
                                        status = this->write_bytes_to_buffer(this,(this->data_struct + rules[i].offset),2);
                                }
                                break;
                        }                               
                        case ATTRIBUTE_VALUE:
                        {
                                if (this->attribute_format == FALSE)
                                {
                                        this->logger->log(this->logger,CONTROL|MORE,"Attribute value has not fixed size");
                                        /* the attribute value is generated */
                                        status = this->generate_from_chunk(this,rules[i].offset);
                                }
                                break;
                        }
                        default:
                                this->logger->log(this->logger,CONTROL|MORE,"Field Type %s is not supported",mapping_find(encoding_type_m,rules[i].type));
                                return NOT_SUPPORTED;
                }
        }

        return status;
}

/**
 * Implements generator_t's destroy function.
 * See #generator_s.destroy.
 */
static status_t destroy(private_generator_t *this)
{
        allocator_free(this->buffer);
        global_logger_manager->destroy_logger(global_logger_manager,this->logger);
        allocator_free(this);
        return SUCCESS;
}

/*
 * Described in header
 */
generator_t * generator_create()
{
        private_generator_t *this;

        this = allocator_alloc_thing(private_generator_t);
        if (this == NULL)
        {
                return NULL;
        }

        /* initiate public functions */
        this->public.generate_payload = (status_t(*)(generator_t*, payload_t *)) generate_payload;
        this->public.destroy = (status_t(*)(generator_t*)) destroy;
        this->public.write_to_chunk = (status_t (*) (generator_t *,chunk_t *)) write_to_chunk;
        
        
        /* initiate private functions */
        this->get_current_buffer_size = get_current_buffer_size;
        this->get_current_buffer_space = get_current_buffer_space;
        this->get_current_data_length = get_current_data_length;
        this->get_current_buffer_offset = get_current_buffer_offset;
        this->generate_u_int_type = generate_u_int_type;
        this->generate_reserved_field = generate_reserved_field;
        this->generate_flag = generate_flag;
        this->generate_from_chunk = generate_from_chunk;
        this->make_space_available = make_space_available;
        this->write_bytes_to_buffer = write_bytes_to_buffer;
        this->write_bytes_to_buffer_at_offset = write_bytes_to_buffer_at_offset;


        /* allocate memory for buffer */
        this->buffer = allocator_alloc(GENERATOR_DATA_BUFFER_SIZE);
        if (this->buffer == NULL)
        {
                allocator_free(this);
                return NULL;
        }

        /* initiate private variables */
        this->out_position = this->buffer;
        this->roof_position = this->buffer + GENERATOR_DATA_BUFFER_SIZE;
        this->data_struct = NULL;
        this->current_bit = 0;
        this->last_payload_length_position_offset = 0;
        this->header_length_position_offset = 0;
        this->logger = global_logger_manager->create_logger(global_logger_manager,GENERATOR,NULL);
        
        if (this->logger == NULL)
        {
                allocator_free(this->buffer);
                allocator_free(this);
                return NULL;
        }       
        return &(this->public);
}