Blame netem/maketable.c

Packit d3f73b
/*
Packit d3f73b
 * Experimental data  distribution table generator
Packit d3f73b
 * Taken from the uncopyrighted NISTnet code (public domain).
Packit d3f73b
 *
Packit d3f73b
 * Read in a series of "random" data values, either
Packit d3f73b
 * experimentally or generated from some probability distribution.
Packit d3f73b
 * From this, create the inverse distribution table used to approximate
Packit d3f73b
 * the distribution.
Packit d3f73b
 */
Packit d3f73b
#include <stdio.h>
Packit d3f73b
#include <stdlib.h>
Packit d3f73b
#include <math.h>
Packit d3f73b
#include <malloc.h>
Packit d3f73b
#include <string.h>
Packit d3f73b
#include <sys/types.h>
Packit d3f73b
#include <sys/stat.h>
Packit d3f73b
Packit d3f73b
Packit d3f73b
double *
Packit d3f73b
readdoubles(FILE *fp, int *number)
Packit d3f73b
{
Packit d3f73b
	struct stat info;
Packit d3f73b
	double *x;
Packit d3f73b
	int limit;
Packit d3f73b
	int n=0, i;
Packit d3f73b
Packit d3f73b
	if (!fstat(fileno(fp), &info) &&
Packit d3f73b
	    info.st_size > 0) {
Packit d3f73b
		limit = 2*info.st_size/sizeof(double);	/* @@ approximate */
Packit d3f73b
	} else {
Packit d3f73b
		limit = 10000;
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	x = calloc(limit, sizeof(double));
Packit d3f73b
	if (!x) {
Packit d3f73b
		perror("double alloc");
Packit d3f73b
		exit(3);
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	for (i=0; i
Packit d3f73b
		if (fscanf(fp, "%lf", &x[i]) != 1 ||
Packit d3f73b
		    feof(fp))
Packit d3f73b
			break;
Packit d3f73b
		++n;
Packit d3f73b
	}
Packit d3f73b
	*number = n;
Packit d3f73b
	return x;
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
void
Packit d3f73b
arraystats(double *x, int limit, double *mu, double *sigma, double *rho)
Packit d3f73b
{
Packit d3f73b
	int n=0, i;
Packit d3f73b
	double sumsquare=0.0, sum=0.0, top=0.0;
Packit d3f73b
	double sigma2=0.0;
Packit d3f73b
Packit d3f73b
	for (i=0; i
Packit d3f73b
		sumsquare += x[i]*x[i];
Packit d3f73b
		sum += x[i];
Packit d3f73b
		++n;
Packit d3f73b
	}
Packit d3f73b
	*mu = sum/(double)n;
Packit d3f73b
	*sigma = sqrt((sumsquare - (double)n*(*mu)*(*mu))/(double)(n-1));
Packit d3f73b
Packit d3f73b
	for (i=1; i < n; ++i){
Packit d3f73b
		top += ((double)x[i]- *mu)*((double)x[i-1]- *mu);
Packit d3f73b
		sigma2 += ((double)x[i-1] - *mu)*((double)x[i-1] - *mu);
Packit d3f73b
Packit d3f73b
	}
Packit d3f73b
	*rho = top/sigma2;
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
/* Create a (normalized) distribution table from a set of observed
Packit d3f73b
 * values.  The table is fixed to run from (as it happens) -4 to +4,
Packit d3f73b
 * with granularity .00002.
Packit d3f73b
 */
Packit d3f73b
Packit d3f73b
#define TABLESIZE	16384/4
Packit d3f73b
#define TABLEFACTOR	8192
Packit d3f73b
#ifndef MINSHORT
Packit d3f73b
#define MINSHORT	-32768
Packit d3f73b
#define MAXSHORT	32767
Packit d3f73b
#endif
Packit d3f73b
Packit d3f73b
/* Since entries in the inverse are scaled by TABLEFACTOR, and can't be bigger
Packit d3f73b
 * than MAXSHORT, we don't bother looking at a larger domain than this:
Packit d3f73b
 */
Packit d3f73b
#define DISTTABLEDOMAIN ((MAXSHORT/TABLEFACTOR)+1)
Packit d3f73b
#define DISTTABLEGRANULARITY 50000
Packit d3f73b
#define DISTTABLESIZE (DISTTABLEDOMAIN*DISTTABLEGRANULARITY*2)
Packit d3f73b
Packit d3f73b
static int *
Packit d3f73b
makedist(double *x, int limit, double mu, double sigma)
Packit d3f73b
{
Packit d3f73b
	int *table;
Packit d3f73b
	int i, index, first=DISTTABLESIZE, last=0;
Packit d3f73b
	double input;
Packit d3f73b
Packit d3f73b
	table = calloc(DISTTABLESIZE, sizeof(int));
Packit d3f73b
	if (!table) {
Packit d3f73b
		perror("table alloc");
Packit d3f73b
		exit(3);
Packit d3f73b
	}
Packit d3f73b
Packit d3f73b
	for (i=0; i < limit; ++i) {
Packit d3f73b
		/* Normalize value */
Packit d3f73b
		input = (x[i]-mu)/sigma;
Packit d3f73b
Packit d3f73b
		index = (int)rint((input+DISTTABLEDOMAIN)*DISTTABLEGRANULARITY);
Packit d3f73b
		if (index < 0) index = 0;
Packit d3f73b
		if (index >= DISTTABLESIZE) index = DISTTABLESIZE-1;
Packit d3f73b
		++table[index];
Packit d3f73b
		if (index > last)
Packit d3f73b
			last = index +1;
Packit d3f73b
		if (index < first)
Packit d3f73b
			first = index;
Packit d3f73b
	}
Packit d3f73b
	return table;
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
/* replace an array by its cumulative distribution */
Packit d3f73b
static void
Packit d3f73b
cumulativedist(int *table, int limit, int *total)
Packit d3f73b
{
Packit d3f73b
	int accum=0;
Packit d3f73b
Packit d3f73b
	while (--limit >= 0) {
Packit d3f73b
		accum += *table;
Packit d3f73b
		*table++ = accum;
Packit d3f73b
	}
Packit d3f73b
	*total = accum;
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static short *
Packit d3f73b
inverttable(int *table, int inversesize, int tablesize, int cumulative)
Packit d3f73b
{
Packit d3f73b
	int i, inverseindex, inversevalue;
Packit d3f73b
	short *inverse;
Packit d3f73b
	double findex, fvalue;
Packit d3f73b
Packit d3f73b
	inverse = (short *)malloc(inversesize*sizeof(short));
Packit d3f73b
	for (i=0; i < inversesize; ++i) {
Packit d3f73b
		inverse[i] = MINSHORT;
Packit d3f73b
	}
Packit d3f73b
	for (i=0; i < tablesize; ++i) {
Packit d3f73b
		findex = ((double)i/(double)DISTTABLEGRANULARITY) - DISTTABLEDOMAIN;
Packit d3f73b
		fvalue = (double)table[i]/(double)cumulative;
Packit d3f73b
		inverseindex = (int)rint(fvalue*inversesize);
Packit d3f73b
		inversevalue = (int)rint(findex*TABLEFACTOR);
Packit d3f73b
		if (inversevalue <= MINSHORT) inversevalue = MINSHORT+1;
Packit d3f73b
		if (inversevalue > MAXSHORT) inversevalue = MAXSHORT;
Packit d3f73b
		if (inverseindex >= inversesize) inverseindex = inversesize- 1;
Packit d3f73b
Packit d3f73b
		inverse[inverseindex] = inversevalue;
Packit d3f73b
	}
Packit d3f73b
	return inverse;
Packit d3f73b
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
/* Run simple linear interpolation over the table to fill in missing entries */
Packit d3f73b
static void
Packit d3f73b
interpolatetable(short *table, int limit)
Packit d3f73b
{
Packit d3f73b
	int i, j, last, lasti = -1;
Packit d3f73b
Packit d3f73b
	last = MINSHORT;
Packit d3f73b
	for (i=0; i < limit; ++i) {
Packit d3f73b
		if (table[i] == MINSHORT) {
Packit d3f73b
			for (j=i; j < limit; ++j)
Packit d3f73b
				if (table[j] != MINSHORT)
Packit d3f73b
					break;
Packit d3f73b
			if (j < limit) {
Packit d3f73b
				table[i] = last + (i-lasti)*(table[j]-last)/(j-lasti);
Packit d3f73b
			} else {
Packit d3f73b
				table[i] = last + (i-lasti)*(MAXSHORT-last)/(limit-lasti);
Packit d3f73b
			}
Packit d3f73b
		} else {
Packit d3f73b
			last = table[i];
Packit d3f73b
			lasti = i;
Packit d3f73b
		}
Packit d3f73b
	}
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
static void
Packit d3f73b
printtable(const short *table, int limit)
Packit d3f73b
{
Packit d3f73b
	int i;
Packit d3f73b
Packit d3f73b
	printf("# This is the distribution table for the experimental distribution.\n");
Packit d3f73b
Packit d3f73b
	for (i=0 ; i < limit; ++i) {
Packit d3f73b
		printf("%d%c", table[i],
Packit d3f73b
		       (i % 8) == 7 ? '\n' : ' ');
Packit d3f73b
	}
Packit d3f73b
}
Packit d3f73b
Packit d3f73b
int
Packit d3f73b
main(int argc, char **argv)
Packit d3f73b
{
Packit d3f73b
	FILE *fp;
Packit d3f73b
	double *x;
Packit d3f73b
	double mu, sigma, rho;
Packit d3f73b
	int limit;
Packit d3f73b
	int *table;
Packit d3f73b
	short *inverse;
Packit d3f73b
	int total;
Packit d3f73b
Packit d3f73b
	if (argc > 1) {
Packit d3f73b
		if (!(fp = fopen(argv[1], "r"))) {
Packit d3f73b
			perror(argv[1]);
Packit d3f73b
			exit(1);
Packit d3f73b
		}
Packit d3f73b
	} else {
Packit d3f73b
		fp = stdin;
Packit d3f73b
	}
Packit d3f73b
	x = readdoubles(fp, &limit);
Packit d3f73b
	if (limit <= 0) {
Packit d3f73b
		fprintf(stderr, "Nothing much read!\n");
Packit d3f73b
		exit(2);
Packit d3f73b
	}
Packit d3f73b
	arraystats(x, limit, &mu, &sigma, &rho);
Packit d3f73b
#ifdef DEBUG
Packit d3f73b
	fprintf(stderr, "%d values, mu %10.4f, sigma %10.4f, rho %10.4f\n",
Packit d3f73b
		limit, mu, sigma, rho);
Packit d3f73b
#endif
Packit d3f73b
Packit d3f73b
	table = makedist(x, limit, mu, sigma);
Packit d3f73b
	free((void *) x);
Packit d3f73b
	cumulativedist(table, DISTTABLESIZE, &total);
Packit d3f73b
	inverse = inverttable(table, TABLESIZE, DISTTABLESIZE, total);
Packit d3f73b
	interpolatetable(inverse, TABLESIZE);
Packit d3f73b
	printtable(inverse, TABLESIZE);
Packit d3f73b
	return 0;
Packit d3f73b
}