/*
 * Copyright (c) 2014, Matias Fontanini
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions are
 * met:
 * 
 * * Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * * Redistributions in binary form must reproduce the above
 *   copyright notice, this list of conditions and the following disclaimer
 *   in the documentation and/or other materials provided with the
 *   distribution.
 * 
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 *
 */

#include "rsn_information.h"
#ifdef HAVE_DOT11

#include <cstring>
#include <stdexcept>
#include "exceptions.h"
#include "pdu_option.h"
#include "dot11/dot11_base.h"

namespace Tins {
template<typename T>
void check_size(uint32_t total_sz) {
    if(total_sz < sizeof(T))
        throw malformed_packet();
}
    
RSNInformation::RSNInformation() : _version(1), _capabilities(0) {

}

RSNInformation::RSNInformation(const serialization_type &buffer) {
    init(&buffer[0], static_cast<uint32_t>(buffer.size()));
}

RSNInformation::RSNInformation(const uint8_t *buffer, uint32_t total_sz) {
    init(buffer, total_sz);
}

void RSNInformation::init(const uint8_t *buffer, uint32_t total_sz) {
    if(total_sz <= sizeof(uint16_t) * 2 + sizeof(uint32_t))
        throw malformed_packet();

    uint16_t uint16_t_buffer;
    uint32_t uint32_t_buffer;

    std::memcpy(&uint16_t_buffer, buffer, sizeof(uint16_t));
    version(Endian::le_to_host(uint16_t_buffer));
    buffer += sizeof(uint16_t);
    total_sz -= sizeof(uint16_t);
    
    std::memcpy(&uint32_t_buffer, buffer, sizeof(uint32_t));
    group_suite((RSNInformation::CypherSuites)uint32_t_buffer);
    buffer += sizeof(uint32_t);
    total_sz -= sizeof(uint32_t);

    std::memcpy(&uint16_t_buffer, buffer, sizeof(uint16_t));
    buffer += sizeof(uint16_t);
    total_sz -= sizeof(uint16_t);
    
    if(uint16_t_buffer * sizeof(uint32_t) > total_sz)
        throw malformed_packet();
    total_sz -= uint16_t_buffer * sizeof(uint32_t);
    while(uint16_t_buffer--) {
        std::memcpy(&uint32_t_buffer, buffer, sizeof(uint32_t));
        add_pairwise_cypher((RSNInformation::CypherSuites)uint32_t_buffer);
        buffer += sizeof(uint32_t);
    }
    check_size<uint16_t>(total_sz);

    std::memcpy(&uint16_t_buffer, buffer, sizeof(uint16_t));
    buffer += sizeof(uint16_t);
    total_sz -= sizeof(uint16_t);
    if(uint16_t_buffer * sizeof(uint32_t) > total_sz)
        throw malformed_packet();
    total_sz -= uint16_t_buffer * sizeof(uint32_t);
    while(uint16_t_buffer--) {
        std::memcpy(&uint32_t_buffer, buffer, sizeof(uint32_t));
        add_akm_cypher((RSNInformation::AKMSuites)uint32_t_buffer);
        buffer += sizeof(uint32_t);
    }
    check_size<uint16_t>(total_sz);
    
    std::memcpy(&uint16_t_buffer, buffer, sizeof(uint16_t));
    capabilities(Endian::le_to_host(uint16_t_buffer));
}

void RSNInformation::add_pairwise_cypher(CypherSuites cypher) {
    _pairwise_cyphers.push_back(cypher);
}

void RSNInformation::add_akm_cypher(AKMSuites akm) {
    _akm_cyphers.push_back(akm);
}

void RSNInformation::group_suite(CypherSuites group) {
    _group_suite = group;
}

void RSNInformation::version(uint16_t ver) {
    _version = ver;
}

void RSNInformation::capabilities(uint16_t cap) {
    _capabilities = cap;
}

RSNInformation::serialization_type RSNInformation::serialize() const {
    size_t size = sizeof(_version) + sizeof(_capabilities) + sizeof(uint32_t);
    size += (sizeof(uint16_t) << 1); // 2 lists count.
    size += sizeof(uint32_t) * (_akm_cyphers.size() + _pairwise_cyphers.size());

    const size_t pairwise_cyphers_size = _pairwise_cyphers.size();
    const size_t akm_cyphers_size = _akm_cyphers.size();
    uint16_t capabilities = Endian::host_to_le(_capabilities);
    uint16_t version = Endian::host_to_le(_version);
    
    serialization_type buffer(size);
    serialization_type::value_type *ptr = &buffer[0];
    std::memcpy(ptr, &version, sizeof(version));
    ptr += sizeof(uint16_t);
    std::memcpy(ptr, &_group_suite, sizeof(uint32_t));
    ptr += sizeof(uint32_t);
    std::memcpy(ptr, &pairwise_cyphers_size, sizeof(uint16_t));
    ptr += sizeof(uint16_t);
    for(cyphers_type::const_iterator it = _pairwise_cyphers.begin(); it != _pairwise_cyphers.end(); ++it) {
        std::memcpy(ptr, &*it, sizeof(uint32_t));
        ptr += sizeof(uint32_t);
    }
    std::memcpy(ptr, &akm_cyphers_size, sizeof(uint16_t));
    ptr += sizeof(uint16_t);
    for(akm_type::const_iterator it = _akm_cyphers.begin(); it != _akm_cyphers.end(); ++it) {
        std::memcpy(ptr, &*it, sizeof(uint32_t));
        ptr += sizeof(uint32_t);
    }
    std::memcpy(ptr, &capabilities, sizeof(uint16_t));

    return buffer;
}

RSNInformation RSNInformation::wpa2_psk() {
    RSNInformation info;
    info.group_suite(RSNInformation::CCMP);
    info.add_pairwise_cypher(RSNInformation::CCMP);
    info.add_akm_cypher(RSNInformation::PSK);
    return info;
}

RSNInformation RSNInformation::from_option(const PDUOption<uint8_t, Dot11> &opt) {
    if(opt.data_size() < sizeof(uint16_t) * 2 + sizeof(uint32_t))
        throw malformed_option();
    return RSNInformation(opt.data_ptr(), static_cast<uint32_t>(opt.data_size()));
}
}

#endif // HAVE_DOT11