src/rt/func.c

/* Copyright (c) 1991 Regents of the University of California */

#ifndef lint
static char SCCSid[] = "$SunId$ LBL";
#endif

/*
 *  func.c - interface to calcomp functions.
 *
 *     4/7/86
 */

#include  "ray.h"

#include  "otypes.h"

#include  "func.h"


#define  INITFILE       "rayinit.cal"
#define  REFVNAME       "`FILE_REFCNT"
#define  CALSUF         ".cal"
#define  LCALSUF        4

XF  unitxf = {                  /* identity transform */
        1.0, 0.0, 0.0, 0.0,
        0.0, 1.0, 0.0, 0.0,
        0.0, 0.0, 1.0, 0.0,
        0.0, 0.0, 0.0, 1.0,
        1.0
};

XF  funcxf;                     /* current transformation */
static OBJREC  *fobj = NULL;    /* current function object */
static RAY  *fray = NULL;       /* current function ray */

static double  l_erf(), l_erfc(), l_arg();


MFUNC *
getfunc(m, ff, ef, dofwd)       /* get function for this modifier */
OBJREC  *m;
int  ff;
unsigned  ef;
int  dofwd;
{
        extern EPNODE  *curfunc;
        static char  initfile[] = INITFILE;
        char  sbuf[MAXSTR];
        register char  **arg;
        register MFUNC  *f;
        int  ne, na;
        register int  i;
                                        /* check to see if done already */
        if ((f = (MFUNC *)m->os) != NULL)
                return(f);
        if (initfile[0]) {              /* initialize on first call */
                setcontext("");
                scompile("Dx=$1;Dy=$2;Dz=$3;", NULL, 0);
                scompile("Nx=$4;Ny=$5;Nz=$6;", NULL, 0);
                scompile("Px=$7;Py=$8;Pz=$9;", NULL, 0);
                scompile("T=$10;Rdot=$11;", NULL, 0);
                scompile("S=$12;Tx=$13;Ty=$14;Tz=$15;", NULL, 0);
                scompile("Ix=$16;Iy=$17;Iz=$18;", NULL, 0);
                scompile("Jx=$19;Jy=$20;Jz=$21;", NULL, 0);
                scompile("Kx=$22;Ky=$23;Kz=$24;", NULL, 0);
                funset("arg", 1, '=', l_arg);
                funset("erf", 1, ':', l_erf);
                funset("erfc", 1, ':', l_erfc);
                setnoisefuncs();
                loadfunc(initfile);
                initfile[0] = '\0';
        }
        if ((na = m->oargs.nsargs) <= ff)
                goto toofew;
        arg = m->oargs.sarg;
        if ((f = (MFUNC *)calloc(1, sizeof(MFUNC))) == NULL)
                goto memerr;
        i = strlen(arg[ff]);                    /* set up context */
        if (i == 1 && arg[ff][0] == '.')
                setcontext(f->ctx = "");        /* "." means no file */
        else {
                strcpy(sbuf,m->oargs.sarg[ff]); /* file name is context */
                if (i > LCALSUF && !strcmp(sbuf+i-LCALSUF, CALSUF))
                        sbuf[i-LCALSUF] = '\0'; /* remove suffix */
                setcontext(f->ctx = savestr(sbuf));
                if (!vardefined(REFVNAME)) {    /* file loaded? */
                        loadfunc(m->oargs.sarg[ff]);
                        varset(REFVNAME, '=', 1.0);
                } else                          /* reference_count++ */
                        varset(REFVNAME, '=', varvalue(REFVNAME)+1.0);
        }
        curfunc = NULL;                 /* parse expressions */
        sprintf(sbuf, "%s \"%s\"", ofun[m->otype].funame, m->oname);
        for (i=0, ne=0; ef && i < na; i++, ef>>=1)
                if (ef & 1) {                   /* flagged as an expression? */
                        if (ne >= MAXEXPR)
                                objerror(m, INTERNAL, "too many expressions");
                        initstr(arg[i], sbuf, 0);
                        f->ep[ne++] = getE1();
                        if (nextc != EOF)
                                syntax("unexpected character");
                }
        if (ef)
                goto toofew;
        if (i <= ff)                    /* find transform args */
                i = ff+1;
        while (i < na && arg[i][0] != '-')
                i++;
        if (i == na)                    /* no transform */
                f->f = f->b = &unitxf;
        else {                          /* get transform */
                if ((f->b = (XF *)malloc(sizeof(XF))) == NULL)
                        goto memerr;
                if (invxf(f->b, na-i, arg+i) != na-i)
                        objerror(m, USER, "bad transform");
                if (f->b->sca < 0.0)
                        f->b->sca = -f->b->sca;
                if (dofwd) {                    /* do both transforms */
                        if ((f->f = (XF *)malloc(sizeof(XF))) == NULL)
                                goto memerr;
                        xf(f->f, na-i, arg+i);
                        if (f->f->sca < 0.0)
                                f->f->sca = -f->f->sca;
                }
        }
        m->os = (char *)f;
        return(f);
toofew:
        objerror(m, USER, "too few arguments");
memerr:
        error(SYSTEM, "out of memory in getfunc");
}


