2016-06-05 20:48:13 +02:00
|
|
|
#include "pubsubd.h"
|
|
|
|
#include <stdlib.h>
|
|
|
|
|
|
|
|
// CHANNELS
|
|
|
|
|
|
|
|
void pubsubd_channels_init (struct channels *chans) { LIST_INIT(chans); }
|
|
|
|
|
2016-06-07 17:44:18 +02:00
|
|
|
struct channel *
|
2016-06-05 20:48:13 +02:00
|
|
|
pubsubd_channels_add (struct channels *chans, struct channel *c)
|
|
|
|
{
|
|
|
|
if(!chans || !c)
|
2016-06-07 17:44:18 +02:00
|
|
|
return NULL;
|
2016-06-05 20:48:13 +02:00
|
|
|
|
|
|
|
struct channel *n = pubsubd_channel_copy (c);
|
|
|
|
LIST_INSERT_HEAD(chans, n, entries);
|
2016-06-07 17:44:18 +02:00
|
|
|
|
|
|
|
return n;
|
2016-06-05 20:48:13 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
void
|
|
|
|
pubsubd_channels_del (struct channels *chans, struct channel *c)
|
|
|
|
{
|
|
|
|
struct channel *todel = pubsubd_channel_get (chans, c);
|
|
|
|
if(todel != NULL) {
|
2016-06-06 02:25:28 +02:00
|
|
|
pubsubd_channel_free (todel);
|
2016-06-07 17:44:18 +02:00
|
|
|
LIST_REMOVE(todel, entries);
|
2016-06-05 20:48:13 +02:00
|
|
|
free (todel);
|
|
|
|
todel = NULL;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2016-06-07 13:49:23 +02:00
|
|
|
void pubsubd_channels_del_all (struct channels *chans)
|
|
|
|
{
|
|
|
|
if (!chans)
|
|
|
|
return;
|
|
|
|
|
|
|
|
struct channel *c;
|
|
|
|
|
|
|
|
while (!LIST_EMPTY(chans)) {
|
|
|
|
c = LIST_FIRST(chans);
|
|
|
|
LIST_REMOVE(c, entries);
|
|
|
|
pubsubd_channel_free (c);
|
|
|
|
free (c);
|
|
|
|
c = NULL;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2016-06-05 20:48:13 +02:00
|
|
|
struct channel * pubsubd_channel_copy (struct channel *c)
|
|
|
|
{
|
2016-06-07 17:44:18 +02:00
|
|
|
if (c == NULL)
|
|
|
|
return NULL;
|
|
|
|
|
2016-06-05 20:48:13 +02:00
|
|
|
struct channel *copy;
|
|
|
|
copy = malloc (sizeof(struct channel));
|
2016-06-07 17:44:18 +02:00
|
|
|
bzero (copy, sizeof (struct channel));
|
|
|
|
|
2016-06-05 20:48:13 +02:00
|
|
|
memcpy (copy, c, sizeof(struct channel));
|
2016-06-07 17:44:18 +02:00
|
|
|
|
|
|
|
if (c->chan != NULL) {
|
|
|
|
copy->chan = strndup (c->chan, c->chanlen);
|
|
|
|
copy->chanlen = c->chanlen;
|
|
|
|
}
|
|
|
|
|
2016-06-05 20:48:13 +02:00
|
|
|
return copy;
|
|
|
|
}
|
|
|
|
|
2016-06-06 02:25:28 +02:00
|
|
|
void pubsubd_channel_free (struct channel * c)
|
|
|
|
{
|
2016-06-07 17:44:18 +02:00
|
|
|
// TODO
|
|
|
|
if (c == NULL)
|
|
|
|
return;
|
|
|
|
|
|
|
|
if (c->chan != NULL) {
|
|
|
|
free (c->chan);
|
|
|
|
c->chan = NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (c->alh != NULL) {
|
|
|
|
pubsubd_subscriber_del_all (c->alh);
|
|
|
|
free (c->alh);
|
|
|
|
}
|
2016-06-06 02:25:28 +02:00
|
|
|
}
|
|
|
|
|
2016-06-05 20:48:13 +02:00
|
|
|
struct channel * pubsubd_channel_get (struct channels *chans, struct channel *c)
|
|
|
|
{
|
|
|
|
struct channel * np = NULL;
|
|
|
|
LIST_FOREACH(np, chans, entries) {
|
2016-06-06 02:25:28 +02:00
|
|
|
if (pubsubd_channel_eq (np, c))
|
2016-06-05 20:48:13 +02:00
|
|
|
return np;
|
|
|
|
}
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
int
|
2016-06-06 02:25:28 +02:00
|
|
|
pubsubd_channel_eq (const struct channel *c1, const struct channel *c2)
|
2016-06-05 20:48:13 +02:00
|
|
|
{
|
|
|
|
return (strncmp (c1->chan, c2->chan, c1->chanlen) == 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
// SUBSCRIBER
|
|
|
|
|
2016-06-07 17:44:18 +02:00
|
|
|
void pubsubd_subscriber_init (struct app_list_head **chans) {
|
|
|
|
if (chans == NULL)
|
|
|
|
return;
|
|
|
|
|
|
|
|
if (*chans == NULL)
|
|
|
|
*chans = malloc (sizeof(struct channels));
|
|
|
|
LIST_INIT(*chans);
|
|
|
|
}
|
2016-06-05 20:48:13 +02:00
|
|
|
|
2016-06-07 17:44:18 +02:00
|
|
|
void pubsubd_channels_print (const struct channels *chans)
|
2016-06-07 13:49:23 +02:00
|
|
|
{
|
2016-06-07 17:44:18 +02:00
|
|
|
printf ("\033[36mmchannels\033[00m\n\n");
|
|
|
|
|
|
|
|
if (chans == NULL)
|
|
|
|
return ;
|
2016-06-07 13:49:23 +02:00
|
|
|
|
2016-06-07 17:44:18 +02:00
|
|
|
struct channel *chan = NULL;
|
|
|
|
LIST_FOREACH(chan, chans, entries) {
|
|
|
|
pubsubd_channel_print (chan);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void pubsubd_channel_print (const struct channel *c)
|
|
|
|
{
|
|
|
|
if (c == NULL || c->chan == NULL)
|
|
|
|
return;
|
|
|
|
|
|
|
|
printf ( "\033[32mchan %s\033[00m\n\t", c->chan);
|
|
|
|
|
|
|
|
if (c->alh == NULL)
|
|
|
|
return;
|
|
|
|
|
|
|
|
struct app_list_elm *ale = NULL;
|
|
|
|
LIST_FOREACH(ale, c->alh, entries) {
|
|
|
|
srv_process_print (ale->p);
|
|
|
|
}
|
2016-06-07 13:49:23 +02:00
|
|
|
}
|
|
|
|
|
2016-06-06 02:25:28 +02:00
|
|
|
struct app_list_elm * pubsubd_app_list_elm_copy (const struct app_list_elm *ale)
|
2016-06-05 20:48:13 +02:00
|
|
|
{
|
|
|
|
if (ale == NULL)
|
|
|
|
return NULL;
|
|
|
|
|
|
|
|
struct app_list_elm * n;
|
|
|
|
n = malloc (sizeof (struct app_list_elm));
|
|
|
|
|
2016-06-07 17:44:18 +02:00
|
|
|
if (ale->p != NULL)
|
|
|
|
n->p = srv_process_copy (ale->p);
|
2016-06-05 20:48:13 +02:00
|
|
|
|
|
|
|
return n;
|
|
|
|
}
|
|
|
|
|
2016-06-06 02:25:28 +02:00
|
|
|
int
|
|
|
|
pubsubd_subscriber_eq (const struct app_list_elm *ale1, const struct app_list_elm *ale2)
|
|
|
|
{
|
|
|
|
return srv_process_eq (ale1->p, ale2->p);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2016-06-05 20:48:13 +02:00
|
|
|
void
|
2016-06-06 02:25:28 +02:00
|
|
|
pubsubd_subscriber_add (struct app_list_head *alh, const struct app_list_elm *ale)
|
2016-06-05 20:48:13 +02:00
|
|
|
{
|
|
|
|
if(!alh || !ale)
|
|
|
|
return;
|
|
|
|
|
|
|
|
struct app_list_elm *n = pubsubd_app_list_elm_copy (ale);
|
|
|
|
LIST_INSERT_HEAD(alh, n, entries);
|
|
|
|
}
|
|
|
|
|
|
|
|
struct app_list_elm *
|
|
|
|
pubsubd_subscriber_get (const struct app_list_head *chans, const struct app_list_elm *p)
|
|
|
|
{
|
|
|
|
struct app_list_elm *np, *res = NULL;
|
|
|
|
LIST_FOREACH(np, chans, entries) {
|
2016-06-06 02:25:28 +02:00
|
|
|
if(pubsubd_subscriber_eq (np, p)) {
|
2016-06-05 20:48:13 +02:00
|
|
|
res = np;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return res;
|
|
|
|
}
|
|
|
|
|
|
|
|
void
|
|
|
|
pubsubd_subscriber_del (struct app_list_head *chans, struct app_list_elm *p)
|
|
|
|
{
|
|
|
|
struct app_list_elm *todel = pubsubd_subscriber_get (chans, p);
|
|
|
|
if(todel != NULL) {
|
|
|
|
pubsubd_app_list_elm_free (todel);
|
2016-06-07 17:44:18 +02:00
|
|
|
LIST_REMOVE(todel, entries);
|
2016-06-05 20:48:13 +02:00
|
|
|
free (todel);
|
|
|
|
todel = NULL;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2016-06-07 17:44:18 +02:00
|
|
|
void pubsubd_subscriber_del_all (struct app_list_head *alh)
|
|
|
|
{
|
|
|
|
if (!alh)
|
|
|
|
return;
|
|
|
|
|
|
|
|
struct app_list_elm *ale;
|
|
|
|
|
|
|
|
while (!LIST_EMPTY(alh)) {
|
|
|
|
ale = LIST_FIRST(alh);
|
|
|
|
LIST_REMOVE(ale, entries);
|
|
|
|
pubsubd_app_list_elm_free (ale);
|
|
|
|
free (ale);
|
|
|
|
ale = NULL;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2016-06-05 20:48:13 +02:00
|
|
|
void pubsubd_app_list_elm_create (struct app_list_elm *ale, struct process *p)
|
|
|
|
{
|
|
|
|
if (ale == NULL)
|
|
|
|
return;
|
|
|
|
|
|
|
|
ale->p = srv_process_copy (p);
|
|
|
|
}
|
|
|
|
|
|
|
|
void pubsubd_app_list_elm_free (struct app_list_elm *todel)
|
|
|
|
{
|
2016-06-07 17:44:18 +02:00
|
|
|
if (todel == NULL || todel->p == NULL)
|
2016-06-06 02:25:28 +02:00
|
|
|
return;
|
2016-06-05 20:48:13 +02:00
|
|
|
srv_process_free (todel->p);
|
|
|
|
}
|
|
|
|
|
|
|
|
// MESSAGE, TODO CBOR
|
|
|
|
|
|
|
|
void pubsubd_msg_serialize (const struct pubsub_msg *msg, char **data, size_t *len)
|
|
|
|
{
|
|
|
|
if (msg == NULL || data == NULL || len == NULL)
|
|
|
|
return;
|
|
|
|
|
|
|
|
// msg: "type(1) chanlen(8) chan datalen(8) data
|
|
|
|
*len = 1 + sizeof(size_t) + msg->chanlen + sizeof(size_t) + msg->datalen;
|
|
|
|
*data = malloc(*len);
|
|
|
|
|
|
|
|
size_t i = 0;
|
|
|
|
|
|
|
|
data[0][i] = msg->type; i++;
|
2016-06-06 02:25:28 +02:00
|
|
|
memcpy (&data[0][i], &msg->chanlen, sizeof(size_t)); i += sizeof(size_t);
|
|
|
|
memcpy (&data[0][i], msg->chan, msg->chanlen); i += msg->chanlen;
|
|
|
|
memcpy (&data[0][i], &msg->datalen, sizeof(size_t)); i += sizeof(size_t);
|
|
|
|
memcpy (&data[0][i], msg->data, msg->datalen); i += msg->datalen;
|
2016-06-05 20:48:13 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
void pubsubd_msg_unserialize (struct pubsub_msg *msg, const char *data, size_t len)
|
|
|
|
{
|
|
|
|
if (msg == NULL || data == NULL)
|
|
|
|
return;
|
|
|
|
|
|
|
|
size_t i = 0;
|
2016-06-06 02:25:28 +02:00
|
|
|
msg->type = data[i]; i++;
|
2016-06-05 20:48:13 +02:00
|
|
|
memcpy (&msg->chanlen, data + i, sizeof(size_t)); i += sizeof(size_t);
|
|
|
|
msg->chan = malloc (msg->chanlen);
|
|
|
|
memcpy (msg->chan, data + i, msg->chanlen); i += msg->chanlen;
|
|
|
|
memcpy (&msg->datalen, data + i, sizeof(size_t)); i += sizeof(size_t);
|
|
|
|
msg->data = malloc (msg->datalen);
|
|
|
|
memcpy (msg->data, data + i, msg->datalen); i += msg->datalen;
|
|
|
|
}
|
|
|
|
|
|
|
|
void pubsubd_msg_free (struct pubsub_msg *msg)
|
|
|
|
{
|
|
|
|
if (msg->chan) {
|
|
|
|
free (msg->chan);
|
|
|
|
msg->chan = 0;
|
|
|
|
}
|
|
|
|
if (msg->data) {
|
|
|
|
free (msg->data);
|
|
|
|
msg->data = 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
// COMMUNICATION
|
|
|
|
|
2016-06-07 17:44:18 +02:00
|
|
|
int pubsubd_get_new_process (struct service *srv, struct app_list_elm *ale
|
|
|
|
, struct channels *chans)
|
2016-06-05 20:48:13 +02:00
|
|
|
{
|
2016-06-07 17:44:18 +02:00
|
|
|
if (srv == NULL || ale == NULL || chans == NULL)
|
|
|
|
return -1;
|
|
|
|
|
2016-06-07 11:45:21 +02:00
|
|
|
if (ale->p != NULL) {
|
|
|
|
free (ale->p);
|
2016-06-07 17:44:18 +02:00
|
|
|
ale->p = NULL;
|
2016-06-07 11:45:21 +02:00
|
|
|
}
|
|
|
|
ale->p = malloc (sizeof (struct process));
|
|
|
|
|
|
|
|
char *buf;
|
|
|
|
size_t msize;
|
|
|
|
srv_get_listen_raw (srv, &buf, &msize);
|
|
|
|
|
|
|
|
// parse pubsubd init msg (sent in TMPDIR/<service>)
|
|
|
|
//
|
|
|
|
// line fmt : pid index version chan action
|
2016-06-07 17:44:18 +02:00
|
|
|
// action : quit | pub | sub
|
2016-06-07 11:45:21 +02:00
|
|
|
|
|
|
|
size_t i;
|
|
|
|
char *str, *token, *saveptr;
|
|
|
|
|
|
|
|
pid_t pid;
|
|
|
|
int index;
|
|
|
|
int version;
|
|
|
|
|
2016-06-07 17:44:18 +02:00
|
|
|
char chan[BUFSIZ];
|
|
|
|
bzero (chan, BUFSIZ);
|
|
|
|
|
2016-06-07 11:45:21 +02:00
|
|
|
for (str = buf, i = 1; ; str = NULL, i++) {
|
|
|
|
token = strtok_r(str, " ", &saveptr);
|
|
|
|
if (token == NULL)
|
|
|
|
break;
|
|
|
|
|
|
|
|
switch (i) {
|
|
|
|
case 1 : pid = strtoul(token, NULL, 10); break;
|
|
|
|
case 2 : index = strtoul(token, NULL, 10); break;
|
|
|
|
case 3 : version = strtoul(token, NULL, 10); break;
|
2016-06-07 17:44:18 +02:00
|
|
|
case 4 : {
|
|
|
|
memcpy (chan, token, (strlen (token) < BUFSIZ) ?
|
|
|
|
strlen (token) : BUFSIZ);
|
|
|
|
break;
|
|
|
|
}
|
2016-06-07 11:45:21 +02:00
|
|
|
case 5 : {
|
2016-06-07 17:44:18 +02:00
|
|
|
if (strncmp("both", token, 4) == 0) {
|
|
|
|
ale->action = PUBSUB_BOTH;
|
2016-06-07 11:45:21 +02:00
|
|
|
}
|
2016-06-07 17:44:18 +02:00
|
|
|
else if (strncmp("pub", token, 3) == 0) {
|
|
|
|
ale->action = PUBSUB_PUB;
|
|
|
|
}
|
2016-06-07 11:45:21 +02:00
|
|
|
else if (strncmp("sub", token, 3) == 0) {
|
2016-06-07 17:44:18 +02:00
|
|
|
ale->action = PUBSUB_SUB;
|
2016-06-07 13:49:23 +02:00
|
|
|
}
|
|
|
|
else { // everything else is about killing the service
|
2016-06-07 17:44:18 +02:00
|
|
|
ale->action = PUBSUB_QUIT;
|
2016-06-07 11:45:21 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2016-06-07 17:44:18 +02:00
|
|
|
if (buf != NULL) {
|
|
|
|
free (buf);
|
|
|
|
buf = NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
chan[BUFSIZ -1] = '\0';
|
|
|
|
|
|
|
|
struct channel c;
|
|
|
|
bzero (&c, sizeof (struct channel));
|
|
|
|
c.chan = strndup (chan, BUFSIZ);
|
|
|
|
c.chanlen = strlen (chan);
|
|
|
|
|
|
|
|
struct channel *new_chan;
|
|
|
|
new_chan = pubsubd_channel_get (chans, &c);
|
|
|
|
if (new_chan == NULL) {
|
|
|
|
new_chan = pubsubd_channels_add (chans, &c);
|
|
|
|
pubsubd_subscriber_init (&new_chan->alh);
|
|
|
|
}
|
|
|
|
pubsubd_channel_free (&c);
|
|
|
|
|
2016-06-07 11:45:21 +02:00
|
|
|
srv_process_gen (ale->p, pid, index, version);
|
2016-06-07 17:44:18 +02:00
|
|
|
|
|
|
|
// add the subscriber
|
|
|
|
if (ale->action == PUBSUB_SUB || ale->action == PUBSUB_BOTH)
|
|
|
|
pubsubd_subscriber_add (new_chan->alh, ale);
|
2016-06-07 11:45:21 +02:00
|
|
|
|
|
|
|
return 0;
|
2016-06-05 20:48:13 +02:00
|
|
|
}
|
2016-06-07 11:45:21 +02:00
|
|
|
|
|
|
|
// TODO CBOR
|
|
|
|
int pubsubd_msg_read_cb (FILE *f, char ** buf, size_t * msize)
|
2016-06-05 20:48:13 +02:00
|
|
|
{
|
2016-06-07 11:45:21 +02:00
|
|
|
// msg: "type(1) chanlen(8) chan datalen(8) data
|
|
|
|
|
|
|
|
// read
|
|
|
|
char type;
|
|
|
|
fread (&type, 1, 1, f);
|
|
|
|
|
|
|
|
size_t chanlen;
|
|
|
|
fread (&chanlen, sizeof (size_t), 1, f);
|
|
|
|
|
|
|
|
char *chan = malloc (chanlen);
|
|
|
|
fread (chan, chanlen, 1, f);
|
|
|
|
|
|
|
|
size_t datalen;
|
|
|
|
fread (&datalen, sizeof (size_t), 1, f);
|
|
|
|
|
|
|
|
char *data = malloc (datalen);
|
|
|
|
fread (data, datalen, 1, f);
|
|
|
|
|
|
|
|
*msize = 1 + chanlen;
|
|
|
|
*buf = malloc(*msize);
|
|
|
|
|
|
|
|
// TODO CHECK THIS
|
|
|
|
size_t i = 0;
|
|
|
|
|
|
|
|
char *cbuf = *buf;
|
|
|
|
|
|
|
|
cbuf[i] = type; i++;
|
|
|
|
memcpy (&cbuf[i], &chanlen, sizeof(size_t)); i += sizeof(size_t);
|
|
|
|
memcpy (&cbuf[i], chan, chanlen); i += chanlen;
|
|
|
|
memcpy (&cbuf[i], &datalen, sizeof(size_t)); i += sizeof(size_t);
|
|
|
|
memcpy (&cbuf[i], data, datalen); i += datalen;
|
2016-06-07 17:44:18 +02:00
|
|
|
|
|
|
|
free (chan);
|
|
|
|
free (data);
|
|
|
|
|
2016-06-07 11:45:21 +02:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
void pubsubd_msg_send (const struct app_list_head *alh, const struct pubsub_msg * m)
|
|
|
|
{
|
|
|
|
}
|
|
|
|
void pubsubd_msg_recv (struct process *p, struct pubsub_msg *m)
|
|
|
|
{
|
|
|
|
// read the message from the process
|
|
|
|
size_t mlen;
|
|
|
|
char *buf;
|
|
|
|
srv_read_cb (p, &buf, &mlen, pubsubd_msg_read_cb);
|
|
|
|
|
|
|
|
pubsubd_msg_unserialize (m, buf, mlen);
|
|
|
|
free (buf);
|
2016-06-05 20:48:13 +02:00
|
|
|
}
|
2016-06-07 11:45:21 +02:00
|
|
|
|
|
|
|
void pubsub_msg_send (const struct service *s, const struct pubsub_msg * m)
|
2016-06-05 20:48:13 +02:00
|
|
|
{
|
|
|
|
}
|
2016-06-07 11:45:21 +02:00
|
|
|
void pubsub_msg_recv (const struct service *s, struct pubsub_msg * m)
|
2016-06-05 20:48:13 +02:00
|
|
|
{
|
|
|
|
}
|
|
|
|
|
|
|
|
// SERVICE
|
|
|
|
|
|
|
|
void pubsubd_srv_init ();
|