#include "mapem_spatem_types.hh"

#include "mapem_spatem_layer_factory.hh"

#include "registration.hh"

#include "loggers.hh"

mapem_spatem_layer::mapem_spatem_layer(const std::string & p_type, const std::string & param) : t_layer<LibItsMapemSpatem__TestSystem::MapemSpatemPort>(p_type), _params(), _mapem_codec(), _spatem_codec() {
  loggers::get_instance().log(">>> mapem_spatem_layer::mapem_spatem_layer: %s, %s", to_string().c_str(), param.c_str());
  // Setup parameters
  params::convert(_params, param);
  _params.insert(std::make_pair<std::string, std::string>("its_aid", "138")); // ETSI TS 102 965 V1.2.1 (2015-06)
  _params.insert(std::make_pair<std::string, std::string>("payload_type", "2")); // MAPE message id - See ETSI TS 102 894

  // Register this object for AdapterControlPort
  loggers::get_instance().log("mapem_spatem_layer::mapem_spatem_layer: Register %s/%p", p_type.c_str(), this);
  registration<mapem_spatem_layer>::get_instance().add_item(p_type, this);
}

void mapem_spatem_layer::sendMsg(const LibItsMapemSpatem__TestSystem::MapemReq& p, params& params){
  loggers::get_instance().log_msg(">>> mapem_spatem_layer::sendMsg: ", p);

  // Encode mapem PDU
  OCTETSTRING data;
  if (_mapem_codec.encode(p.msgOut(), data) == -1) {
    loggers::get_instance().warning("mapem_spatem_layer::sendMsg: Encoding failure");
    return;
  }
  // Update parameters
  send_data(data, _params);
}

void mapem_spatem_layer::sendMsg(const LibItsMapemSpatem__TestSystem::SpatemReq& p, params& params){
  loggers::get_instance().log_msg(">>> mapem_spatem_layer::sendMsg: ", p);

  // Encode spatem PDU
  OCTETSTRING data;
  if (_spatem_codec.encode(p.msgOut(), data) == -1) {
    loggers::get_instance().warning("mapem_spatem_layer::sendMsg: Encoding failure");
    return;
  }
  send_data(data, _params);
}

void mapem_spatem_layer::send_data(OCTETSTRING& data, params& params) {
  loggers::get_instance().log_msg(">>> mapem_spatem_layer::send_data: ", data);
  //params.log();
  send_to_all_layers(data, params);
}

