pki_layer.cc 3.51 KB
Newer Older
Yann Garcia's avatar
Yann Garcia committed
#include "pki_layer_factory.hh"
#include "codec_stack_builder.hh"

#include "loggers.hh"

#include "converter.hh"

garciay's avatar
garciay committed
#include "security_services.hh"

Yann Garcia's avatar
Yann Garcia committed
using namespace std; // Required for isnan()
#include "LibItsPki_TestSystem.hh"

garciay's avatar
garciay committed
pki_layer::pki_layer(const std::string & p_type, const std::string & param) : t_layer<LibItsPki__TestSystem::PkiPort>(p_type), _params(), _etsi_ts102941_types_enrolment_inner_request(), _etsi_ts102941_types_enrolment_inner_response(), _codec()
Yann Garcia's avatar
Yann Garcia committed
{
  loggers::get_instance().log(">>> pki_layer::pki_layer: %s, %s", to_string().c_str(), param.c_str());

  // Setup parameters
  params::convert(_params, param);
  // Sanity checks
  params::const_iterator it = _params.find(params::certificate);
  if (it == _params.cend()) {
    _params[params::certificate] = "CERT_TS_A_EA";
  }
  it = _params.find(params::peer_certificate);
  if (it == _params.cend()) {
    _params[params::certificate] = "CERT_IUT_A_EA";
  }
garciay's avatar
garciay committed
  _params[params::its_aid] = "2468";
Yann Garcia's avatar
Yann Garcia committed
  _params[params::payload_type] = "";
garciay's avatar
garciay committed
  _params[params::signature] = "NISTP-256";
Yann Garcia's avatar
Yann Garcia committed
  _params[params::encrypted_mode] = "1";
}

void pki_layer::sendMsg(const EtsiTs102941TypesEnrolment::InnerEcRequest& p_inner_ec_request, params& p_param) {
garciay's avatar
garciay committed
  loggers::get_instance().log_msg(">>> pki_layer::sendMsg: ", p_inner_ec_request);
Yann Garcia's avatar
Yann Garcia committed

  OCTETSTRING data;
garciay's avatar
garciay committed
  _etsi_ts102941_types_enrolment_inner_request.encode(p_inner_ec_request, data);
Yann Garcia's avatar
Yann Garcia committed
  // Add security
  OCTETSTRING secured_data;
garciay's avatar
garciay committed
  if (sign_and_encrypt_payload(data, secured_data) == 0) {
Yann Garcia's avatar
Yann Garcia committed
    send_data(data, _params);
  }
}

garciay's avatar
garciay committed
void pki_layer::sendMsg(const EtsiTs102941TypesEnrolment::InnerEcResponse& p_inner_ec_response, params& p_param) {
  loggers::get_instance().log_msg(">>> pki_layer::sendMsg: ", p_inner_ec_response);
Yann Garcia's avatar
Yann Garcia committed

  OCTETSTRING data;
garciay's avatar
garciay committed
  _etsi_ts102941_types_enrolment_inner_response.encode(p_inner_ec_response, data);
Yann Garcia's avatar
Yann Garcia committed
  // Add security
  OCTETSTRING secured_data;
garciay's avatar
garciay committed
  if (sign_and_encrypt_payload(data, secured_data) == 0) {
Yann Garcia's avatar
Yann Garcia committed
    send_data(data, _params);
  }
}

void pki_layer::send_data(OCTETSTRING& data, params& params) {
  loggers::get_instance().log_msg(">>> pki_layer::send_data: ", data);

  send_to_all_layers(data, params);
}

void pki_layer::receive_data(OCTETSTRING& data, params& params)
{
  loggers::get_instance().log_msg(">>> pki_layer::receive_data: ", data);

garciay's avatar
garciay committed
  // // Decode HTTP message
  // LibItsPki__TypesAndValues::HttpMessage pki_message;
  // if (_codec.decode(data, pki_message) == -1) {
  //   loggers::get_instance().warning("pki_layer::receive_data: Failed to decode data");
  //   return;
  // }
Yann Garcia's avatar
Yann Garcia committed
  
garciay's avatar
garciay committed
  // // Pass it to the ports
  // to_all_upper_ports(pki_message, params);
Yann Garcia's avatar
Yann Garcia committed
}

int pki_layer::sign_and_encrypt_payload(const OCTETSTRING& p_data, OCTETSTRING& p_secured_data) {
  loggers::get_instance().log_msg(">>> pki_layer::sign_and_encrypt_payload: ", p_data);

garciay's avatar
garciay committed
  // 1. Signed the data
  OCTETSTRING signed_data;
  if (security_services::get_instance().sign_payload(p_data, signed_data, _params) == -1) {
    loggers::get_instance().warning("http_etsi_ieee1609dot2_codec::encode: Failed to sign data");
    return -1;
Yann Garcia's avatar
Yann Garcia committed
  }
garciay's avatar
garciay committed
  loggers::get_instance().log_msg("pki_layer::sign_and_encrypt_payload: signed_data=", signed_data);
  // 2. Encrypt the signed packet
  if (security_services::get_instance().encrypt_gn_payload(signed_data, p_secured_data, _params) == -1) {
    loggers::get_instance().warning("http_etsi_ieee1609dot2_codec::encode: Failed to encrypt data");
    return -1;
  }
  loggers::get_instance().log_msg("<<< http_etsi_ieee1609dot2_codec::encode: ", p_secured_data);
  
  return 0;
Yann Garcia's avatar
Yann Garcia committed
}

pki_layer_factory pki_layer_factory::_f;