/*
 * Copyright (C) 2016 by Argonne National Laboratory.
 *
 * This software is available to you under a choice of one of two
 * licenses.  You may choose to be licensed under the terms of the GNU
 * General Public License (GPL) Version 2, available from the file
 * COPYING in the main directory of this source tree, or the
 * BSD license below:
 *
 *     Redistribution and use in source and binary forms, with or
 *     without modification, are permitted provided that the following
 *     conditions are met:
 *
 *      - Redistributions of source code must retain the above
 *        copyright notice, this list of conditions and the following
 *        disclaimer.
 *
 *      - Redistributions in binary form must reproduce the above
 *        copyright notice, this list of conditions and the following
 *        disclaimer in the documentation and/or other materials
 *        provided with the distribution.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
 * SOFTWARE.
 */

#include <pthread.h>

#include "fi_bgq_spi.h"
#include "cq_agent.h"
#include "fi_bgq_memfifo.h"

#define N_PRODUCERS 16
#define N_PACKETS (0x01 << 16)

struct memfifo mfifo;
struct memfifo_producer producer[N_PRODUCERS];
pthread_t info[N_PRODUCERS];

struct l2atomic_barrier barrier;

static
void * producer_fn (void *arg) {

	uint16_t id = (uint16_t)((uintptr_t)arg);

	unsigned i;
	for (i=0; i<2; i++) {
	        l2atomic_barrier(&barrier);
		unsigned production_count = N_PACKETS;
		while (production_count > 0) {
			if (0 == memfifo_produce16(&producer[id], id+1)) --production_count;
		}
	}

	return NULL;
}

void test_init_fn (void *buffer, uintptr_t cookie) {

	uint64_t *ptr = (uint64_t *) buffer;
	*ptr = cookie;
}

int main (int argc, char *argv[]) {

	struct l2atomic l2atomic;
	memset((void*)&l2atomic, 0, sizeof(l2atomic));

	int rc, lineno;
	rc = l2atomic_init(&l2atomic); lineno = __LINE__;
	if (rc) goto err;

	struct memfifo mfifo;
	rc = memfifo_initialize(&l2atomic, "some name", &mfifo, 0); lineno = __LINE__;
	if (rc) goto err;

        rc = l2atomic_barrier_alloc_generic(&l2atomic, &barrier, N_PRODUCERS+1, "barrier_test"); lineno = __LINE__;
        if (rc) goto err;
	/* create 'producer' threads */
	uintptr_t pid;
	unsigned production_count[N_PRODUCERS];
	for (pid = 0; pid < N_PRODUCERS; ++pid) {
		producer[pid] = mfifo.producer;
		production_count[pid] = 0;
		if (pthread_create(&info[pid], NULL, &producer_fn, (void*)pid)) { lineno = __LINE__; goto err; }
	}
	unsigned expected_packet_count = N_PRODUCERS * N_PACKETS;
	uint16_t id;
	unsigned i;
	uint64_t total_time;
	for (i=0; i<2; i++) {
        	l2atomic_barrier(&barrier);
	        uint64_t start_time = GetTimeBase();
		unsigned consumption_count = 0;
		while (consumption_count < expected_packet_count) {
			if (0 == memfifo_consume16(&mfifo.consumer, &id)) {
				++consumption_count;
			}
		}
        	uint64_t end_time = GetTimeBase();
		total_time = end_time - start_time;
	}

	fprintf(stdout, "total cycles: %lu\n", total_time);

	double cycles_per_producer = (double)total_time / (double)N_PRODUCERS;
	fprintf(stdout, "cycles/producer: %f\n", cycles_per_producer);

	double cycles_per_write = cycles_per_producer / (double)N_PACKETS;
	fprintf(stdout, "write: %d (cycles)\n", (unsigned)cycles_per_write);
	fprintf(stdout, "write: %0.04f (usec)\n", cycles_per_write / 1600.0);

	fprintf (stdout, "TEST SUCCESSFUL\n");
	return 0;
err:
	fprintf (stderr, "%s: Error at line %d\n", __FILE__, lineno);
	return 1;
}