mirror of
https://git.rwth-aachen.de/acs/public/villas/node/
synced 2025-03-16 00:00:02 +01:00
115 lines
No EOL
3 KiB
C
115 lines
No EOL
3 KiB
C
/** 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;
|
|
} |