void mapem_spatem_layer::receive_data(OCTETSTRING& data, params& params)
{
  loggers::get_instance().log_msg(">>> mapem_spatem_layer::receive_data: ", data);
  
  // Sanity check
  if (*(static_cast<const unsigned char*>(data)+ 1) == 0x05) { // Check that received packet has MAPE message id 
    // Decode the MAPEM payload
    LibItsMapemSpatem__TestSystem::MapemInd p;
    _mapem_codec.decode(data, p.msgIn());
    if (!p.msgIn().is_bound()) {
      // Discard it
      return;
    } // else, continue
    // Process lower layer data
    // recvTime
    params::const_iterator it = params.find(params::timestamp);
    if (it != params.cend()) {
      p.recvTime().set_long_long_val(std::stoll(it->second));
    } else {
      p.recvTime().set_to_omit();
    }
    // gnNextHeader
    it = params.find(params::gn_next_header);
    if (it != params.cend()) {
      p.gnNextHeader() = std::stoi(it->second);
    } else {
      p.gnNextHeader().set_to_omit();
    }
    // gnHeaderType
    it = params.find(params::gn_header_type);
    if (it != params.cend()) {
      p.gnHeaderType() = std::stoi(it->second);
    } else {
      p.gnHeaderType().set_to_omit();
    }
    // gnHeaderSubtype
    it = params.find(params::gn_header_sub_type);
    if (it != params.cend()) {
      p.gnHeaderSubtype() = std::stoi(it->second);
    } else {
      p.gnHeaderSubtype().set_to_omit();
    }
    // gnLifetime
    it = params.find(params::gn_lifetime);
    if (it != params.cend()) {
      p.gnLifetime() = std::stoi(it->second);
    } else {
      p.gnLifetime().set_to_omit();
    }
    // gnTrafficClass
    it = params.find(params::gn_traffic_class);
    if (it != params.cend()) {
      p.gnTrafficClass() = std::stoi(it->second);
    } else {
      p.gnTrafficClass().set_to_omit();
    }
    // btpDestinationPort
    it = params.find(params::btp_destination_port);
    if (it != params.cend()) {
      p.btpDestinationPort() = std::stoi(it->second);
    } else {
      p.btpDestinationPort().set_to_omit();
    }
    // btpInfo
    it = params.find(params::btp_info);
    if (it != params.cend()) {
      p.btpInfo() = std::stoi(it->second);
    } else {
      p.btpInfo().set_to_omit();
    }
    // ssp
    it = params.find(params::ssp);
    if (it != params.cend()) {
      loggers::get_instance().log("mapem_spatem_layer::receive_data: ssp=%s", it->second.c_str());
      p.ssp() = oct2bit(str2oct(CHARSTRING(it->second.c_str())));
    } else {
      p.ssp().set_to_omit();
    }
    // its_aid
    it = params.find(params::its_aid);
    if (it != params.cend()) {
      p.its__aid() = std::stoi(it->second);
    } else {
      p.its__aid().set_to_omit();
    }
  
    // Pass it to the ports if any
    to_all_upper_ports(p, params);
  } else if (*(static_cast<const unsigned char*>(data)+ 1) == 0x04) { // Check that received packet has SPATE message id 
    // Decode the SPATEM payload
    LibItsMapemSpatem__TestSystem::SpatemInd p;
    _spatem_codec.decode(data, p.msgIn());
    if (!p.msgIn().is_bound()) {
      // Discard it
      return;
    } // else, continue
    // Process lower layer data
    // recvTime
    params::const_iterator it = params.find(params::timestamp);
    if (it != params.cend()) {
      p.recvTime().set_long_long_val(std::stoll(it->second));
    } else {
      p.recvTime().set_to_omit();
    }
    // gnNextHeader
    it = params.find(params::gn_next_header);
    if (it != params.cend()) {
      p.gnNextHeader() = std::stoi(it->second);
    } else {
      p.gnNextHeader().set_to_omit();
    }
    // gnHeaderType
    it = params.find(params::gn_header_type);
    if (it != params.cend()) {
      p.gnHeaderType() = std::stoi(it->second);
    } else {
      p.gnHeaderType().set_to_omit();
    }
    // gnHeaderSubtype
    it = params.find(params::gn_header_sub_type);
    if (it != params.cend()) {
      p.gnHeaderSubtype() = std::stoi(it->second);
    } else {
      p.gnHeaderSubtype().set_to_omit();
    }
    // gnLifetime
    it = params.find(params::gn_lifetime);
    if (it != params.cend()) {
      p.gnLifetime() = std::stoi(it->second);
    } else {
      p.gnLifetime().set_to_omit();
    }
    // gnTrafficClass
    it = params.find(params::gn_traffic_class);
    if (it != params.cend()) {
      p.gnTrafficClass() = std::stoi(it->second);
    } else {
      p.gnTrafficClass().set_to_omit();
    }
    // btpDestinationPort
    it = params.find(params::btp_destination_port);
    if (it != params.cend()) {
      p.btpDestinationPort() = std::stoi(it->second);
    } else {
      p.btpDestinationPort().set_to_omit();
    }
    // btpInfo
    it = params.find(params::btp_info);
    if (it != params.cend()) {
      p.btpInfo() = std::stoi(it->second);
    } else {
      p.btpInfo().set_to_omit();
    }
    // ssp
    it = params.find(params::ssp);
    if (it != params.cend()) {
      loggers::get_instance().log("mapem_spatem_layer::receive_data: ssp=%s", it->second.c_str());
      p.ssp() = oct2bit(str2oct(CHARSTRING(it->second.c_str())));
    } else {
      p.ssp().set_to_omit();
    }
    // its_aid
    it = params.find(params::its_aid);
    if (it != params.cend()) {
      p.its__aid() = std::stoi(it->second);
    } else {
      p.its__aid().set_to_omit();
    }
  
    // Pass it to the ports if any
    to_all_upper_ports(p, params);
  } else {
    // Not a MAPEM/SPATEM message, discard it
    loggers::get_instance().warning("mapem_spatem_layer::receive_data: Wrong message id: 0x%02x", *(static_cast<const unsigned char*>(data)+ 1));
    return;
  }
}

int mapem_spatem_layer::enable_secured_mode(const std::string& p_certificate_id, const boolean p_enforce_security) {
  loggers::get_instance().log(">>> mapem_spatem_layer::enable_secured_mode: '%s' - %x", p_certificate_id.c_str(), p_enforce_security);

  return 0;
}

int mapem_spatem_layer::disable_secured_mode() {
  loggers::get_instance().log(">>> mapem_spatem_layer::disable_secured_mode");

  return 0;
}

mapem_spatem_layer_factory mapem_spatem_layer_factory::_f;