freefunc(m)                     /* free memory associated with modifier */
OBJREC  *m;
{
        register MFUNC  *f;
        register int  i;

        if ((f = (MFUNC *)m->os) == NULL)
                return;
        for (i = 0; f->ep[i] != NULL; i++)
                epfree(f->ep[i]);
        if (f->ctx[0]) {                        /* done with definitions */
                setcontext(f->ctx);
                i = varvalue(REFVNAME)-.5;      /* reference_count-- */
                if (i > 0)
                        varset(REFVNAME, '=', (double)i);
                else
                        dcleanup(2);            /* remove definitions */
                freestr(f->ctx);
        }
        if (f->b != &unitxf)
                free((char *)f->b);
        if (f->f != NULL && f->f != &unitxf)
                free((char *)f->f);
        free((char *)f);
        m->os = NULL;
}


setfunc(m, r)                   /* set channels for function call */
OBJREC  *m;
register RAY  *r;
{
        static long  lastrno = -1;
        register MFUNC  *f;
                                        /* get function */
        if ((f = (MFUNC *)m->os) == NULL)
                error(m, CONSISTENCY, "setfunc called before getfunc");
                                        /* set evaluator context */
        setcontext(f->ctx);
                                        /* check to see if matrix set */
        if (m == fobj && r->rno == lastrno)
                return(0);
        fobj = m;
        fray = r;
        if (r->rox != NULL)
                if (f->b != &unitxf) {
                        funcxf.sca = r->rox->b.sca * f->b->sca;
                        multmat4(funcxf.xfm, r->rox->b.xfm, f->b->xfm);
                } else
                        copystruct(&funcxf, &r->rox->b);
        else
                copystruct(&funcxf, f->b);
        lastrno = r->rno;
        eclock++;               /* notify expression evaluator */
        return(1);
}


loadfunc(fname)                 /* load definition file */
char  *fname;
{
        extern char  *libpath;          /* library search path */
        char  *ffname;

        if ((ffname = getpath(fname, libpath, R_OK)) == NULL) {
                sprintf(errmsg, "cannot find function file \"%s\"", fname);
                error(USER, errmsg);
        }
        fcompile(ffname);
}


static double
l_arg()                         /* return nth real argument */
{
        extern double  argument();
        register int  n;

        n = argument(1) + .5;           /* round to integer */

        if (n < 1)
                return(fobj->oargs.nfargs);

        if (n > fobj->oargs.nfargs) {
                sprintf(errmsg, "missing real argument %d", n);
                objerror(fobj, USER, errmsg);
        }
        return(fobj->oargs.farg[n-1]);
}


static double
l_erf()                         /* error function */
{
        extern double  erf();

        return(erf(argument(1)));
}


static double
l_erfc()                        /* cumulative error function */
{
        extern double  erfc();

        return(erfc(argument(1)));
}


