2009-12-02 11:08:58 +01:00
|
|
|
/* Filter driver - utility functions */
|
|
|
|
|
|
|
|
#include "inc.h"
|
|
|
|
#include <sys/mman.h>
|
|
|
|
#include <signal.h>
|
|
|
|
|
|
|
|
static clock_t next_alarm;
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* flt_malloc *
|
|
|
|
*===========================================================================*/
|
|
|
|
char *flt_malloc(size_t size, char *sbuf, size_t ssize)
|
|
|
|
{
|
|
|
|
/* Allocate a buffer for 'size' bytes. If 'size' is equal to or less
|
|
|
|
* than 'ssize', return the static buffer 'sbuf', otherwise, use
|
|
|
|
* malloc() to allocate memory dynamically.
|
|
|
|
*/
|
|
|
|
char *p;
|
|
|
|
|
|
|
|
if (size <= ssize)
|
|
|
|
return sbuf;
|
|
|
|
|
2010-02-10 14:56:26 +01:00
|
|
|
if(!(p = alloc_contig(size, 0, NULL)))
|
2010-03-05 16:05:11 +01:00
|
|
|
panic("out of memory: %d", size);
|
2009-12-02 11:08:58 +01:00
|
|
|
|
|
|
|
return p;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* flt_free *
|
|
|
|
*===========================================================================*/
|
2010-04-07 13:25:51 +02:00
|
|
|
void flt_free(char *buf, size_t size, const char *sbuf)
|
2009-12-02 11:08:58 +01:00
|
|
|
{
|
|
|
|
/* Free a buffer previously allocated with flt_malloc().
|
|
|
|
*/
|
|
|
|
|
|
|
|
if(buf != sbuf)
|
2010-02-10 14:56:26 +01:00
|
|
|
free_contig(buf, size);
|
2009-12-02 11:08:58 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
/*===========================================================================*
|
|
|
|
* flt_alarm *
|
|
|
|
*===========================================================================*/
|
|
|
|
clock_t flt_alarm(clock_t dt)
|
|
|
|
{
|
|
|
|
int r;
|
|
|
|
|
|
|
|
if(dt < 0)
|
|
|
|
return next_alarm;
|
|
|
|
|
|
|
|
r = sys_setalarm(dt, 0);
|
|
|
|
|
|
|
|
if(r != OK)
|
2010-03-05 16:05:11 +01:00
|
|
|
panic("sys_setalarm failed: %d", r);
|
2009-12-02 11:08:58 +01:00
|
|
|
|
|
|
|
if(dt == 0) {
|
|
|
|
if(!next_alarm)
|
2010-03-05 16:05:11 +01:00
|
|
|
panic("clearing unset alarm: %d", r);
|
2009-12-02 11:08:58 +01:00
|
|
|
next_alarm = 0;
|
|
|
|
} else {
|
|
|
|
if(next_alarm)
|
2010-03-05 16:05:11 +01:00
|
|
|
panic("overwriting alarm: %d", r);
|
2009-12-02 11:08:58 +01:00
|
|
|
if ((r = getuptime(&next_alarm)) != OK)
|
2010-03-05 16:05:11 +01:00
|
|
|
panic("getuptime failed: %d", r);
|
2009-12-02 11:08:58 +01:00
|
|
|
next_alarm += dt;
|
|
|
|
}
|
|
|
|
|
|
|
|
return next_alarm;
|
|
|
|
}
|
|
|
|
|