1.1 --- /dev/null	Thu Jan 01 00:00:00 1970 +0000
     1.2 +++ b/libs/vmath/vmath.c	Sun Sep 29 08:20:19 2013 +0300
     1.3 @@ -0,0 +1,336 @@
     1.4 +/*
     1.5 +libvmath - a vector math library
     1.6 +Copyright (C) 2004-2011 John Tsiombikas <nuclear@member.fsf.org>
     1.7 +
     1.8 +This program is free software: you can redistribute it and/or modify
     1.9 +it under the terms of the GNU Lesser General Public License as published
    1.10 +by the Free Software Foundation, either version 3 of the License, or
    1.11 +(at your option) any later version.
    1.12 +
    1.13 +This program is distributed in the hope that it will be useful,
    1.14 +but WITHOUT ANY WARRANTY; without even the implied warranty of
    1.15 +MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    1.16 +GNU Lesser General Public License for more details.
    1.17 +
    1.18 +You should have received a copy of the GNU Lesser General Public License
    1.19 +along with this program.  If not, see <http://www.gnu.org/licenses/>.
    1.20 +*/
    1.21 +
    1.22 +#include <stdlib.h>
    1.23 +#include <math.h>
    1.24 +#include "vmath.h"
    1.25 +
    1.26 +/** Numerical calculation of integrals using simpson's rule */
    1.27 +scalar_t integral(scalar_t (*f)(scalar_t), scalar_t low, scalar_t high, int samples)
    1.28 +{
    1.29 +	int i;
    1.30 +	scalar_t h = (high - low) / (scalar_t)samples;
    1.31 +	scalar_t sum = 0.0;
    1.32 +
    1.33 +	for(i=0; i<samples+1; i++) {
    1.34 +		scalar_t y = f((scalar_t)i * h + low);
    1.35 +		sum += ((!i || i == samples) ? y : ((i % 2) ? 4.0 * y : 2.0 * y)) * (h / 3.0);
    1.36 +	}
    1.37 +	return sum;
    1.38 +}
    1.39 +
    1.40 +/** Gaussuan function */
    1.41 +scalar_t gaussian(scalar_t x, scalar_t mean, scalar_t sdev)
    1.42 +{
    1.43 +	scalar_t exponent = -SQ(x - mean) / (2.0 * SQ(sdev));
    1.44 +	return 1.0 - -pow(M_E, exponent) / (sdev * sqrt(TWO_PI));
    1.45 +}
    1.46 +
    1.47 +
    1.48 +/** b-spline approximation */
    1.49 +scalar_t bspline(scalar_t a, scalar_t b, scalar_t c, scalar_t d, scalar_t t)
    1.50 +{
    1.51 +	vec4_t tmp;
    1.52 +	scalar_t tsq = t * t;
    1.53 +
    1.54 +	static mat4_t bspline_mat = {
    1.55 +		{-1,  3, -3,  1},
    1.56 +		{3, -6,  3,  0},
    1.57 +		{-3,  0,  3,  0},
    1.58 +		{1,  4,  1,  0}
    1.59 +	};
    1.60 +
    1.61 +	tmp = v4_scale(v4_transform(v4_cons(a, b, c, d), bspline_mat), 1.0 / 6.0);
    1.62 +	return v4_dot(v4_cons(tsq * t, tsq, t, 1.0), tmp);
    1.63 +}
    1.64 +
    1.65 +/** Catmull-rom spline interpolation */
    1.66 +scalar_t spline(scalar_t a, scalar_t b, scalar_t c, scalar_t d, scalar_t t)
    1.67 +{
    1.68 +	vec4_t tmp;
    1.69 +	scalar_t tsq = t * t;
    1.70 +
    1.71 +	static mat4_t crspline_mat = {
    1.72 +		{-1,  3, -3,  1},
    1.73 +		{2, -5,  4, -1},
    1.74 +		{-1,  0,  1,  0},
    1.75 +		{0,  2,  0,  0}
    1.76 +	};
    1.77 +
    1.78 +	tmp = v4_scale(v4_transform(v4_cons(a, b, c, d), crspline_mat), 0.5);
    1.79 +	return v4_dot(v4_cons(tsq * t, tsq, t, 1.0), tmp);
    1.80 +}
    1.81 +
    1.82 +/** Bezier interpolation */
    1.83 +scalar_t bezier(scalar_t a, scalar_t b, scalar_t c, scalar_t d, scalar_t t)
    1.84 +{
    1.85 +	scalar_t omt, omt3, t3, f;
    1.86 +	t3 = t * t * t;
    1.87 +	omt = 1.0f - t;
    1.88 +	omt3 = omt * omt * omt;
    1.89 +	f = 3 * t * omt;
    1.90 +
    1.91 +	return (a * omt3) + (b * f * omt) + (c * f * t) + (d * t3);
    1.92 +}
    1.93 +
    1.94 +/* ---- Ken Perlin's implementation of noise ---- */
    1.95 +
    1.96 +#define B	0x100
    1.97 +#define BM	0xff
    1.98 +#define N	0x1000
    1.99 +#define NP	12   /* 2^N */
   1.100 +#define NM	0xfff
   1.101 +
   1.102 +#define s_curve(t) (t * t * (3.0f - 2.0f * t))
   1.103 +
   1.104 +#define setup(elem, b0, b1, r0, r1) \
   1.105 +	do {							\
   1.106 +		scalar_t t = elem + N;		\
   1.107 +		b0 = ((int)t) & BM;			\
   1.108 +		b1 = (b0 + 1) & BM;			\
   1.109 +		r0 = t - (int)t;			\
   1.110 +		r1 = r0 - 1.0f;				\
   1.111 +	} while(0)
   1.112 +
   1.113 +
   1.114 +static int perm[B + B + 2];			/* permuted index from g_n onto themselves */
   1.115 +static vec3_t grad3[B + B + 2];		/* 3D random gradients */
   1.116 +static vec2_t grad2[B + B + 2];		/* 2D random gradients */
   1.117 +static scalar_t grad1[B + B + 2];	/* 1D random ... slopes */
   1.118 +static int tables_valid;
   1.119 +
   1.120 +static void init_noise()
   1.121 +{
   1.122 +	int i;
   1.123 +
   1.124 +	/* calculate random gradients */
   1.125 +	for(i=0; i<B; i++) {
   1.126 +		perm[i] = i;	/* .. and initialize permutation mapping to identity */
   1.127 +
   1.128 +		grad1[i] = (scalar_t)((rand() % (B + B)) - B) / B;
   1.129 +
   1.130 +		grad2[i].x = (scalar_t)((rand() % (B + B)) - B) / B;
   1.131 +		grad2[i].y = (scalar_t)((rand() % (B + B)) - B) / B;
   1.132 +		grad2[i] = v2_normalize(grad2[i]);
   1.133 +
   1.134 +		grad3[i].x = (scalar_t)((rand() % (B + B)) - B) / B;
   1.135 +		grad3[i].y = (scalar_t)((rand() % (B + B)) - B) / B;
   1.136 +		grad3[i].z = (scalar_t)((rand() % (B + B)) - B) / B;
   1.137 +		grad3[i] = v3_normalize(grad3[i]);
   1.138 +	}
   1.139 +
   1.140 +	/* permute indices by swapping them randomly */
   1.141 +	for(i=0; i<B; i++) {
   1.142 +		int rand_idx = rand() % B;
   1.143 +
   1.144 +		int tmp = perm[i];
   1.145 +		perm[i] = perm[rand_idx];
   1.146 +		perm[rand_idx] = tmp;
   1.147 +	}
   1.148 +
   1.149 +	/* fill up the rest of the arrays by duplicating the existing gradients */
   1.150 +	/* and permutations */
   1.151 +	for(i=0; i<B+2; i++) {
   1.152 +		perm[B + i] = perm[i];
   1.153 +		grad1[B + i] = grad1[i];
   1.154 +		grad2[B + i] = grad2[i];
   1.155 +		grad3[B + i] = grad3[i];
   1.156 +	}
   1.157 +}
   1.158 +
   1.159 +scalar_t noise1(scalar_t x)
   1.160 +{
   1.161 +	int bx0, bx1;
   1.162 +	scalar_t rx0, rx1, sx, u, v;
   1.163 +
   1.164 +	if(!tables_valid) {
   1.165 +		init_noise();
   1.166 +		tables_valid = 1;
   1.167 +	}
   1.168 +
   1.169 +	setup(x, bx0, bx1, rx0, rx1);
   1.170 +	sx = s_curve(rx0);
   1.171 +	u = rx0 * grad1[perm[bx0]];
   1.172 +	v = rx1 * grad1[perm[bx1]];
   1.173 +
   1.174 +	return lerp(u, v, sx);
   1.175 +}
   1.176 +
   1.177 +scalar_t noise2(scalar_t x, scalar_t y)
   1.178 +{
   1.179 +	int i, j, b00, b10, b01, b11;
   1.180 +	int bx0, bx1, by0, by1;
   1.181 +	scalar_t rx0, rx1, ry0, ry1;
   1.182 +	scalar_t sx, sy, u, v, a, b;
   1.183 +
   1.184 +	if(!tables_valid) {
   1.185 +		init_noise();
   1.186 +		tables_valid = 1;
   1.187 +	}
   1.188 +
   1.189 +	setup(x, bx0, bx1, rx0, rx1);
   1.190 +	setup(y, by0, by1, ry0, ry1);
   1.191 +
   1.192 +	i = perm[bx0];
   1.193 +	j = perm[bx1];
   1.194 +
   1.195 +	b00 = perm[i + by0];
   1.196 +	b10 = perm[j + by0];
   1.197 +	b01 = perm[i + by1];
   1.198 +	b11 = perm[j + by1];
   1.199 +
   1.200 +	/* calculate hermite inteprolating factors */
   1.201 +	sx = s_curve(rx0);
   1.202 +	sy = s_curve(ry0);
   1.203 +
   1.204 +	/* interpolate along the left edge */
   1.205 +	u = v2_dot(grad2[b00], v2_cons(rx0, ry0));
   1.206 +	v = v2_dot(grad2[b10], v2_cons(rx1, ry0));
   1.207 +	a = lerp(u, v, sx);
   1.208 +
   1.209 +	/* interpolate along the right edge */
   1.210 +	u = v2_dot(grad2[b01], v2_cons(rx0, ry1));
   1.211 +	v = v2_dot(grad2[b11], v2_cons(rx1, ry1));
   1.212 +	b = lerp(u, v, sx);
   1.213 +
   1.214 +	/* interpolate between them */
   1.215 +	return lerp(a, b, sy);
   1.216 +}
   1.217 +
   1.218 +scalar_t noise3(scalar_t x, scalar_t y, scalar_t z)
   1.219 +{
   1.220 +	int i, j;
   1.221 +	int bx0, bx1, by0, by1, bz0, bz1;
   1.222 +	int b00, b10, b01, b11;
   1.223 +	scalar_t rx0, rx1, ry0, ry1, rz0, rz1;
   1.224 +	scalar_t sx, sy, sz;
   1.225 +	scalar_t u, v, a, b, c, d;
   1.226 +
   1.227 +	if(!tables_valid) {
   1.228 +		init_noise();
   1.229 +		tables_valid = 1;
   1.230 +	}
   1.231 +
   1.232 +	setup(x, bx0, bx1, rx0, rx1);
   1.233 +	setup(y, by0, by1, ry0, ry1);
   1.234 +	setup(z, bz0, bz1, rz0, rz1);
   1.235 +
   1.236 +	i = perm[bx0];
   1.237 +	j = perm[bx1];
   1.238 +
   1.239 +	b00 = perm[i + by0];
   1.240 +	b10 = perm[j + by0];
   1.241 +	b01 = perm[i + by1];
   1.242 +	b11 = perm[j + by1];
   1.243 +
   1.244 +	/* calculate hermite interpolating factors */
   1.245 +	sx = s_curve(rx0);
   1.246 +	sy = s_curve(ry0);
   1.247 +	sz = s_curve(rz0);
   1.248 +
   1.249 +	/* interpolate along the top slice of the cell */
   1.250 +	u = v3_dot(grad3[b00 + bz0], v3_cons(rx0, ry0, rz0));
   1.251 +	v = v3_dot(grad3[b10 + bz0], v3_cons(rx1, ry0, rz0));
   1.252 +	a = lerp(u, v, sx);
   1.253 +
   1.254 +	u = v3_dot(grad3[b01 + bz0], v3_cons(rx0, ry1, rz0));
   1.255 +	v = v3_dot(grad3[b11 + bz0], v3_cons(rx1, ry1, rz0));
   1.256 +	b = lerp(u, v, sx);
   1.257 +
   1.258 +	c = lerp(a, b, sy);
   1.259 +
   1.260 +	/* interpolate along the bottom slice of the cell */
   1.261 +	u = v3_dot(grad3[b00 + bz0], v3_cons(rx0, ry0, rz1));
   1.262 +	v = v3_dot(grad3[b10 + bz0], v3_cons(rx1, ry0, rz1));
   1.263 +	a = lerp(u, v, sx);
   1.264 +
   1.265 +	u = v3_dot(grad3[b01 + bz0], v3_cons(rx0, ry1, rz1));
   1.266 +	v = v3_dot(grad3[b11 + bz0], v3_cons(rx1, ry1, rz1));
   1.267 +	b = lerp(u, v, sx);
   1.268 +
   1.269 +	d = lerp(a, b, sy);
   1.270 +
   1.271 +	/* interpolate between slices */
   1.272 +	return lerp(c, d, sz);
   1.273 +}
   1.274 +
   1.275 +scalar_t fbm1(scalar_t x, int octaves)
   1.276 +{
   1.277 +	int i;
   1.278 +	scalar_t res = 0.0f, freq = 1.0f;
   1.279 +	for(i=0; i<octaves; i++) {
   1.280 +		res += noise1(x * freq) / freq;
   1.281 +		freq *= 2.0f;
   1.282 +	}
   1.283 +	return res;
   1.284 +}
   1.285 +
   1.286 +scalar_t fbm2(scalar_t x, scalar_t y, int octaves)
   1.287 +{
   1.288 +	int i;
   1.289 +	scalar_t res = 0.0f, freq = 1.0f;
   1.290 +	for(i=0; i<octaves; i++) {
   1.291 +		res += noise2(x * freq, y * freq) / freq;
   1.292 +		freq *= 2.0f;
   1.293 +	}
   1.294 +	return res;
   1.295 +}
   1.296 +
   1.297 +scalar_t fbm3(scalar_t x, scalar_t y, scalar_t z, int octaves)
   1.298 +{
   1.299 +	int i;
   1.300 +	scalar_t res = 0.0f, freq = 1.0f;
   1.301 +	for(i=0; i<octaves; i++) {
   1.302 +		res += noise3(x * freq, y * freq, z * freq) / freq;
   1.303 +		freq *= 2.0f;
   1.304 +	}
   1.305 +	return res;
   1.306 +}
   1.307 +
   1.308 +scalar_t turbulence1(scalar_t x, int octaves)
   1.309 +{
   1.310 +	int i;
   1.311 +	scalar_t res = 0.0f, freq = 1.0f;
   1.312 +	for(i=0; i<octaves; i++) {
   1.313 +		res += fabs(noise1(x * freq) / freq);
   1.314 +		freq *= 2.0f;
   1.315 +	}
   1.316 +	return res;
   1.317 +}
   1.318 +
   1.319 +scalar_t turbulence2(scalar_t x, scalar_t y, int octaves)
   1.320 +{
   1.321 +	int i;
   1.322 +	scalar_t res = 0.0f, freq = 1.0f;
   1.323 +	for(i=0; i<octaves; i++) {
   1.324 +		res += fabs(noise2(x * freq, y * freq) / freq);
   1.325 +		freq *= 2.0f;
   1.326 +	}
   1.327 +	return res;
   1.328 +}
   1.329 +
   1.330 +scalar_t turbulence3(scalar_t x, scalar_t y, scalar_t z, int octaves)
   1.331 +{
   1.332 +	int i;
   1.333 +	scalar_t res = 0.0f, freq = 1.0f;
   1.334 +	for(i=0; i<octaves; i++) {
   1.335 +		res += fabs(noise3(x * freq, y * freq, z * freq) / freq);
   1.336 +		freq *= 2.0f;
   1.337 +	}
   1.338 +	return res;
   1.339 +}