VILLASnode/src/msg.c

/**
 * Message related functions
 *
 * @author Steffen Vogel <stvogel@eonerc.rwth-aachen.de>
 * @copyright 2014, Institute for Automation of Complex Power Systems, EONERC
 */

#include <stdlib.h>
#include <string.h>
#include <errno.h>
#include <arpa/inet.h>

#include "msg.h"
#include "utils.h"

int msg_fprint(FILE *f, struct msg *msg)
{
	fprintf(f, "%-8u %-8u", msg->device, msg->sequence);

	for (int i = 0; i < msg->length / sizeof(double); i++) {
		fprintf(f, "%-12.6f ", msg->data[i]);
	}

	fprintf(f, "\n");

	return 0;
}

int msg_fscan(FILE *f, struct msg *msg)
{
	fscanf(f, "%8u %8u ", &msg->device, &msg->sequence);

	for (int i = 0; i < msg->length / sizeof(double); i++) {
		fscanf(f, "%12lf ", &msg->data[i]);
	}

	fscanf(f, "\n");

	return 0;
}

void msg_random(struct msg *m)
{
	int values = m->length / sizeof(double);

	for (int i = 0; i < values; i++) {
		m->data[i] += (double) random() / RAND_MAX - .5;
	}

	m->sequence++;
}

int msg_send(struct msg *m, struct node *n)
{
	if (sendto(n->sd, m, m->length + 8, 0,
		(struct sockaddr *) &n->remote,
		sizeof(struct sockaddr_in)) < 0)
		perror("Failed sendto");

	debug(10, "Message sent to node %s (%s:%u)", n->name, inet_ntoa(n->remote.sin_addr), ntohs(n->remote.sin_port));
}

int msg_recv(struct msg *m, struct node *n)
{
	if (recv(n->sd, m, sizeof(struct msg), 0) < 0)
		perror("Failed recv");

	debug(10, "Message received from node %s", n->name);
}