uint8_t *build_control_encap_pkt(
uint8_t * orig_pkt,
int orig_pkt_len,
lisp_addr_t *addr_from,
lisp_addr_t *addr_dest,
int port_from,
int port_dest,
encap_control_opts opts,
int *control_encap_pkt_len)
{
uint8_t *lisp_encap_pkt_ptr = NULL;
uint8_t *inner_pkt_ptr = NULL;
lisp_encap_control_hdr_t *lisp_hdr_ptr = NULL;
int encap_pkt_len = 0;
int lisp_hdr_len = 0;
/* Add the interal IP and UDP headers */
inner_pkt_ptr = build_ip_udp_pcket(orig_pkt,
orig_pkt_len,
addr_from,
addr_dest,
port_from,
port_dest,
&encap_pkt_len);
/* Header length */
lisp_hdr_len = sizeof(lisp_encap_control_hdr_t);
/* Assign memory for the original packet plus the new header */
*control_encap_pkt_len = lisp_hdr_len + encap_pkt_len;
if ((lisp_encap_pkt_ptr = (void *) malloc(*control_encap_pkt_len)) == NULL) {
lispd_log_msg(LISP_LOG_DEBUG_2, "malloc(packet_len): %s", strerror(errno));
free(inner_pkt_ptr);
return (NULL);
}
memset(lisp_encap_pkt_ptr, 0, *control_encap_pkt_len);
/* LISP encap control header */
lisp_hdr_ptr = (lisp_encap_control_hdr_t *) lisp_encap_pkt_ptr;
lisp_hdr_ptr->type = LISP_ENCAP_CONTROL_TYPE;
lisp_hdr_ptr->s_bit = 0; /* XXX Security field not supported */
lisp_hdr_ptr->ddt_bit = opts.ddt_bit;
/* Copy original packet after the LISP control header */
memcpy((uint8_t *)CO(lisp_hdr_ptr, lisp_hdr_len), inner_pkt_ptr, encap_pkt_len);
free (inner_pkt_ptr);
return (lisp_encap_pkt_ptr);
}
int build_and_send_map_request_msg(
lispd_mapping_elt *requested_mapping,
lisp_addr_t *src_eid,
lisp_addr_t *dst_rloc_addr,
uint8_t encap,
uint8_t probe,
uint8_t solicit_map_request,
uint8_t smr_invoked,
uint64_t *nonce)
{
uint8_t *packet = NULL;
uint8_t *map_req_pkt = NULL;
lisp_addr_t *src_addr = NULL;
int out_socket = 0;
int packet_len = 0;
int mrp_len = 0; /* return the length here */
int result = 0;
map_req_pkt = build_map_request_pkt(
requested_mapping,
src_eid,
encap,
probe,
solicit_map_request,
smr_invoked,
&mrp_len,
nonce);
if (map_req_pkt == NULL) {
lispd_log_msg(LISP_LOG_DEBUG_1, "build_and_send_map_request_msg: Could not build map-request packet for %s/%d:"
" Encap: %c, Probe: %c, SMR: %c, SMR-inv: %c ",
get_char_from_lisp_addr_t(requested_mapping->eid_prefix),
requested_mapping->eid_prefix_length,
(encap == TRUE ? 'Y' : 'N'),
(probe == TRUE ? 'Y' : 'N'),
(solicit_map_request == TRUE ? 'Y' : 'N'),
(smr_invoked == TRUE ? 'Y' : 'N'));
return (BAD);
}
/* Get src interface information */
src_addr = get_default_ctrl_address(dst_rloc_addr->afi);
out_socket = get_default_ctrl_socket(dst_rloc_addr->afi);
if (src_addr == NULL){
lispd_log_msg(LISP_LOG_DEBUG_1, "build_and_send_map_request_msg: Couden't send Map Request. No output interface with afi %d.",
dst_rloc_addr->afi);
free (map_req_pkt);
return (BAD);
}
/* Add UDP and IP header to the Map Request message */
packet = build_ip_udp_pcket(map_req_pkt,
mrp_len,
src_addr,
dst_rloc_addr,
LISP_CONTROL_PORT,
LISP_CONTROL_PORT,
&packet_len);
free (map_req_pkt);
if (packet == NULL){
lispd_log_msg(LISP_LOG_DEBUG_1,"build_and_send_map_request_msg: Couldn't send Map Request. Error adding IP and UDP header to the message");
return (BAD);
}
/* Send the packet */
if ((err = send_packet(out_socket,packet,packet_len)) == GOOD){
lispd_log_msg(LISP_LOG_DEBUG_1, "Sent Map-Request packet for %s/%d to %s: Encap: %c, Probe: %c, SMR: %c, SMR-inv: %c . Nonce: %s",
get_char_from_lisp_addr_t(requested_mapping->eid_prefix),
requested_mapping->eid_prefix_length,
get_char_from_lisp_addr_t(*dst_rloc_addr),
(encap == TRUE ? 'Y' : 'N'),
(probe == TRUE ? 'Y' : 'N'),
(solicit_map_request == TRUE ? 'Y' : 'N'),
(smr_invoked == TRUE ? 'Y' : 'N'),
get_char_from_nonce(*nonce));
result = GOOD;
}else{
lispd_log_msg(LISP_LOG_DEBUG_1, "Couldn't sent Map-Request packet for %s/%d: Encap: %c, Probe: %c, SMR: %c, SMR-inv: %c ",
get_char_from_lisp_addr_t(requested_mapping->eid_prefix),
requested_mapping->eid_prefix_length,
(encap == TRUE ? 'Y' : 'N'),
(probe == TRUE ? 'Y' : 'N'),
(solicit_map_request == TRUE ? 'Y' : 'N'),
(smr_invoked == TRUE ? 'Y' : 'N'));
result = BAD;
}
free (packet);
return (result);
}
