src/rt/func.c

/* Copyright (c) 1995 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  CALSUF         ".cal"
#define  LCALSUF        4
char  REFVNAME[] = "`FILE_REFCNT";

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);
        fobj = NULL; fray = NULL;
        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;Ts=$25;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();
                setprismfuncs();
                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,arg[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(arg[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 string 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 unsigned long  lastrno = ~0;
        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  *getlibpath();     /* library search path */
        char  *ffname;

        if ((ffname = getpath(fname, getlibpath(), 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;

        if (fobj == NULL)
                syntax("arg(n) used in constant expression");

        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;
{
        if (fray == NULL)
                syntax("ray parameter used in constant expression");

        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)                     /* total distance */
                return(raydist(fray,PRIMARY) * 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);

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