Files
argyllcms/rspl/t3d.c
2026-08-20 20:28:40 +01:00

900 lines
25 KiB
C

/************************************************/
/* Test RSPL in 3D */
/************************************************/
/* Author: Graeme Gill
* Date: 22/4/96
* Derived from cmatch.c
* Copyright 1995 Graeme W. Gill
*
* This material is licenced under the GNU AFFERO GENERAL PUBLIC LICENSE Version 3 :-
* see the License.txt file for licencing details.
*/
#define DEBUG
#define DETAILED
#include <stdio.h>
#include <stdlib.h>
#include <fcntl.h>
#include <math.h>
#include "aconfig.h"
#include "rspl.h"
#include "tiffio.h"
#include "plot.h"
#include "ui.h"
#ifdef NEVER
#define INTERP spline_interp
#else
#define INTERP interp
#endif
#ifdef NEVER
FILE *verbose_out = stdout;
int verbose_level = 6; /* Current verbosity level */
/* 0 = none */
/* !0 = diagnostics */
#endif /* NEVER */
#define PLOTRES 256
#define WIDTH 400 /* Raster size */
#define HEIGHT 400
#define MAX_ITS 500
#define IT_TOL 0.0005
#define GRES0 33 /* Default rspl resolutions */
#define GRES1 33
#define GRES2 33
#undef NEVER
#define ALWAYS
//double t1xa[PNTS] = { 0.2, 0.25, 0.30, 0.35, 0.40, 0.44, 0.48, 0.51, 0.64, 0.75 };
//double t1ya[PNTS] = { 0.3, 0.35, 0.4, 0.41, 0.42, 0.46, 0.5, 0.575, 0.48, 0.75 };
/* 1D test function repeated 3 times along x = y = 0.5 */
co test_points1[] = {
{{ 0.4,0.4,0.20 },{ 0.30 }}, /* 0 */
{{ 0.4,0.4,0.25 },{ 0.35 }}, /* 1 */
{{ 0.4,0.4,0.30 },{ 0.40 }}, /* 2 */
{{ 0.4,0.4,0.35 },{ 0.41 }}, /* 3 */
{{ 0.4,0.4,0.40 },{ 0.42 }}, /* 4 */
{{ 0.4,0.4,0.44 },{ 0.46 }}, /* 5 */
{{ 0.4,0.4,0.48 },{ 0.50 }}, /* 6 */
{{ 0.4,0.4,0.51 },{ 0.575 }}, /* 7 */
{{ 0.4,0.4,0.64 },{ 0.48 }}, /* 8 */
{{ 0.4,0.4,0.75 },{ 0.75 }}, /* 9 */
{{ 0.5,0.4,0.20 },{ 0.30 }}, /* 0 */
{{ 0.5,0.4,0.25 },{ 0.35 }}, /* 1 */
{{ 0.5,0.4,0.30 },{ 0.40 }}, /* 2 */
{{ 0.5,0.4,0.35 },{ 0.41 }}, /* 3 */
{{ 0.5,0.4,0.40 },{ 0.42 }}, /* 4 */
{{ 0.5,0.4,0.44 },{ 0.46 }}, /* 5 */
{{ 0.5,0.4,0.48 },{ 0.50 }}, /* 6 */
{{ 0.5,0.4,0.51 },{ 0.575 }}, /* 7 */
{{ 0.5,0.4,0.64 },{ 0.48 }}, /* 8 */
{{ 0.5,0.4,0.75 },{ 0.75 }}, /* 9 */
{{ 0.6,0.4,0.20 },{ 0.30 }}, /* 0 */
{{ 0.6,0.4,0.25 },{ 0.35 }}, /* 1 */
{{ 0.6,0.4,0.30 },{ 0.40 }}, /* 2 */
{{ 0.6,0.4,0.35 },{ 0.41 }}, /* 3 */
{{ 0.6,0.4,0.40 },{ 0.42 }}, /* 4 */
{{ 0.6,0.4,0.44 },{ 0.46 }}, /* 5 */
{{ 0.6,0.4,0.48 },{ 0.50 }}, /* 6 */
{{ 0.6,0.4,0.51 },{ 0.575 }}, /* 7 */
{{ 0.6,0.4,0.64 },{ 0.48 }}, /* 8 */
{{ 0.6,0.4,0.75 },{ 0.75 }}, /* 9 */
{{ 0.4,0.5,0.20 },{ 0.30 }}, /* 0 */
{{ 0.4,0.5,0.25 },{ 0.35 }}, /* 1 */
{{ 0.4,0.5,0.30 },{ 0.40 }}, /* 2 */
{{ 0.4,0.5,0.35 },{ 0.41 }}, /* 3 */
{{ 0.4,0.5,0.40 },{ 0.42 }}, /* 4 */
{{ 0.4,0.5,0.44 },{ 0.46 }}, /* 5 */
{{ 0.4,0.5,0.48 },{ 0.50 }}, /* 6 */
{{ 0.4,0.5,0.51 },{ 0.575 }}, /* 7 */
{{ 0.4,0.5,0.64 },{ 0.48 }}, /* 8 */
{{ 0.4,0.5,0.75 },{ 0.75 }}, /* 9 */
{{ 0.5,0.5,0.20 },{ 0.30 }}, /* 0 */
{{ 0.5,0.5,0.25 },{ 0.35 }}, /* 1 */
{{ 0.5,0.5,0.30 },{ 0.40 }}, /* 2 */
{{ 0.5,0.5,0.35 },{ 0.41 }}, /* 3 */
{{ 0.5,0.5,0.40 },{ 0.42 }}, /* 4 */
{{ 0.5,0.5,0.44 },{ 0.46 }}, /* 5 */
{{ 0.5,0.5,0.48 },{ 0.50 }}, /* 6 */
{{ 0.5,0.5,0.51 },{ 0.575 }}, /* 7 */
{{ 0.5,0.5,0.64 },{ 0.48 }}, /* 8 */
{{ 0.5,0.5,0.75 },{ 0.75 }}, /* 9 */
{{ 0.6,0.5,0.20 },{ 0.30 }}, /* 0 */
{{ 0.6,0.5,0.25 },{ 0.35 }}, /* 1 */
{{ 0.6,0.5,0.30 },{ 0.40 }}, /* 2 */
{{ 0.6,0.5,0.35 },{ 0.41 }}, /* 3 */
{{ 0.6,0.5,0.40 },{ 0.42 }}, /* 4 */
{{ 0.6,0.5,0.44 },{ 0.46 }}, /* 5 */
{{ 0.6,0.5,0.48 },{ 0.50 }}, /* 6 */
{{ 0.6,0.5,0.51 },{ 0.575 }}, /* 7 */
{{ 0.6,0.5,0.64 },{ 0.48 }}, /* 8 */
{{ 0.6,0.5,0.75 },{ 0.75 }}, /* 9 */
{{ 0.4,0.6,0.20 },{ 0.30 }}, /* 0 */
{{ 0.4,0.6,0.25 },{ 0.35 }}, /* 1 */
{{ 0.4,0.6,0.30 },{ 0.40 }}, /* 2 */
{{ 0.4,0.6,0.35 },{ 0.41 }}, /* 3 */
{{ 0.4,0.6,0.40 },{ 0.42 }}, /* 4 */
{{ 0.4,0.6,0.44 },{ 0.46 }}, /* 5 */
{{ 0.4,0.6,0.48 },{ 0.50 }}, /* 6 */
{{ 0.4,0.6,0.51 },{ 0.575 }}, /* 7 */
{{ 0.4,0.6,0.64 },{ 0.48 }}, /* 8 */
{{ 0.4,0.6,0.75 },{ 0.75 }}, /* 9 */
{{ 0.5,0.6,0.20 },{ 0.30 }}, /* 0 */
{{ 0.5,0.6,0.25 },{ 0.35 }}, /* 1 */
{{ 0.5,0.6,0.30 },{ 0.40 }}, /* 2 */
{{ 0.5,0.6,0.35 },{ 0.41 }}, /* 3 */
{{ 0.5,0.6,0.40 },{ 0.42 }}, /* 4 */
{{ 0.5,0.6,0.44 },{ 0.46 }}, /* 5 */
{{ 0.5,0.6,0.48 },{ 0.50 }}, /* 6 */
{{ 0.5,0.6,0.51 },{ 0.575 }}, /* 7 */
{{ 0.5,0.6,0.64 },{ 0.48 }}, /* 8 */
{{ 0.5,0.6,0.75 },{ 0.75 }}, /* 9 */
{{ 0.6,0.6,0.20 },{ 0.30 }}, /* 0 */
{{ 0.6,0.6,0.25 },{ 0.35 }}, /* 1 */
{{ 0.6,0.6,0.30 },{ 0.40 }}, /* 2 */
{{ 0.6,0.6,0.35 },{ 0.41 }}, /* 3 */
{{ 0.6,0.6,0.40 },{ 0.42 }}, /* 4 */
{{ 0.6,0.6,0.44 },{ 0.46 }}, /* 5 */
{{ 0.6,0.6,0.48 },{ 0.50 }}, /* 6 */
{{ 0.6,0.6,0.51 },{ 0.575 }}, /* 7 */
{{ 0.6,0.6,0.64 },{ 0.48 }}, /* 8 */
{{ 0.6,0.6,0.75 },{ 0.75 }} /* 9 */
};
/* function */
co test_points2[] = {
{{ 0.50915, 0.50936, 0.57048 },{ 0.36209169635 }},
{{ 0.85943, 0.84331, 0.81487 },{ 0.91571493013 }},
{{ 0.11381, 0.80378, 0.82951 },{ 0.16052707023 }},
{{ 0.79087, 0.11157, 0.83913 },{ 0.30641388193 }},
{{ 0.16297, 0.23090, 0.96417 },{ 0.15005479047 }},
{{ 0.78181, 0.80097, 0.00192 },{ 0.32179402798 }},
{{ 0.16141, 0.84321, 0.16561 },{ 0.14446082013 }},
{{ 0.79859, 0.11111, 0.15547 },{ -0.1308162293 }},
{{ 0.12959, 0.16184, 0.21825 },{ 0.03520247555 }},
{{ 1.00000, 0.46395, 0.84399 },{ 0.63914200000 }},
{{ 0.48724, 0.76024, 1.00000 },{ 0.64150992880 }},
{{ 0.40744, 0.00000, 0.65533 },{ 0.13060244736 }},
{{ 0.10931, 0.43216, 0.25195 },{ 0.06329759515 }},
{{ 0.69401, 0.99412, 0.55335 },{ 0.75632862795 }},
{{ 0.51759, 0.30372, 0.13622 },{ 0.07965761859 }},
{{ 0.98628, 0.40857, 0.47688 },{ 0.29286006552 }},
{{ 0.44474, 0.26024, 1.00000 },{ 0.37263430380 }},
{{ 0.15229, 0.52694, 0.75101 },{ 0.16014862087 }},
{{ 0.50968, 0.74522, 0.14058 },{ 0.30725752992 }},
{{ 0.82291, 0.10614, 0.49956 },{ 0.07762756903 }},
{{ 0.15674, 0.78167, 0.50766 },{ 0.17389174472 }},
{{ 0.12961, 0.17234, 0.65990 },{ 0.08236132255 }},
{{ 1.00000, 0.83202, 0.35206 },{ 0.61366800000 }},
{{ 0.36633, 0.89555, 0.76014 },{ 0.48373766601 }},
{{ 0.85641, 0.39194, 0.18691 },{ 0.09699956583 }},
{{ 0.50918, 0.23923, 0.42132 },{ 0.16380116928 }},
{{ 0.65513, 0.40585, 0.83832 },{ 0.49065371733 }},
{{ 0.66726, 0.75472, 0.25419 },{ 0.41666516892 }},
{{ 0.22193, 0.58555, 0.13920 },{ 0.13003877385 }},
{{ 0.41507, 0.89581, 0.25539 },{ 0.37048608609 }},
{{ 0.43231, 0.12362, 0.17297 },{ 0.01981752271 }},
{{ 0.78191, 0.63297, 0.72639 },{ 0.64361123257 }}
};
co test_points3[] = {
{{ 0.50915, 0.50936, 0.57048 },{ -0.00010 }},
{{ 0.85943, 0.84331, 0.81487 },{ 0.46573 }},
{{ 0.11381, 0.80378, 0.82951 },{ 0.56085 }},
{{ 0.79087, 0.11157, 0.83913 },{ 0.33378 }},
{{ 0.16297, 0.23090, 0.96417 },{ 0.38872 }},
{{ 0.78181, 0.80097, 0.00192 },{ 0.28654 }},
{{ 0.16141, 0.84321, 0.16561 },{ 0.43410 }},
{{ 0.79859, 0.11111, 0.15547 },{ 0.35140 }},
{{ 0.12959, 0.16184, 0.21825 },{ 0.46711 }},
{{ 1.00000, 0.46395, 0.84399 },{ 0.94213 }},
{{ 0.48724, 0.76024, 1.00000 },{ 0.00058 }},
{{ 0.40744, 0.00000, 0.65533 },{ 0.00859 }},
{{ 0.10931, 0.43216, 0.25195 },{ 0.54679 }},
{{ 0.69401, 0.99412, 0.55335 },{ 0.12494 }},
{{ 0.51759, 0.30372, 0.13622 },{ -0.00126 }},
{{ 0.98628, 0.40857, 0.47688 },{ 0.89573 }},
{{ 0.44474, 0.26024, 1.00000 },{ 0.00280 }},
{{ 0.15229, 0.52694, 0.75101 },{ 0.43807 }},
{{ 0.50968, 0.74522, 0.14058 },{ 0.00004 }},
{{ 0.82291, 0.10614, 0.49956 },{ 0.40990 }},
{{ 0.15674, 0.78167, 0.50766 },{ 0.44271 }},
{{ 0.12961, 0.17234, 0.65990 },{ 0.46804 }},
{{ 1.00000, 0.83202, 0.35206 },{ 0.90938 }},
{{ 0.36633, 0.89555, 0.76014 },{ 0.07020 }},
{{ 0.85641, 0.39194, 0.18691 },{ 0.48559 }},
{{ 0.50918, 0.23923, 0.42132 },{ -0.00391 }},
{{ 0.65513, 0.40585, 0.83832 },{ 0.09449 }},
{{ 0.66726, 0.75472, 0.25419 },{ 0.10065 }},
{{ 0.22193, 0.58555, 0.13920 },{ 0.28186 }},
{{ 0.41507, 0.89581, 0.25539 },{ 0.02877 }},
{{ 0.43231, 0.12362, 0.17297 },{ 0.00237 }},
{{ 0.78191, 0.63297, 0.72639 },{ 0.29573 }}
};
/* x + y^2 + z^1/3 function with one non-monotonic point */
co test_points4[] = {
{{ 0.1,0.1,0.5 },{ 0.11 }}, /* 0 */
{{ 0.2,0.7,0.1 },{ 0.69 }}, /* 1 */
{{ 0.8,0.8,0.8 },{ 1.44 }}, /* 2 */
{{ 0.5,0.6,0.4 },{ 0.86 }}, /* 3 */
{{ 0.2,0.5,0.2 },{ 0.45 }}, /* 4 */
{{ 0.3,0.7,0.2 },{ 0.35 }}, /* nm 5 */
{{ 0.5,0.4,0.9 },{ 0.66 }}, /* 6 */
{{ 0.1,0.9,0.7 },{ 0.91 }}, /* 7 */
{{ 0.7,0.2,0.1 },{ 0.74 }}, /* 8 */
{{ 0.8,0.4,0.3 },{ 0.96 }}, /* 9 */
{{ 0.3,0.3,0.4 },{ 0.39 }} /* 10 */
};
/* doubled up x + y^2 + z^1/3 function with one non-monotonic point */
co test_points5[] = {
{{ 0.1,0.1,0.5 },{ 0.11 }}, /* 0 */
{{ 0.101,0.101,0.501 },{ 0.11 }}, /* 0d */
{{ 0.2,0.7,0.1 },{ 0.69 }}, /* 1 */
{{ 0.201,0.701,0.101 },{ 0.69 }}, /* 1d */
{{ 0.8,0.8,0.8 },{ 1.44 }}, /* 2 */
{{ 0.801,0.801,0.801 },{ 1.44 }}, /* 2d */
{{ 0.5,0.6,0.4 },{ 0.86 }}, /* 3 */
{{ 0.501,0.601,0.401 },{ 0.86 }}, /* 3d */
{{ 0.2,0.5,0.2 },{ 0.45 }}, /* 4 */
{{ 0.201,0.501,0.201 },{ 0.45 }}, /* 4d */
{{ 0.3,0.7,0.2 },{ 0.35 }}, /* nm 5 */
{{ 0.301,0.701,0.201 },{ 0.35 }}, /* nm 5d */
{{ 0.5,0.4,0.9 },{ 0.66 }}, /* 6 */
{{ 0.501,0.401,0.901 },{ 0.66 }}, /* 6d */
{{ 0.1,0.9,0.7 },{ 0.91 }}, /* 7 */
{{ 0.101,0.901,0.701 },{ 0.91 }}, /* 7d */
{{ 0.7,0.2,0.1 },{ 0.74 }}, /* 8 */
{{ 0.701,0.201,0.101 },{ 0.74 }}, /* 8d */
{{ 0.8,0.4,0.3 },{ 0.96 }}, /* 9 */
{{ 0.801,0.401,0.301 },{ 0.96 }}, /* 9d */
{{ 0.3,0.3,0.4 },{ 0.39 }}, /* 10 */
{{ 0.301,0.301,0.401 },{ 0.39 }} /* 10d */
};
co test_points6[] = {
{{ 0.0069, 0.0071, 0.0061 },{ 0.0726 }},
{{ 0.0068, 0.0071, 0.0060 },{ 0.0704 }},
{{ 0.0069, 0.0072, 0.0062 },{ 0.0720 }},
{{ 0.0069, 0.0072, 0.0061 },{ 0.0734 }},
{{ 0.0069, 0.0072, 0.0063 },{ 0.0750 }},
{{ 0.0070, 0.0072, 0.0062 },{ 0.0779 }},
{{ 0.0070, 0.0072, 0.0063 },{ 0.0741 }},
{{ 0.0069, 0.0072, 0.0061 },{ 0.0745 }},
{{ 0.0069, 0.0072, 0.0061 },{ 0.0747 }},
{{ 0.0071, 0.0073, 0.0063 },{ 0.0760 }},
{{ 0.0070, 0.0073, 0.0063 },{ 0.0751 }},
{{ 0.0070, 0.0073, 0.0062 },{ 0.0759 }},
{{ 0.0071, 0.0074, 0.0062 },{ 0.0693 }},
{{ 0.0071, 0.0074, 0.0064 },{ 0.0740 }},
{{ 0.0072, 0.0075, 0.0064 },{ 0.0741 }},
{{ 0.0199, 0.0209, 0.0184 },{ 0.1019 }},
{{ 0.0296, 0.0306, 0.0257 },{ 0.1213 }},
{{ 0.0627, 0.0651, 0.0548 },{ 0.1779 }},
{{ 0.0831, 0.0863, 0.0718 },{ 0.2095 }},
{{ 0.1091, 0.1134, 0.0946 },{ 0.2487 }},
{{ 0.1442, 0.1497, 0.1227 },{ 0.2949 }},
{{ 0.1745, 0.1814, 0.1495 },{ 0.3360 }},
{{ 0.1747, 0.1816, 0.1498 },{ 0.3367 }},
{{ 0.1747, 0.1816, 0.1496 },{ 0.3364 }},
{{ 0.1748, 0.1816, 0.1497 },{ 0.3355 }},
{{ 0.1749, 0.1817, 0.1497 },{ 0.3344 }},
{{ 0.1748, 0.1817, 0.1498 },{ 0.3356 }},
{{ 0.1748, 0.1817, 0.1498 },{ 0.3354 }},
{{ 0.1749, 0.1817, 0.1496 },{ 0.3361 }},
{{ 0.1749, 0.1818, 0.1498 },{ 0.3368 }},
{{ 0.1749, 0.1818, 0.1498 },{ 0.3335 }},
{{ 0.1750, 0.1818, 0.1499 },{ 0.3367 }},
{{ 0.1750, 0.1819, 0.1500 },{ 0.3362 }},
{{ 0.1750, 0.1819, 0.1498 },{ 0.3359 }},
{{ 0.1751, 0.1820, 0.1500 },{ 0.3354 }},
{{ 0.1752, 0.1821, 0.1501 },{ 0.3355 }},
{{ 0.1754, 0.1823, 0.1502 },{ 0.3369 }},
{{ 0.1756, 0.1824, 0.1504 },{ 0.3360 }},
{{ 0.2743, 0.2842, 0.2367 },{ 0.4381 }},
{{ 0.3289, 0.3411, 0.2834 },{ 0.4922 }},
{{ 0.4036, 0.4184, 0.3475 },{ 0.5617 }},
{{ 0.4689, 0.4854, 0.4020 },{ 0.6147 }},
{{ 0.5379, 0.5567, 0.4606 },{ 0.6709 }},
{{ 0.7137, 0.7420, 0.6169 },{ 0.8045 }},
{{ 0.8730, 0.9105, 0.7433 },{ 0.9150 }},
{{ 0.8738, 0.9113, 0.7435 },{ 0.9141 }},
{{ 0.8741, 0.9116, 0.7445 },{ 0.9120 }},
{{ 0.8744, 0.9118, 0.7443 },{ 0.9173 }},
{{ 0.8748, 0.9123, 0.7457 },{ 0.9219 }},
{{ 0.8748, 0.9123, 0.7450 },{ 0.9133 }},
{{ 0.8748, 0.9124, 0.7445 },{ 0.9210 }},
{{ 0.8751, 0.9127, 0.7462 },{ 0.9207 }},
{{ 0.8751, 0.9127, 0.7457 },{ 0.9225 }},
{{ 0.8754, 0.9130, 0.7454 },{ 0.9137 }},
{{ 0.8757, 0.9133, 0.7456 },{ 0.9219 }},
{{ 0.8759, 0.9135, 0.7470 },{ 0.9166 }},
{{ 0.8761, 0.9137, 0.7469 },{ 0.9162 }},
{{ 0.8759, 0.9137, 0.7469 },{ 0.9151 }},
{{ 0.8765, 0.9141, 0.7470 },{ 0.9167 }},
};
#ifdef NEVER
#ifdef __STDC__
#include <stdarg.h>
void error(char *fmt, ...), warning(char *fmt, ...), verbose(int level, char *fmt, ...);
#else
#include <varargs.h>
void error(), warning(), verbose();
#endif
#endif /* NEVER */
void write_rgb_tiff(char *name, int width, int height, unsigned char *data);
void usage(void) {
fprintf(stderr,"Test 3D rspl interpolation\n");
fprintf(stderr,"Author: Graeme W. Gill\n");
fprintf(stderr,"usage: t2d [options]\n");
fprintf(stderr," -t n Test set:\n");
fprintf(stderr," * 1 = 1D test set along x = y = 0.5\n");
fprintf(stderr," 2 = Test set 1\n");
fprintf(stderr," 3 = Test set 2\n");
fprintf(stderr," 4 = x + y^2 + z^1/3 with nonmon point\n");
fprintf(stderr," 5 = doubled up x + y^2 + z^1/3 with nonmon point\n");
fprintf(stderr," 6 = neutral axis extrapolation\n");
fprintf(stderr," -r resx,resy,resz Set grid resolutions (def %d %d %d)\n",GRES0,GRES1,GRES2);
fprintf(stderr," -h Test half scale resolution too\n");
fprintf(stderr," -q Test quarter scale resolution too\n");
fprintf(stderr," -x Use auto smoothing\n");
fprintf(stderr," -s Test symetric smoothness\n");
fprintf(stderr," -p plot 4 slices, xy = 0.5, yz = 0.5, xz = 0.5, x=y=z\n");
fprintf(stderr," -P x1:y1:z1:x2:y2:z2 plot slice from x1,y1,z1,x2,y2,z2\n");
fprintf(stderr," -S factor smoothing factor (default 1.0)\n");
exit(1);
}
int main(int argc, char *argv[]) {
int fa,nfa; /* argument we're looking at */
rspl *rss; /* Regularized spline structure */
rspl *rss2 = NULL; /* Regularized spline structure at half/quarter resolution */
datai low,high;
int gres[MXDI];
int gres2[MXDI];
double avgdev[MXDO];
co *test_points = test_points1;
int npoints = sizeof(test_points1)/sizeof(co);
int dosym = 0;
int autosm = 0;
int doplot = 0;
double plotpts[2][3]; /* doplot == 2 start/end points */
int doh = 0; /* half scale */
int doq = 0;
int rsv;
double smoothf = 1.0;
int flags = RSPL_NOFLAGS;
low[0] = 0.0;
low[1] = 0.0;
low[2] = 0.0;
high[0] = 1.0;
high[1] = 1.0;
high[2] = 1.0;
gres[0] = GRES0;
gres[1] = GRES1;
gres[2] = GRES2;
avgdev[0] = 0.0;
avgdev[1] = 0.0;
avgdev[2] = 0.0;
/* Process the arguments */
for(fa = 1;fa < argc;fa++) {
nfa = fa; /* skip to nfa if next argument is used */
if (argv[fa][0] == '-') { /* Look for any flags */
char *na = NULL; /* next argument after flag, null if none */
if (argv[fa][2] != '\000')
na = &argv[fa][2]; /* next is directly after flag */
else {
if ((fa+1) < argc) {
if (argv[fa+1][0] != '-') {
nfa = fa + 1;
na = argv[nfa]; /* next is seperate non-flag argument */
}
}
}
if (argv[fa][1] == '?')
usage();
/* test set */
else if (argv[fa][1] == 't' || argv[fa][1] == 'T') {
int ix;
fa = nfa;
if (na == NULL) usage();
ix = atoi(na);
switch (ix) {
case 1:
test_points = test_points1;
npoints = sizeof(test_points1)/sizeof(co);
break;
case 2:
test_points = test_points2;
npoints = sizeof(test_points2)/sizeof(co);
break;
case 3:
test_points = test_points3;
npoints = sizeof(test_points3)/sizeof(co);
break;
case 4:
test_points = test_points4;
npoints = sizeof(test_points4)/sizeof(co);
break;
case 5:
test_points = test_points5;
npoints = sizeof(test_points5)/sizeof(co);
break;
case 6:
test_points = test_points6;
npoints = sizeof(test_points6)/sizeof(co);
break;
default:
usage();
}
} else if (argv[fa][1] == 'r' || argv[fa][1] == 'R') {
fa = nfa;
if (na == NULL) usage();
if (sscanf(na, " %d,%d,%d ", &gres[0], &gres[1], &gres[2]) != 3)
usage();
} else if (argv[fa][1] == 'h' || argv[fa][1] == 'H') {
doh = 1;
} else if (argv[fa][1] == 'q' || argv[fa][1] == 'Q') {
doh = 1;
doq = 1;
} else if (argv[fa][1] == 'p') {
doplot = 1;
} else if (argv[fa][1] == 'P') {
doplot = 2;
fa = nfa;
if (na == NULL) usage();
if (sscanf(na,"%lf:%lf:%lf:%lf:%lf:%lf",&plotpts[0][0],&plotpts[0][1],&plotpts[0][2],&plotpts[1][0],&plotpts[1][1],&plotpts[1][2]) != 6) {
usage();
}
} else if (argv[fa][1] == 's') {
dosym = 1;
} else if (argv[fa][1] == 'x') {
autosm = 1;
/* smoothing factor */
} else if (argv[fa][1] == 'S') {
int ix;
fa = nfa;
if (na == NULL) usage();
smoothf = atof(na);
} else
usage();
} else
break;
}
if (autosm)
flags |= RSPL_AUTOSMOOTH;
if (dosym)
flags |= RSPL_SYMDOMAIN;
/* Create the object */
rss = new_rspl(RSPL_NOFLAGS, 3, 1);
/* Fit to scattered data */
rss->fit_rspl(rss,
flags, /* Non-mon and clip flags */
test_points, /* Test points */
npoints, /* Number of test points */
low, high, gres, /* Low, high, resolution of grid */
NULL, NULL, /* Default data scale */
smoothf, /* Smoothing */
avgdev, /* Average deviation */
NULL); /* iwidth */
if (doh) {
if (doq) {
gres2[0] = gres[0]/4;
gres2[1] = gres[1]/4;
gres2[2] = gres[2]/4;
} else {
gres2[0] = gres[0]/2;
gres2[1] = gres[1]/2;
gres2[2] = gres[2]/2;
}
rss2 = new_rspl(RSPL_NOFLAGS, 3, 1);
/* Fit to scattered data */
rss2->fit_rspl(rss2,
flags, /* Non-mon and clip flags */
test_points, /* Test points */
npoints, /* Number of test points */
low, high, gres2, /* Low, high, resolution of grid */
NULL, NULL, /* Default data scale */
smoothf, /* Smoothing */
avgdev, /* Average deviation */
NULL); /* iwidth */
}
/* Test the interpolation with a slice in 2D */
for (rsv = 0; rsv <= doh; rsv++) {
double z[2][2] = { { 0.1, 0.5 } , { 0.5, 0.9 } };
double x1 = -0.2;
double x2 = 1.2;
double y1 = -0.2;
double y2 = 1.2;
double min = -0.0;
double max = 1.0;
rspl *rs;
unsigned char pa[HEIGHT][WIDTH][3];
co tco; /* Test point */
double sx,sy;
int i,j,k;
if (rsv == 0)
rs = rss;
else
rs = rss2;
sx = (x2 - x1)/(double)WIDTH;
sy = (y2 - y1)/(double)HEIGHT;
for (j=0; j < HEIGHT; j++) {
double jj = j/(HEIGHT-1.0);
tco.p[1] = (double)((HEIGHT-1) - j) * sy + y1;
for (i = 0; i < WIDTH; i++) {
double ii = j/(HEIGHT-1.0);
tco.p[0] = (double)i * sx + x1;
tco.p[2] = (1.0-ii) * (1.0-jj) * z[0][0]
+ (1.0-ii) * jj * z[0][1]
+ ii * (1.0-jj) * z[1][0]
+ ii * jj * z[1][1];
if (rs->INTERP(rs, &tco)) {
pa[j][i][0] = 0; /* Out of bounds in green */
pa[j][i][1] = 100;
pa[j][i][2] = 0;
} else {
int m;
/* printf("%d %d, %f %f returned %f\n",i,j,tco.p[0],tco.p[1],tco.v[0]); */
m = (int)((255.0 * (tco.v[0] - min)/(max - min)) + 0.5);
if (m < 0) {
pa[j][i][0] = 20; /* Dark blue */
pa[j][i][1] = 20;
pa[j][i][2] = 50;
} else if (m > 255) {
pa[j][i][0] = 230; /* Light blue */
pa[j][i][1] = 230;
pa[j][i][2] = 255;
} else {
pa[j][i][0] = m; /* Level in grey */
pa[j][i][1] = m;
pa[j][i][2] = m;
}
}
}
}
/* Mark vertices in red */
for(k = 0; k < npoints; k++) {
j = (int)((HEIGHT * (y2 - test_points[k].p[1])/(y2 - y1)) + 0.5);
i = (int)((WIDTH * (test_points[k].p[0] - x1)/(x2 - x1)) + 0.5);
pa[j][i][0] = 255;
pa[j][i][1] = 0;
pa[j][i][2] = 0;
}
write_rgb_tiff(rsv == 0 ? "t3d.tif" : "t3dh.tif" ,WIDTH,HEIGHT,(unsigned char *)pa);
}
/* Plot out 4 slices */
if (doplot == 1) {
int slice;
for (slice = 0; slice < 4; slice++) {
co tp; /* Test point */
double x[PLOTRES];
double ya[PLOTRES];
double yb[PLOTRES];
double xx,yy,zz;
double x1,x2,y1,y2,z1,z2;
double sx,sy,sz;
int i,n;
/* Set up slice to plot */
if (slice == 0) {
x1 = 0.5; y1 = 0.5, z1 = 0.0;
x2 = 0.5; y2 = 0.5, z2 = 1.0;
printf("Plot along z at x = y = 0.5\n");
n = PLOTRES;
} else if (slice == 1) {
x1 = 0.0; y1 = 0.5, z1 = 0.5;
x2 = 1.0; y2 = 0.5, z2 = 0.5;
printf("Plot along x at y = z = 0.5\n");
n = PLOTRES;
} else if (slice == 2) {
x1 = 0.5; y1 = 0.0, z1 = 0.5;
x2 = 0.5; y2 = 1.0, z2 = 0.5;
printf("Plot along y at x = z = 0.5\n");
n = PLOTRES;
} else {
x1 = 0.0; y1 = 0.0, z1 = 0.0;
x2 = 1.0; y2 = 1.0, z2 = 1.0;
printf("Plot along x = y = z\n");
n = PLOTRES;
}
sx = (x2 - x1)/n;
sy = (y2 - y1)/n;
sz = (z2 - z1)/n;
xx = x1;
yy = y1;
zz = z1;
for (i = 0; i < n; i++) {
double vv = i/(n-1.0);
x[i] = vv;
tp.p[0] = xx;
tp.p[1] = yy;
tp.p[2] = zz;
if (rss->INTERP(rss, &tp))
tp.v[0] = -0.1;
ya[i] = tp.v[0];
if (doh) {
if (rss2->INTERP(rss2, &tp))
tp.v[0] = -0.1;
yb[i] = tp.v[0];
}
xx += sx;
yy += sy;
zz += sz;
}
/* Plot the result */
if (doh)
do_plot(x,ya,yb,NULL,n);
else
do_plot(x,ya,NULL,NULL,n);
}
} else if (doplot == 2) {
co tp; /* Test point */
double x[PLOTRES];
double ya[PLOTRES];
double yb[PLOTRES];
double xx,yy,zz;
double x1,x2,y1,y2,z1,z2;
double sx,sy,sz;
int i,n;
x1 = plotpts[0][0];
y1 = plotpts[0][1];
z1 = plotpts[0][2];
x2 = plotpts[1][0];
y2 = plotpts[1][1];
z2 = plotpts[1][2];
printf("Plot along z at x = y = 0.5\n");
n = PLOTRES;
sx = (x2 - x1)/n;
sy = (y2 - y1)/n;
sz = (z2 - z1)/n;
xx = x1;
yy = y1;
zz = z1;
for (i = 0; i < n; i++) {
double vv = i/(n-1.0);
x[i] = vv;
tp.p[0] = xx;
tp.p[1] = yy;
tp.p[2] = zz;
if (rss->INTERP(rss, &tp))
tp.v[0] = -0.1;
ya[i] = tp.v[0];
if (doh) {
if (rss2->INTERP(rss2, &tp))
tp.v[0] = -0.1;
yb[i] = tp.v[0];
}
xx += sx;
yy += sy;
zz += sz;
}
/* Plot the result */
if (doh)
do_plot(x,ya,yb,NULL,n);
else
do_plot(x,ya,NULL,NULL,n);
}
/* Report the fit */
{
co tco; /* Test point */
int k;
double avg = 0;
double max = 0.0;
for(k = 0; k < npoints; k++) {
double err;
tco.p[0] = test_points[k].p[0];
tco.p[1] = test_points[k].p[1];
tco.p[2] = test_points[k].p[2];
rss->INTERP(rss, &tco);
err = tco.v[0] - test_points[k].v[0];
err = fabs(err);
avg += err;
if (err > max)
max = err;
}
avg /= (double)npoints;
printf("Max error %f%%, average %f%%\n",100.0 * max, 100.0 * avg);
}
return 0;
}
/* ---------------------- */
/* Tiff diagnostic output */
void
write_rgb_tiff(
char *name,
int width,
int height,
unsigned char *data
) {
int y;
unsigned char *dp;
TIFF *tif;
if ((tif = TIFFOpen(name, "w")) == NULL) {
fprintf(stderr,"Failed to open output TIFF file '%s'\n",name);
exit (-1);
}
TIFFSetField(tif, TIFFTAG_IMAGEWIDTH, width);
TIFFSetField(tif, TIFFTAG_IMAGELENGTH, height);
TIFFSetField(tif, TIFFTAG_ORIENTATION, ORIENTATION_TOPLEFT);
TIFFSetField(tif, TIFFTAG_SAMPLESPERPIXEL, 3);
TIFFSetField(tif, TIFFTAG_BITSPERSAMPLE, 8);
TIFFSetField(tif, TIFFTAG_PLANARCONFIG, PLANARCONFIG_CONTIG);
TIFFSetField(tif, TIFFTAG_PHOTOMETRIC, PHOTOMETRIC_RGB);
TIFFSetField(tif, TIFFTAG_COMPRESSION, COMPRESSION_NONE);
for (dp = data, y = 0; y < height; y++, dp += 3 * width) {
if (TIFFWriteScanline(tif, (tdata_t)dp, y, 0) < 0) {
fprintf(stderr,"WriteScanline Failed at line %d\n",y);
exit (-1);
}
}
(void) TIFFClose(tif);
}
#ifdef NEVER
/******************************************************************/
/* Error/debug output routines */
/******************************************************************/
/* Basic printf type error() and warning() routines */
#ifdef __STDC__
void
error(char *fmt, ...)
#else
void
error(va_alist)
va_dcl
#endif
{
va_list args;
#ifndef __STDC__
char *fmt;
#endif
fprintf(stderr,"cmatch: Error - ");
#ifdef __STDC__
va_start(args, fmt);
#else
va_start(args);
fmt = va_arg(args, char *);
#endif
vfprintf(stderr, fmt, args);
va_end(args);
fprintf(stderr, "\n");
fflush(stdout);
exit (-1);
}
#ifdef __STDC__
void
warning(char *fmt, ...)
#else
void
warning(va_alist)
va_dcl
#endif
{
va_list args;
#ifndef __STDC__
char *fmt;
#endif
fprintf(stderr,"cmatch: Warning - ");
#ifdef __STDC__
va_start(args, fmt);
#else
va_start(args);
fmt = va_arg(args, char *);
#endif
vfprintf(stderr, fmt, args);
va_end(args);
fprintf(stderr, "\n");
}
#ifdef __STDC__
void
verbose(int level, char *fmt, ...)
{
va_list args;
va_start(args, fmt);
#else
verbose(va_alist)
va_dcl
{
va_list args;
int level;
char *fmt;
va_start(args);
level = va_arg(args, int);
fmt = va_arg(args, char *);
#endif
if (verbose_level >= level)
{
fprintf(verbose_out,"cmatch: ");
vfprintf(verbose_out, fmt, args);
fprintf(verbose_out, "\n");
fflush(verbose_out);
}
va_end(args);
}
#endif /* NEVER */