src/gen/genworm.c

#ifndef lint
static const char       RCSid[] = "$Id: genworm.c,v 2.13 2024/12/10 17:22:39 greg Exp $";
#endif
/*
 *  genworm.c - program to generate worms (strings with varying thickness).
 *
 *      The program takes as input the functions of t for x, y,
 *      z and r (the radius).  Cylinders and cones will be
 *      joined by spheres.  Negative radii are forbidden.
 *
 *      9/24/87
 */

#include  <stdlib.h>
#include  <math.h>

#include  "calcomp.h"
#include  "rtio.h"
#include  "resolu.h"
#include  "rterror.h"
#include  "fvect.h"

#define  XNAME          "X`SYS`"                /* x function name */
#define  YNAME          "Y`SYS`"                /* y function name */
#define  ZNAME          "Z`SYS`"                /* z function name */
#define  RNAME          "R`SYS`"                /* r function name */

#define  PI             3.14159265358979323846

#define  max(a,b)       ((a) > (b) ? (a) : (b))


/* XXX redundant, move to library */
double  l_hermite(char *), l_bezier(char *), l_bspline(char *);


int
main(argc, argv)
int  argc;
char  *argv[];
{
        char  stmp[256];
        double  t, f, lastr = 0, r;
        FVECT  lastp, p;
        int  i, nseg;

        esupport |= E_VARIABLE|E_FUNCTION|E_RCONST;
        esupport &= ~(E_OUTCHAN|E_INCHAN);
        varset("PI", ':', PI);
        funset("hermite", 5, ':', l_hermite);
        funset("bezier", 5, ':', l_bezier);
        funset("bspline", 5, ':', l_bspline);

        if (argc < 8)
                goto userror;

        for (i = 8; i < argc; i++)
                if (!strcmp(argv[i], "-e"))
                        scompile(argv[++i], NULL, 0);
                else if (!strcmp(argv[i], "-f")) {
                        char  *fpath = getpath(argv[++i], getrlibpath(), 0);
                        if (fpath == NULL) {
                                fprintf(stderr, "%s: cannot find file '%s'\n",
                                                argv[0], argv[i]);
                                quit(1);
                        }
                        fcompile(fpath);
                } else
                        goto userror;

        sprintf(stmp, "%s(t)=%s;", XNAME, argv[3]);
        scompile(stmp, NULL, 0);
        sprintf(stmp, "%s(t)=%s;", YNAME, argv[4]);
        scompile(stmp, NULL, 0);
        sprintf(stmp, "%s(t)=%s;", ZNAME, argv[5]);
        scompile(stmp, NULL, 0);
        sprintf(stmp, "%s(t)=%s;", RNAME, argv[6]);
        scompile(stmp, NULL, 0);
        nseg = eval(argv[7]) + .5;
        if (nseg <= 0)
                goto userror;

        fputs("# ", stdout);
        printargs(argc, argv, stdout);
        doptimize(1);
        eclock++;

        for (i = 0; i <= nseg; i++) {
                t = (double)i/nseg;
                p[0] = funvalue(XNAME, 1, &t);
                p[1] = funvalue(YNAME, 1, &t);
                p[2] = funvalue(ZNAME, 1, &t);
                r = funvalue(RNAME, 1, &t);
                if (i) {
                        if (lastr <= r+FTINY && lastr >= r-FTINY) {
                                printf("\n%s cylinder %s.c%d\n",
                                                argv[1], argv[2], i);
                                printf("0\n0\n7\n");
                                printf("%18.12g %18.12g %18.12g\n",
                                                lastp[0], lastp[1], lastp[2]);
                                printf("%18.12g %18.12g %18.12g\n",
                                                p[0], p[1], p[2]);
                                printf("%18.12g\n", r);
                        } else {
                                printf("\n%s cone %s.c%d\n",
                                                argv[1], argv[2], i);
                                printf("0\n0\n8\n");
                                f = (lastr - r)/dist2(lastp,p);
                                printf("%18.12g %18.12g %18.12g\n",
                                        lastp[0] + f*lastr*(p[0] - lastp[0]),
                                        lastp[1] + f*lastr*(p[1] - lastp[1]),
                                        lastp[2] + f*lastr*(p[2] - lastp[2]));
                                printf("%18.12g %18.12g %18.12g\n",
                                        p[0] + f*r*(p[0] - lastp[0]),
                                        p[1] + f*r*(p[1] - lastp[1]),
                                        p[2] + f*r*(p[2] - lastp[2]));
                                f = 1.0 - (lastr-r)*f;
                                f = f <= 0.0 ? 0.0 : sqrt(f);
                                printf("%18.12g %18.12g\n", f*lastr, f*r);
                        }
                }
                printf("\n%s sphere %s.s%d\n", argv[1], argv[2], i);
                printf("0\n0\n4 %18.12g %18.12g %18.12g %18.12g\n",
                                p[0], p[1], p[2], r);
                VCOPY(lastp, p);
                lastr = r;
        }
        return 0;

userror:
        fprintf(stderr,
"Usage: %s material name x(t) y(t) z(t) r(t) nseg [-e expr] [-f file]\n",
                        argv[0]);
        return 1;
}


