--- ray/src/common/xf.c 1989/03/24 16:59:48 1.2 +++ ray/src/common/xf.c 1991/10/23 15:19:25 1.11 @@ -1,4 +1,4 @@ -/* Copyright (c) 1986 Regents of the University of California */ +/* Copyright (c) 1990 Regents of the University of California */ #ifndef lint static char SCCSid[] = "$SunId$ LBL"; @@ -10,24 +10,31 @@ static char SCCSid[] = "$SunId$ LBL"; * 1/28/86 */ +#include "standard.h" -#define PI 3.14159265358979323846 +#define d2r(a) ((PI/180.)*(a)) -#define checkarg(a,n) if (strcmp(av[i],a) || i+n >= ac) return(i) +#define checkarg(a,n) if (av[i][a] || i+n >= ac) goto done int -xf(xfmat, xfsca, ac, av) /* get transform specification */ -double xfmat[4][4]; -double *xfsca; +xf(ret, ac, av) /* get transform specification */ +register XF *ret; int ac; char *av[]; { double atof(), sin(), cos(); - double m4[4][4]; - double theta; - int i; + MAT4 xfmat, m4; + double xfsca, dtmp; + int i, icnt; + setident4(ret->xfm); + ret->sca = 1.0; + + icnt = 1; + setident4(xfmat); + xfsca = 1.0; + for (i = 0; i < ac && av[i][0] == '-'; i++) { setident4(m4); @@ -35,7 +42,7 @@ char *av[]; switch (av[i][1]) { case 't': /* translate */ - checkarg("-t",3); + checkarg(2,3); m4[3][0] = atof(av[++i]); m4[3][1] = atof(av[++i]); m4[3][2] = atof(av[++i]); @@ -44,22 +51,22 @@ char *av[]; case 'r': /* rotate */ switch (av[i][2]) { case 'x': - checkarg("-rx",1); - theta = PI/180.0 * atof(av[++i]); - m4[1][1] = m4[2][2] = cos(theta); - m4[2][1] = -(m4[1][2] = sin(theta)); + checkarg(3,1); + dtmp = d2r(atof(av[++i])); + m4[1][1] = m4[2][2] = cos(dtmp); + m4[2][1] = -(m4[1][2] = sin(dtmp)); break; case 'y': - checkarg("-ry",1); - theta = PI/180 * atof(av[++i]); - m4[0][0] = m4[2][2] = cos(theta); - m4[0][2] = -(m4[2][0] = sin(theta)); + checkarg(3,1); + dtmp = d2r(atof(av[++i])); + m4[0][0] = m4[2][2] = cos(dtmp); + m4[0][2] = -(m4[2][0] = sin(dtmp)); break; case 'z': - checkarg("-rz",1); - theta = PI/180 * atof(av[++i]); - m4[0][0] = m4[1][1] = cos(theta); - m4[1][0] = -(m4[0][1] = sin(theta)); + checkarg(3,1); + dtmp = d2r(atof(av[++i])); + m4[0][0] = m4[1][1] = cos(dtmp); + m4[1][0] = -(m4[0][1] = sin(dtmp)); break; default: return(i); @@ -67,28 +74,31 @@ char *av[]; break; case 's': /* scale */ - checkarg("-s",1); - *xfsca *= + checkarg(2,1); + dtmp = atof(av[i+1]); + if (dtmp == 0.0) goto done; + i++; + xfsca *= m4[0][0] = m4[1][1] = - m4[2][2] = atof(av[++i]); + m4[2][2] = dtmp; break; case 'm': /* mirror */ switch (av[i][2]) { case 'x': - checkarg("-mx",0); - *xfsca *= + checkarg(3,0); + xfsca *= m4[0][0] = -1.0; break; case 'y': - checkarg("-my",0); - *xfsca *= + checkarg(3,0); + xfsca *= m4[1][1] = -1.0; break; case 'z': - checkarg("-mz",0); - *xfsca *= + checkarg(3,0); + xfsca *= m4[2][2] = -1.0; break; default: @@ -96,29 +106,50 @@ char *av[]; } break; + case 'i': /* iterate */ + checkarg(2,1); + while (icnt-- > 0) { + multmat4(ret->xfm, ret->xfm, xfmat); + ret->sca *= xfsca; + } + icnt = atoi(av[++i]); + setident4(xfmat); + xfsca = 1.0; + continue; + default: return(i); } multmat4(xfmat, xfmat, m4); } +done: + while (icnt-- > 0) { + multmat4(ret->xfm, ret->xfm, xfmat); + ret->sca *= xfsca; + } return(i); } -#ifdef INVXF int -invxf(xfmat, xfsca, ac, av) /* invert transform specification */ -double xfmat[4][4]; -double *xfsca; +invxf(ret, ac, av) /* invert transform specification */ +register XF *ret; int ac; char *av[]; { double atof(), sin(), cos(); - double m4[4][4]; - double theta; - int i; + MAT4 xfmat, m4; + double xfsca, dtmp; + int i, icnt; + setident4(ret->xfm); + ret->sca = 1.0; + + icnt = 1; + setident4(xfmat); + xfsca = 1.0; + for (i = 0; i < ac && av[i][0] == '-'; i++) { setident4(m4); @@ -126,7 +157,7 @@ char *av[]; switch (av[i][1]) { case 't': /* translate */ - checkarg("-t",3); + checkarg(2,3); m4[3][0] = -atof(av[++i]); m4[3][1] = -atof(av[++i]); m4[3][2] = -atof(av[++i]); @@ -135,22 +166,22 @@ char *av[]; case 'r': /* rotate */ switch (av[i][2]) { case 'x': - checkarg("-rx",1); - theta = -PI/180.0 * atof(av[++i]); - m4[1][1] = m4[2][2] = cos(theta); - m4[2][1] = -(m4[1][2] = sin(theta)); + checkarg(3,1); + dtmp = -d2r(atof(av[++i])); + m4[1][1] = m4[2][2] = cos(dtmp); + m4[2][1] = -(m4[1][2] = sin(dtmp)); break; case 'y': - checkarg("-ry",1); - theta = -PI/180.0 * atof(av[++i]); - m4[0][0] = m4[2][2] = cos(theta); - m4[0][2] = -(m4[2][0] = sin(theta)); + checkarg(3,1); + dtmp = -d2r(atof(av[++i])); + m4[0][0] = m4[2][2] = cos(dtmp); + m4[0][2] = -(m4[2][0] = sin(dtmp)); break; case 'z': - checkarg("-rz",1); - theta = -PI/180.0 * atof(av[++i]); - m4[0][0] = m4[1][1] = cos(theta); - m4[1][0] = -(m4[0][1] = sin(theta)); + checkarg(3,1); + dtmp = -d2r(atof(av[++i])); + m4[0][0] = m4[1][1] = cos(dtmp); + m4[1][0] = -(m4[0][1] = sin(dtmp)); break; default: return(i); @@ -158,28 +189,31 @@ char *av[]; break; case 's': /* scale */ - checkarg("-s",1); - *xfsca *= + checkarg(2,1); + dtmp = atof(av[i+1]); + if (dtmp == 0.0) goto done; + i++; + xfsca *= m4[0][0] = m4[1][1] = - m4[2][2] = 1.0 / atof(av[++i]); + m4[2][2] = 1.0 / dtmp; break; case 'm': /* mirror */ switch (av[i][2]) { case 'x': - checkarg("-mx",0); - *xfsca *= + checkarg(3,0); + xfsca *= m4[0][0] = -1.0; break; case 'y': - checkarg("-my",0); - *xfsca *= + checkarg(3,0); + xfsca *= m4[1][1] = -1.0; break; case 'z': - checkarg("-mz",0); - *xfsca *= + checkarg(3,0); + xfsca *= m4[2][2] = -1.0; break; default: @@ -187,12 +221,38 @@ char *av[]; } break; + case 'i': /* iterate */ + checkarg(2,1); + while (icnt-- > 0) { + multmat4(ret->xfm, xfmat, ret->xfm); + ret->sca *= xfsca; + } + icnt = atoi(av[++i]); + setident4(xfmat); + xfsca = 1.0; + break; + default: return(i); } multmat4(xfmat, m4, xfmat); /* left multiply */ } +done: + while (icnt-- > 0) { + multmat4(ret->xfm, xfmat, ret->xfm); + ret->sca *= xfsca; + } return(i); } -#endif + + +int +fullxf(fx, ac, av) /* compute both forward and inverse */ +FULLXF *fx; +int ac; +char *av[]; +{ + xf(&fx->f, ac, av); + return(invxf(&fx->b, ac, av)); +}