/** Hook funktions
 *
 * Every path can register a hook function which is called for every received
 * message. This can be used to debug the data flow, get statistics
 * or alter the message.
 *
 * This file includes some examples.
 *
 * @author Steffen Vogel <stvogel@eonerc.rwth-aachen.de>
 * @copyright 2014-2015, Institute for Automation of Complex Power Systems, EONERC
 *   This file is part of S2SS. All Rights Reserved. Proprietary and confidential.
 *   Unauthorized copying of this file, via any medium is strictly prohibited. 
 *********************************************************************************/

#include <string.h>
#include <time.h>

#include "config.h"
#include "msg.h"
#include "hooks.h"
#include "path.h"
#include "utils.h"

/* The configuration of hook parameters is done in "config.h" */

/* Plausability checks */
#if HOOK_MULTIPLEX_RATIO > POOL_SIZE
 #error "POOL_SIZE is too small for given HOOK_MULTIPLEX_RATIO"
#endif

/** @todo Make const */
static struct hook_id hook_list[] = {
	{ hook_print, "print" },
	{ hook_decimate, "decimate" },
	{ hook_tofixed, "tofixed" },
	{ hook_ts, "ts" },
	{ hook_fir, "fir" },
	{ hook_dft, "dft"}
};

hook_cb_t hook_lookup(const char *name)
{
	for (int i=0; i<ARRAY_LEN(hook_list); i++) {
		if (!strcmp(name, hook_list[i].name))
			return hook_list[i].cb;
	}

	return NULL; /* No matching hook was found */
}
 
int hook_print(struct msg *m, struct path *p, struct timespec *ts)
{
	/* Print every message once to stdout */
	msg_fprint(stdout, m);

	return 0;
}

int hook_tofixed(struct msg *m, struct path *p, struct timespec *ts)
{
	for (int i=0; i<m->length; i++) {
		m->data[i].i = m->data[i].f * 1e3; 
	}
	
	return 0;
}

int hook_ts(struct msg *m, struct path *p, struct timespec *ts)
{
	struct timespec *ts = (struct timespec *) &m->data[HOOK_TS_INDEX];
	
	clock_gettime(CLOCK_REALTIME, ts);
	
	return 0;
}

int hook_fir(struct msg *m, struct path *p, struct timespec *ts)
{
	/** Simple FIR-LP: F_s = 1kHz, F_pass = 100 Hz, F_block = 300
	 * Tip: Use MATLAB's filter design tool and export coefficients
	 *      with the integrated C-Header export */ 
	static const double coeffs[] = {
		-0.003658148158728, -0.008882653268281, 0.008001024183003,
		0.08090485991761,    0.2035239551043,   0.3040703593515,
		0.3040703593515,     0.2035239551043,   0.08090485991761,
		0.008001024183003,  -0.008882653268281,-0.003658148158728 };
	
	/* Accumulator */
	double sum = 0;
	
	/** Trim FIR length to length of history buffer */
	int len = MIN(ARRAY_LEN(coeffs), p->poolsize);

	for (int i=0; i<len; i++) {
		struct msg *old = &p->pool[(p->poolsize+p->received-i) % p->poolsize];
		
		sum += coeffs[i] * old->data[HOOK_FIR_INDEX].f;
	}

	m->data[HOOK_FIR_INDEX].f = sum;

	return 0;
}

int hook_decimate(struct msg *m, struct path *p, struct timespec *ts)
{
	/* Only sent every HOOK_DECIMATE_RATIO'th message */
	return m->sequence % HOOK_DECIMATE_RATIO;
}

/** @todo Implement */
int hook_dft(struct msg *m, struct path *p, struct timespec *ts)
{
	return 0;
}