double
l_hermite(char *nm)
{
        double  t;
        
        t = argument(5);
        return( argument(1)*((2.0*t-3.0)*t*t+1.0) +
                argument(2)*(-2.0*t+3.0)*t*t +
                argument(3)*((t-2.0)*t+1.0)*t +
                argument(4)*(t-1.0)*t*t );
}


double
l_bezier(char *nm)
{
        double  t;

        t = argument(5);
        return( argument(1) * (1.+t*(-3.+t*(3.-t))) +
                argument(2) * 3.*t*(1.+t*(-2.+t)) +
                argument(3) * 3.*t*t*(1.-t) +
                argument(4) * t*t*t );
}


double
l_bspline(char *nm)
{
        double  t;

        t = argument(5);
        return( argument(1) * (1./6.+t*(-1./2.+t*(1./2.-1./6.*t))) +
                argument(2) * (2./3.+t*t*(-1.+1./2.*t)) +
                argument(3) * (1./6.+t*(1./2.+t*(1./2.-1./2.*t))) +
                argument(4) * (1./6.*t*t*t) );
}
Revision:	2.14
Committed:	Fri Apr 18 23:02:53 2025 UTC (3 weeks, 3 days ago) by greg
Content type:	text/plain
Branch:	MAIN
CVS Tags:	HEAD
Changes since 2.13:	+3 -2 lines
Log Message:	perf(gensurf,genrev,genworm): Added call to doptimize() for expressions
#	User	Rev	Content
1	greg	1.1	#ifndef lint
2	greg	2.14	static const char RCSid[] = "$Id: genworm.c,v 2.13 2024/12/10 17:22:39 greg Exp $";
3	greg	1.1	#endif
4	greg	1.2	/*
5	greg	1.1	* genworm.c - program to generate worms (strings with varying thickness).
6			*
7			* The program takes as input the functions of t for x, y,
8			* z and r (the radius). Cylinders and cones will be
9			* joined by spheres. Negative radii are forbidden.
10			*
11			* 9/24/87
12			*/
13
14	schorsch	2.7	#include <stdlib.h>
15	greg	2.2	#include <math.h>
16	schorsch	2.7
17	greg	2.6	#include "calcomp.h"
18	greg	2.10	#include "rtio.h"
19	greg	2.8	#include "resolu.h"
20			#include "rterror.h"
21	greg	1.1	#include "fvect.h"
22
23	greg	1.9	#define XNAME "X`SYS`" /* x function name */
24			#define YNAME "Y`SYS`" /* y function name */
25			#define ZNAME "Z`SYS`" /* z function name */
26			#define RNAME "R`SYS`" /* r function name */
27	greg	1.1
28			#define PI 3.14159265358979323846
29
30			#define max(a,b) ((a) > (b) ? (a) : (b))
31
32
33	schorsch	2.7	/* XXX redundant, move to library */
34	greg	2.6	double l_hermite(char ), l_bezier(char ), l_bspline(char *);
35	greg	1.1
36
37	schorsch	2.7	int
38	greg	1.1	main(argc, argv)
39			int argc;
40			char *argv[];
41			{
42			char stmp[256];
43	schorsch	2.7	double t, f, lastr = 0, r;
44	greg	1.1	FVECT lastp, p;
45			int i, nseg;
46
47	greg	2.9	esupport \|= E_VARIABLE\|E_FUNCTION\|E_RCONST;
48			esupport &= ~(E_OUTCHAN\|E_INCHAN);
49	greg	1.7	varset("PI", ':', PI);
50	greg	1.8	funset("hermite", 5, ':', l_hermite);
51			funset("bezier", 5, ':', l_bezier);
52			funset("bspline", 5, ':', l_bspline);
53	greg	1.1
54			if (argc < 8)
55			goto userror;
56
57			for (i = 8; i < argc; i++)
58			if (!strcmp(argv[i], "-e"))
59	greg	1.6	scompile(argv[++i], NULL, 0);
60	greg	2.10	else if (!strcmp(argv[i], "-f")) {
61			char *fpath = getpath(argv[++i], getrlibpath(), 0);
62			if (fpath == NULL) {
63			fprintf(stderr, "%s: cannot find file '%s'\n",
64			argv[0], argv[i]);
65			quit(1);
66			}
67			fcompile(fpath);
68			} else
69	greg	1.1	goto userror;
70
71			sprintf(stmp, "%s(t)=%s;", XNAME, argv[3]);
72	greg	1.6	scompile(stmp, NULL, 0);
73	greg	1.1	sprintf(stmp, "%s(t)=%s;", YNAME, argv[4]);
74	greg	1.6	scompile(stmp, NULL, 0);
75	greg	1.1	sprintf(stmp, "%s(t)=%s;", ZNAME, argv[5]);
76	greg	1.6	scompile(stmp, NULL, 0);
77	greg	1.1	sprintf(stmp, "%s(t)=%s;", RNAME, argv[6]);
78	greg	1.6	scompile(stmp, NULL, 0);
79	greg	2.11	nseg = eval(argv[7]) + .5;
80	greg	1.1	if (nseg <= 0)
81			goto userror;
82
83	greg	2.8	fputs("# ", stdout);
84			printargs(argc, argv, stdout);
85	greg	2.14	doptimize(1);
86			eclock++;
87	greg	1.1
88			for (i = 0; i <= nseg; i++) {
89			t = (double)i/nseg;
90			p[0] = funvalue(XNAME, 1, &t);
91			p[1] = funvalue(YNAME, 1, &t);
92			p[2] = funvalue(ZNAME, 1, &t);
93			r = funvalue(RNAME, 1, &t);
94	schorsch	2.5	if (i) {
95	greg	1.1	if (lastr <= r+FTINY && lastr >= r-FTINY) {
96			printf("\n%s cylinder %s.c%d\n",
97			argv[1], argv[2], i);
98			printf("0\n0\n7\n");
99			printf("%18.12g %18.12g %18.12g\n",
100			lastp[0], lastp[1], lastp[2]);
101			printf("%18.12g %18.12g %18.12g\n",
102			p[0], p[1], p[2]);
103			printf("%18.12g\n", r);
104			} else {
105			printf("\n%s cone %s.c%d\n",
106			argv[1], argv[2], i);
107			printf("0\n0\n8\n");
108			f = (lastr - r)/dist2(lastp,p);
109			printf("%18.12g %18.12g %18.12g\n",
110			lastp[0] + flastr(p[0] - lastp[0]),
111			lastp[1] + flastr(p[1] - lastp[1]),
112			lastp[2] + flastr(p[2] - lastp[2]));
113			printf("%18.12g %18.12g %18.12g\n",
114			p[0] + fr(p[0] - lastp[0]),
115			p[1] + fr(p[1] - lastp[1]),
116			p[2] + fr(p[2] - lastp[2]));
117			f = 1.0 - (lastr-r)*f;
118			f = f <= 0.0 ? 0.0 : sqrt(f);
119			printf("%18.12g %18.12g\n", flastr, fr);
120			}
121	schorsch	2.5	}
122	greg	1.1	printf("\n%s sphere %s.s%d\n", argv[1], argv[2], i);
123			printf("0\n0\n4 %18.12g %18.12g %18.12g %18.12g\n",
124			p[0], p[1], p[2], r);
125			VCOPY(lastp, p);
126			lastr = r;
127			}
128	schorsch	2.7	return 0;
129	greg	1.1
130			userror:
131			fprintf(stderr,
132			"Usage: %s material name x(t) y(t) z(t) r(t) nseg [-e expr] [-f file]\n",
133			argv[0]);
134	schorsch	2.7	return 1;
135	greg	1.1	}
136
137
138			double
139	greg	2.6	l_hermite(char *nm)
140	greg	1.1	{
141			double t;
142
143			t = argument(5);
144			return( argument(1)((2.0t-3.0)tt+1.0) +
145			argument(2)(-2.0t+3.0)tt +
146			argument(3)((t-2.0)t+1.0)*t +
147			argument(4)(t-1.0)t*t );
148	greg	1.3	}
149
150
151			double
152	greg	2.6	l_bezier(char *nm)
153	greg	1.3	{
154			double t;
155
156			t = argument(5);
157			return( argument(1) * (1.+t(-3.+t(3.-t))) +
158			argument(2) * 3.t(1.+t*(-2.+t)) +
159			argument(3) * 3.tt*(1.-t) +
160			argument(4) * ttt );
161	greg	1.4	}
162
163
164			double
165	greg	2.6	l_bspline(char *nm)
166	greg	1.4	{
167			double t;
168
169			t = argument(5);
170			return( argument(1) * (1./6.+t(-1./2.+t(1./2.-1./6.*t))) +
171			argument(2) * (2./3.+tt(-1.+1./2.*t)) +
172			argument(3) * (1./6.+t(1./2.+t(1./2.-1./2.*t))) +
173			argument(4) * (1./6.tt*t) );
174	greg	1.1	}