double
chanvalue(n)                    /* return channel n to calcomp */
register int  n;
{
        double  sum;
        register RAY  *r;

        if (--n < 0)
                goto badchan;

        if (n < 3)                      /* ray direction */

                return( (       fray->rdir[0]*funcxf.xfm[0][n] +
                                fray->rdir[1]*funcxf.xfm[1][n] +
                                fray->rdir[2]*funcxf.xfm[2][n]  )
                         / funcxf.sca );

        if (n < 6)                      /* surface normal */

                return( (       fray->ron[0]*funcxf.xfm[0][n-3] +
                                fray->ron[1]*funcxf.xfm[1][n-3] +
                                fray->ron[2]*funcxf.xfm[2][n-3] )
                         / funcxf.sca );

        if (n < 9)                      /* intersection */

                return( fray->rop[0]*funcxf.xfm[0][n-6] +
                                fray->rop[1]*funcxf.xfm[1][n-6] +
                                fray->rop[2]*funcxf.xfm[2][n-6] +
                                             funcxf.xfm[3][n-6] );

        if (n == 9) {                   /* distance */

                sum = fray->rot;
                for (r = fray->parent; r != NULL; r = r->parent)
                        sum += r->rot;
                return(sum * funcxf.sca);

        }
        if (n == 10)                    /* dot product (range [-1,1]) */
                return( fray->rod <= -1.0 ? -1.0 :
                        fray->rod >= 1.0 ? 1.0 :
                        fray->rod );

        if (n == 11)                    /* scale */
                return(funcxf.sca);

        if (n < 15)                     /* origin */
                return(funcxf.xfm[3][n-12]);

        if (n < 18)                     /* i unit vector */
                return(funcxf.xfm[0][n-15] / funcxf.sca);

        if (n < 21)                     /* j unit vector */
                return(funcxf.xfm[1][n-15] / funcxf.sca);

        if (n < 24)                     /* k unit vector */
                return(funcxf.xfm[2][n-21] / funcxf.sca);
badchan:
        error(USER, "illegal channel number");
}
Revision:	2.3
Committed:	Tue Dec 24 17:43:43 1991 UTC (32 years, 4 months ago) by greg
Content type:	text/plain
Branch:	MAIN
Changes since 2.2:	+2 -2 lines
Log Message:	minor cosmetic surgery
#	User	Rev	Content
1	greg	1.13	/* Copyright (c) 1991 Regents of the University of California */
2	greg	1.1
3			#ifndef lint
4			static char SCCSid[] = "$SunId$ LBL";
5			#endif
6
7			/*
8			* func.c - interface to calcomp functions.
9			*
10			* 4/7/86
11			*/
12
13			#include "ray.h"
14
15			#include "otypes.h"
16
17	greg	2.2	#include "func.h"
18	greg	1.1
19	greg	2.2
20	greg	1.21	#define INITFILE "rayinit.cal"
21	greg	2.2	#define REFVNAME "`FILE_REFCNT"
22			#define CALSUF ".cal"
23			#define LCALSUF 4
24	greg	1.21
25	greg	1.13	XF unitxf = { /* identity transform */
26			1.0, 0.0, 0.0, 0.0,
27			0.0, 1.0, 0.0, 0.0,
28			0.0, 0.0, 1.0, 0.0,
29			0.0, 0.0, 0.0, 1.0,
30			1.0
31			};
32
33	greg	1.12	XF funcxf; /* current transformation */
34			static OBJREC fobj = NULL; / current function object */
35			static RAY fray = NULL; / current function ray */
36	greg	1.1
37	greg	2.2	static double l_erf(), l_erfc(), l_arg();
38	greg	1.1
39	greg	2.2
40			MFUNC *
41			getfunc(m, ff, ef, dofwd) /* get function for this modifier */
42	greg	1.1	OBJREC *m;
43	greg	2.2	int ff;
44			unsigned ef;
45			int dofwd;
46			{
47			extern EPNODE *curfunc;
48			static char initfile[] = INITFILE;
49			char sbuf[MAXSTR];
50			register char **arg;
51			register MFUNC *f;
52			int ne, na;
53			register int i;
54			/* check to see if done already */
55			if ((f = (MFUNC *)m->os) != NULL)
56			return(f);
57			if (initfile[0]) { /* initialize on first call */
58			setcontext("");
59			scompile("Dx=$1;Dy=$2;Dz=$3;", NULL, 0);
60			scompile("Nx=$4;Ny=$5;Nz=$6;", NULL, 0);
61			scompile("Px=$7;Py=$8;Pz=$9;", NULL, 0);
62			scompile("T=$10;Rdot=$11;", NULL, 0);
63			scompile("S=$12;Tx=$13;Ty=$14;Tz=$15;", NULL, 0);
64			scompile("Ix=$16;Iy=$17;Iz=$18;", NULL, 0);
65			scompile("Jx=$19;Jy=$20;Jz=$21;", NULL, 0);
66			scompile("Kx=$22;Ky=$23;Kz=$24;", NULL, 0);
67			funset("arg", 1, '=', l_arg);
68			funset("erf", 1, ':', l_erf);
69			funset("erfc", 1, ':', l_erfc);
70			setnoisefuncs();
71			loadfunc(initfile);
72			initfile[0] = '\0';
73			}
74			if ((na = m->oargs.nsargs) <= ff)
75			goto toofew;
76			arg = m->oargs.sarg;
77			if ((f = (MFUNC *)calloc(1, sizeof(MFUNC))) == NULL)
78			goto memerr;
79			i = strlen(arg[ff]); /* set up context */
80			if (i == 1 && arg[ff][0] == '.')
81			setcontext(f->ctx = ""); /* "." means no file */
82			else {
83			strcpy(sbuf,m->oargs.sarg[ff]); /* file name is context */
84			if (i > LCALSUF && !strcmp(sbuf+i-LCALSUF, CALSUF))
85			sbuf[i-LCALSUF] = '\0'; /* remove suffix */
86			setcontext(f->ctx = savestr(sbuf));
87			if (!vardefined(REFVNAME)) { /* file loaded? */
88			loadfunc(m->oargs.sarg[ff]);
89			varset(REFVNAME, '=', 1.0);
90			} else /* reference_count++ */
91			varset(REFVNAME, '=', varvalue(REFVNAME)+1.0);
92			}
93			curfunc = NULL; /* parse expressions */
94			sprintf(sbuf, "%s \"%s\"", ofun[m->otype].funame, m->oname);
95			for (i=0, ne=0; ef && i < na; i++, ef>>=1)
96			if (ef & 1) { /* flagged as an expression? */
97			if (ne >= MAXEXPR)
98			objerror(m, INTERNAL, "too many expressions");
99			initstr(arg[i], sbuf, 0);
100			f->ep[ne++] = getE1();
101			if (nextc != EOF)
102			syntax("unexpected character");
103			}
104			if (ef)
105			goto toofew;
106			if (i <= ff) /* find transform args */
107			i = ff+1;
108			while (i < na && arg[i][0] != '-')
109			i++;
110			if (i == na) /* no transform */
111			f->f = f->b = &unitxf;
112			else { /* get transform */
113			if ((f->b = (XF *)malloc(sizeof(XF))) == NULL)
114	greg	2.3	goto memerr;
115	greg	2.2	if (invxf(f->b, na-i, arg+i) != na-i)
116			objerror(m, USER, "bad transform");
117			if (f->b->sca < 0.0)
118			f->b->sca = -f->b->sca;
119			if (dofwd) { /* do both transforms */
120			if ((f->f = (XF *)malloc(sizeof(XF))) == NULL)
121	greg	2.3	goto memerr;
122	greg	2.2	xf(f->f, na-i, arg+i);
123			if (f->f->sca < 0.0)
124			f->f->sca = -f->f->sca;
125			}
126			}
127			m->os = (char *)f;
128			return(f);
129			toofew:
130			objerror(m, USER, "too few arguments");
131			memerr:
132			error(SYSTEM, "out of memory in getfunc");
133			}
134
135
136			freefunc(m) /* free memory associated with modifier */
137			OBJREC *m;
138			{
139			register MFUNC *f;
140			register int i;
141
142			if ((f = (MFUNC *)m->os) == NULL)
143			return;
144			for (i = 0; f->ep[i] != NULL; i++)
145			epfree(f->ep[i]);
146			if (f->ctx[0]) { /* done with definitions */
147			setcontext(f->ctx);
148			i = varvalue(REFVNAME)-.5; /* reference_count-- */
149			if (i > 0)
150			varset(REFVNAME, '=', (double)i);
151			else
152			dcleanup(2); /* remove definitions */
153			freestr(f->ctx);
154			}
155			if (f->b != &unitxf)
156			free((char *)f->b);
157			if (f->f != NULL && f->f != &unitxf)
158			free((char *)f->f);
159			free((char *)f);
160			m->os = NULL;
161			}
162
163
164			setfunc(m, r) /* set channels for function call */
165			OBJREC *m;
166	greg	1.1	register RAY *r;
167			{
168	greg	1.16	static long lastrno = -1;
169	greg	2.2	register MFUNC *f;
170			/* get function */
171			if ((f = (MFUNC *)m->os) == NULL)
172			error(m, CONSISTENCY, "setfunc called before getfunc");
173			/* set evaluator context */
174			setcontext(f->ctx);
175			/* check to see if matrix set */
176	greg	1.16	if (m == fobj && r->rno == lastrno)
177	greg	1.17	return(0);
178	greg	1.1	fobj = m;
179			fray = r;
180	greg	1.13	if (r->rox != NULL)
181	greg	2.2	if (f->b != &unitxf) {
182			funcxf.sca = r->rox->b.sca * f->b->sca;
183			multmat4(funcxf.xfm, r->rox->b.xfm, f->b->xfm);
184	greg	1.13	} else
185			copystruct(&funcxf, &r->rox->b);
186			else
187	greg	2.2	copystruct(&funcxf, f->b);
188	greg	1.16	lastrno = r->rno;
189	greg	1.1	eclock++; /* notify expression evaluator */
190	greg	1.17	return(1);
191	greg	1.1	}
192
193
194			loadfunc(fname) /* load definition file */
195			char *fname;
196			{
197			extern char libpath; / library search path */
198			char *ffname;
199
200	greg	1.6	if ((ffname = getpath(fname, libpath, R_OK)) == NULL) {
201	greg	1.1	sprintf(errmsg, "cannot find function file \"%s\"", fname);
202			error(USER, errmsg);
203			}
204			fcompile(ffname);
205			}
206
207
208	greg	2.2	static double
209	greg	1.1	l_arg() /* return nth real argument */
210			{
211			extern double argument();
212			register int n;
213
214			n = argument(1) + .5; /* round to integer */
215
216			if (n < 1)
217			return(fobj->oargs.nfargs);
218
219			if (n > fobj->oargs.nfargs) {
220			sprintf(errmsg, "missing real argument %d", n);
221			objerror(fobj, USER, errmsg);
222			}
223			return(fobj->oargs.farg[n-1]);
224	greg	1.19	}
225
226
227	greg	2.2	static double
228	greg	1.19	l_erf() /* error function */
229			{
230			extern double erf();
231
232			return(erf(argument(1)));
233			}
234
235
236	greg	2.2	static double
237	greg	1.19	l_erfc() /* cumulative error function */
238			{
239			extern double erfc();
240
241			return(erfc(argument(1)));
242	greg	1.1	}
243
244
245			double
246			chanvalue(n) /* return channel n to calcomp */
247			register int n;
248			{
249	greg	1.8	double sum;
250	greg	1.1	register RAY *r;
251
252	greg	1.10	if (--n < 0)
253			goto badchan;
254	greg	1.1
255	greg	1.8	if (n < 3) /* ray direction */
256	greg	1.1
257	greg	1.12	return( ( fray->rdir[0]*funcxf.xfm[0][n] +
258			fray->rdir[1]*funcxf.xfm[1][n] +
259			fray->rdir[2]*funcxf.xfm[2][n] )
260			/ funcxf.sca );
261	greg	1.1
262	greg	1.8	if (n < 6) /* surface normal */
263
264	greg	1.12	return( ( fray->ron[0]*funcxf.xfm[0][n-3] +
265			fray->ron[1]*funcxf.xfm[1][n-3] +
266			fray->ron[2]*funcxf.xfm[2][n-3] )
267			/ funcxf.sca );
268	greg	1.8
269			if (n < 9) /* intersection */
270
271	greg	1.12	return( fray->rop[0]*funcxf.xfm[0][n-6] +
272			fray->rop[1]*funcxf.xfm[1][n-6] +
273			fray->rop[2]*funcxf.xfm[2][n-6] +
274			funcxf.xfm[3][n-6] );
275	greg	1.8
276	greg	1.10	if (n == 9) { /* distance */
277
278			sum = fray->rot;
279			for (r = fray->parent; r != NULL; r = r->parent)
280			sum += r->rot;
281	greg	1.12	return(sum * funcxf.sca);
282	greg	1.10
283			}
284	greg	1.18	if (n == 10) /* dot product (range [-1,1]) */
285			return( fray->rod <= -1.0 ? -1.0 :
286			fray->rod >= 1.0 ? 1.0 :
287			fray->rod );
288	greg	1.10
289	greg	1.8	if (n == 11) /* scale */
290	greg	1.12	return(funcxf.sca);
291	greg	1.8
292			if (n < 15) /* origin */
293	greg	1.12	return(funcxf.xfm[3][n-12]);
294	greg	1.8
295			if (n < 18) /* i unit vector */
296	greg	1.12	return(funcxf.xfm[0][n-15] / funcxf.sca);
297	greg	1.8
298			if (n < 21) /* j unit vector */
299	greg	1.12	return(funcxf.xfm[1][n-15] / funcxf.sca);
300	greg	1.8
301			if (n < 24) /* k unit vector */
302	greg	1.12	return(funcxf.xfm[2][n-21] / funcxf.sca);
303	greg	1.10	badchan:
304			error(USER, "illegal channel number");
305	greg	1.1	}