/* Test "client" for the shared memory interface.
 * Busy waits on the incoming queue, prints received samples and writes them
 * back to the other queue. */

#include "config.h"
#include "log.h"
#include "nodes/shmem.h"
#include "pool.h"
#include "queue.h"
#include "sample.h"
#include "sample_io.h"
#include "super_node.h"
#include "utils.h"

#include <string.h>

static struct super_node sn = { .state = STATE_DESTROYED };

void usage()
{
	printf("Usage: villas-shmem CONFIG NODE\n");
	printf("  CONFIG  path to a configuration file\n");
	printf("  NODE    the name of the node which samples should be read from\n");
}

int main(int argc, char* argv[])
{
	if (argc != 3) {
		usage();
		return 1;
	}

	super_node_init(&sn);
	super_node_parse_uri(&sn, argv[1]);

	struct node *node = list_lookup(&sn.nodes, argv[2]);
	if (!node)
		error("Node '%s' does not exist!", argv[2]);

	struct shmem* shm = node->_vd;
	size_t len = shmem_total_size(shm->insize, shm->outsize, shm->sample_size);
	struct shmem_shared *shmem = shmem_int_open(shm->name, len);
	if (!shmem)
		serror("Failed to open shmem interface");

	struct sample *insmps[node->vectorize], *outsmps[node->vectorize];
	while (1) {
		int r, w;
		if (shm->cond_out)
			r = queue_signalled_pull_many(&shmem->out.qs, (void **) insmps, node->vectorize);
		else
			r = queue_pull_many(&shmem->out.q, (void **) insmps, node->vectorize);
		int avail = sample_alloc(&shmem->pool, outsmps, r);
		if (avail < r)
			warn("pool underrun (%d/%d)\n", avail, r);
		for (int i = 0; i < r; i++)
			sample_io_villas_fprint(stdout, insmps[i], SAMPLE_IO_ALL);
		for (int i = 0; i < avail; i++) {
			outsmps[i]->sequence = insmps[i]->sequence;
			outsmps[i]->ts = insmps[i]->ts;
			int len = MIN(insmps[i]->length, outsmps[i]->capacity);
			memcpy(outsmps[i]->data, insmps[i]->data, len*sizeof(insmps[0]->data[0]));
			outsmps[i]->length = len;
		}
		for (int i = 0; i < r; i++)
			sample_put(insmps[i]);
		if (shm->cond_in)
			w = queue_signalled_push_many(&shmem->in.qs, (void **) outsmps, avail);
		else
			w = queue_push_many(&shmem->in.q, (void **) outsmps, avail);
		if (w < avail)
			warn("short write (%d/%d)\n", w, r);
	}
}