From 722b769e4d519f2428ee893a78cafa999151bb1c Mon Sep 17 00:00:00 2001 From: Sander Vrijders Date: Thu, 17 Mar 2016 14:37:49 +0100 Subject: lib: Add communication with IPCP daemon This adds the messages required for the IRMd to communicate with an IPC Process through the library. --- src/lib/ipcp.c | 108 ++++++++++++++++- src/lib/irm.c | 2 + src/lib/sockets.c | 346 ++++++++++++++++++++++++++++++++++++++++++++---------- 3 files changed, 387 insertions(+), 69 deletions(-) (limited to 'src/lib') diff --git a/src/lib/ipcp.c b/src/lib/ipcp.c index 294d518c..7870e478 100644 --- a/src/lib/ipcp.c +++ b/src/lib/ipcp.c @@ -31,6 +31,7 @@ #include #include #include +#include #include #include @@ -38,6 +39,45 @@ #include #include +static int send_ipcp_msg(pid_t pid, + struct ipcp_msg * msg) +{ + int sockfd = 0; + buffer_t * buf = NULL; + char * sock_path; + + sock_path = ipcp_sock_path(pid); + if (sock_path == NULL) + return -1; + + sockfd = client_socket_open(sock_path); + if (sockfd < 0) { + free(sock_path); + return -1; + } + + buf = serialize_ipcp_msg(msg); + if (buf == NULL) { + free(sock_path); + close(sockfd); + return -1; + } + + if (write(sockfd, buf->data, buf->size) == -1) { + free(sock_path); + free(buf->data); + free(buf); + close(sockfd); + return -1; + } + + free(buf->data); + free(buf); + + close(sockfd); + return 0; +} + pid_t ipcp_create(rina_name_t name, char * ipcp_type) { @@ -48,6 +88,9 @@ pid_t ipcp_create(rina_name_t name, char * ipcp_dir = "bin/ipcpd"; char * full_name = NULL; + if (ipcp_type == NULL) + return -1; + pid = fork(); if (pid == -1) { LOG_ERR("Failed to fork"); @@ -121,20 +164,58 @@ int ipcp_reg(pid_t pid, char ** difs, size_t difs_size) { - return -1; + struct ipcp_msg msg; + + if (difs == NULL) + return -1; + + msg.code = IPCP_REG; + msg.difs = difs; + msg.difs_size = difs_size; + + if (send_ipcp_msg(pid, &msg)) { + LOG_ERR("Failed to send message to daemon"); + return -1; + } + + return 0; } int ipcp_unreg(pid_t pid, char ** difs, size_t difs_size) { - return -1; + struct ipcp_msg msg; + + if (difs == NULL) + return -1; + + msg.code = IPCP_UNREG; + msg.difs = difs; + msg.difs_size = difs_size; + + if (send_ipcp_msg(pid, &msg)) { + LOG_ERR("Failed to send message to daemon"); + return -1; + } + + return 0; } int ipcp_bootstrap(pid_t pid, struct dif_config conf) { - return -1; + struct ipcp_msg msg; + + msg.code = IPCP_BOOTSTRAP; + msg.conf = &conf; + + if (send_ipcp_msg(pid, &msg)) { + LOG_ERR("Failed to send message to daemon"); + return -1; + } + + return 0; } int ipcp_enroll(pid_t pid, @@ -143,5 +224,24 @@ int ipcp_enroll(pid_t pid, char ** n_1_difs, ssize_t n_1_difs_size) { - return -1; + struct ipcp_msg msg; + + if (n_1_difs == NULL) + return -1; + + if (dif_name == NULL) + return -1; + + msg.code = IPCP_ENROLL; + msg.dif_name = dif_name; + msg.member = &member; + msg.difs = n_1_difs; + msg.difs_size = n_1_difs_size; + + if (send_ipcp_msg(pid, &msg)) { + LOG_ERR("Failed to send message to daemon"); + return -1; + } + + return 0; } diff --git a/src/lib/irm.c b/src/lib/irm.c index a1847eed..e4804074 100644 --- a/src/lib/irm.c +++ b/src/lib/irm.c @@ -44,6 +44,8 @@ static int send_irm_msg(struct irm_msg * msg) } if (write(sockfd, buf->data, buf->size) == -1) { + free(buf->data); + free(buf); close(sockfd); return -1; } diff --git a/src/lib/sockets.c b/src/lib/sockets.c index 59ac40f9..425d0354 100644 --- a/src/lib/sockets.c +++ b/src/lib/sockets.c @@ -25,6 +25,8 @@ #include #include #include +#include + #include #include #include @@ -94,6 +96,37 @@ int server_socket_open(char * file_name) return sockfd; } +char * ipcp_sock_path(pid_t pid) +{ + char * full_name = NULL; + char * pid_string = NULL; + size_t len = 0; + char * delim = "-"; + + len = n_digits(pid); + pid_string = malloc(len + 1); + if (pid_string == NULL) + return NULL; + + sprintf(pid_string, "%d", pid); + + len += strlen(IPCP_SOCK_PATH_PREFIX); + len += strlen(delim); + full_name = malloc(len + 1); + if (full_name == NULL) { + free(pid_string); + return NULL; + } + + strcpy(full_name, IPCP_SOCK_PATH_PREFIX); + strcat(full_name, delim); + strcat(full_name, pid_string); + + free(pid_string); + + return full_name; +} + static int serialized_string_len(uint8_t * data) { uint8_t * seek = data; @@ -113,6 +146,20 @@ static void ser_copy_value(size_t flen, *offset += flen; } +static void ser_copy_name(rina_name_t * name, + uint8_t * data, + int * offset) +{ + ser_copy_value(strlen(name->ap_name) + 1, + data, name->ap_name, offset); + ser_copy_value(sizeof(int), data, + &name->api_id, offset); + ser_copy_value(strlen(name->ae_name) + 1, + data, name->ae_name, offset); + ser_copy_value(sizeof(int), data, + &name->aei_id, offset); +} + static void deser_copy_value(size_t flen, void * dst, void * src, @@ -152,12 +199,60 @@ static void deser_copy_size_t(uint8_t * data, deser_copy_value(sizeof(size_t), dst, data, offset); } -static void deser_copy_enum(uint8_t * data, - enum irm_msg_code * dst, - int * offset) +static rina_name_t * deser_copy_name(uint8_t * data, + int * offset) { - *dst = 0; - deser_copy_value(sizeof(enum irm_msg_code), dst, data, offset); + rina_name_t * name; + + name = name_create(); + if (name == NULL) { + LOG_ERR("Failed to alloc memory"); + return NULL; + } + + if (deser_copy_string(data, &name->ap_name, offset)) { + name_destroy(name); + return NULL; + } + + deser_copy_int(data, &name->api_id, offset); + + if (deser_copy_string(data, &name->ae_name, offset)) { + name_destroy(name); + return NULL; + } + + deser_copy_int(data, &name->aei_id, offset); + + return name; +} + + +/* Move these to a separate file? */ +static buffer_t * buffer_create() +{ + buffer_t * buf; + + buf = malloc(sizeof(*buf)); + if (buf == NULL) + return NULL; + + buf->data = malloc(IRM_MSG_BUF_SIZE); + if (buf->data == NULL) { + free(buf); + return NULL; + } + + return buf; +} + +static void buffer_destroy(buffer_t * buf) +{ + if (buf->data != NULL) + free(buf->data); + + if (buf != NULL) + free(buf); } buffer_t * serialize_irm_msg(struct irm_msg * msg) @@ -171,47 +266,26 @@ buffer_t * serialize_irm_msg(struct irm_msg * msg) if (msg == NULL) return NULL; - buf = malloc(sizeof(*buf)); + buf = buffer_create(); if (buf == NULL) return NULL; - buf->data = malloc(IRM_MSG_BUF_SIZE); - if (buf->data == NULL) { - free(buf); - return NULL; - } - data = buf->data; ser_copy_value(sizeof(enum irm_msg_code), data, &msg->code, &offset); if (!name_is_ok(msg->name)) { LOG_ERR("Null pointer passed"); - free(buf->data); - free(buf); + buffer_destroy(buf); return NULL; } - - /* - * Every IRM message passes the name, may change - * Move to separate function when it does - */ - ser_copy_value(strlen(msg->name->ap_name) + 1, data, - msg->name->ap_name, &offset); - - ser_copy_value(sizeof(int), data, &msg->name->api_id, &offset); - - ser_copy_value(strlen(msg->name->ae_name) + 1, data, - msg->name->ae_name, &offset); - - ser_copy_value(sizeof(int), data, &msg->name->aei_id, &offset); + ser_copy_name(msg->name, data, &offset); switch (msg->code) { case IRM_CREATE_IPCP: if (!msg->ipcp_type) { LOG_ERR("Null pointer passed"); - free(buf->data); - free(buf); + buffer_destroy(buf); return NULL; } @@ -225,8 +299,7 @@ buffer_t * serialize_irm_msg(struct irm_msg * msg) break; case IRM_ENROLL_IPCP: if (msg->dif_name == NULL) { - free(buf->data); - free(buf); + buffer_destroy(buf); return NULL; } @@ -237,8 +310,7 @@ buffer_t * serialize_irm_msg(struct irm_msg * msg) case IRM_REG_IPCP: case IRM_UNREG_IPCP: if (msg->difs == NULL || msg->difs[0] == NULL) { - free(buf->data); - free(buf); + buffer_destroy(buf); return NULL; } @@ -253,8 +325,7 @@ buffer_t * serialize_irm_msg(struct irm_msg * msg) break; default: LOG_ERR("Don't know that code"); - free(buf->data); - free(buf); + buffer_destroy(buf); return NULL; } @@ -281,43 +352,24 @@ struct irm_msg * deserialize_irm_msg(buffer_t * data) return NULL; } - deser_copy_enum(data->data, &msg->code, &offset); + deser_copy_value(sizeof(enum irm_msg_code), + &msg->code, data->data, &offset); - msg->name = name_create(); + msg->name = deser_copy_name(data->data, &offset); if (msg->name == NULL) { - LOG_ERR("Failed to alloc memory"); + LOG_ERR("Failed to reconstruct name"); free(msg); return NULL; } - if (deser_copy_string(data->data, - &msg->name->ap_name, - &offset)) { - name_destroy(msg->name); - free(msg); - return NULL; - } - - deser_copy_int(data->data, &msg->name->api_id, &offset); - - if (deser_copy_string(data->data, - &msg->name->ae_name, - &offset)) { - name_destroy(msg->name); - free(msg); - return NULL; - } - - deser_copy_int(data->data, &msg->name->aei_id, &offset); - switch (msg->code) { case IRM_CREATE_IPCP: - if (deser_copy_string(data->data, - &msg->ipcp_type, - &offset)) { - name_destroy(msg->name); - free(msg); - return NULL; + if (deser_copy_string(data->data, + &msg->ipcp_type, + &offset)) { + name_destroy(msg->name); + free(msg); + return NULL; } break; @@ -369,3 +421,167 @@ struct irm_msg * deserialize_irm_msg(buffer_t * data) return msg; } + +buffer_t * serialize_ipcp_msg(struct ipcp_msg * msg) +{ + buffer_t * buf = NULL; + uint8_t * data = NULL; + int offset = 0; + char ** pos = NULL; + int i = 0; + + if (msg == NULL) + return NULL; + + buf = buffer_create(); + if (buf == NULL) + return NULL; + + data = buf->data; + + ser_copy_value(sizeof(enum ipcp_msg_code), + data, &msg->code, &offset); + + switch (msg->code) { + case IPCP_BOOTSTRAP: + break; + case IPCP_ENROLL: + if (msg->dif_name == NULL) { + buffer_destroy(buf); + return NULL; + } + + ser_copy_value(strlen(msg->dif_name) + 1, data, + msg->dif_name, &offset); + + if (!name_is_ok(msg->member)) { + LOG_ERR("Null pointer passed"); + buffer_destroy(buf); + return NULL; + } + ser_copy_name(msg->member, data, &offset); + + /* All these operations end with a list of DIFs */ + case IPCP_REG: + case IPCP_UNREG: + if (msg->difs == NULL || msg->difs[0] == NULL) { + buffer_destroy(buf); + return NULL; + } + + ser_copy_value(sizeof(size_t), data, &msg->difs_size, &offset); + + pos = msg->difs; + for (i = 0; i < msg->difs_size; i++) { + ser_copy_value(strlen(*pos) + 1, data, *pos, &offset); + pos++; + } + break; + default: + LOG_ERR("Don't know that code"); + buffer_destroy(buf); + return NULL; + } + + buf->size = offset; + + return buf; +} + +struct ipcp_msg * deserialize_ipcp_msg(buffer_t * data) +{ + struct ipcp_msg * msg; + int i, j; + int offset = 0; + size_t difs_size; + + if (data == NULL || data->data == NULL) { + LOG_ERR("Got a null pointer"); + return NULL; + } + + msg = malloc(sizeof(*msg)); + if (msg == NULL) { + LOG_ERR("Failed to allocate memory"); + return NULL; + } + + deser_copy_value(sizeof(enum ipcp_msg_code), + &msg->code, data->data, &offset); + + switch (msg->code) { + case IPCP_BOOTSTRAP: + break; + case IPCP_ENROLL: + if (deser_copy_string(data->data, + &msg->dif_name, + &offset)) { + free(msg); + return NULL; + } + + msg->member = deser_copy_name(data->data, &offset); + if (msg->member == NULL) { + LOG_ERR("Failed to reconstruct name"); + free(msg->dif_name); + free(msg); + return NULL; + } + + deser_copy_size_t(data->data, &difs_size, &offset); + msg->difs_size = difs_size; + + msg->difs = malloc(sizeof(*(msg->difs)) * difs_size); + if (msg->difs == NULL) { + free(msg->dif_name); + name_destroy(msg->member); + free(msg); + return NULL; + } + + for (i = 0; i < difs_size; i++) { + if (deser_copy_string(data->data, + &msg->difs[i], + &offset)) { + for (j = 0; j < i; j++) + free(msg->difs[j]); + free(msg->dif_name); + free(msg->difs); + name_destroy(msg->member); + free(msg); + return NULL; + } + } + break; + case IPCP_REG: + case IPCP_UNREG: + deser_copy_size_t(data->data, &difs_size, &offset); + msg->difs_size = difs_size; + + msg->difs = malloc(sizeof(*(msg->difs)) * difs_size); + if (msg->difs == NULL) { + free(msg); + return NULL; + } + + for (i = 0; i < difs_size; i++) { + if (deser_copy_string(data->data, + &msg->difs[i], + &offset)) { + for (j = 0; j < i; j++) + free(msg->difs[j]); + free(msg->difs); + free(msg); + return NULL; + } + } + + break; + default: + LOG_ERR("Don't know that code"); + free(msg); + return NULL; + } + + return msg; +} -- cgit v1.2.3