1 |
/* Copyright (c) 1994 Regents of the University of California */ |
2 |
|
3 |
#ifndef lint |
4 |
static char SCCSid[] = "$SunId$ LBL"; |
5 |
#endif |
6 |
|
7 |
/* |
8 |
* Parse an MGF file, converting or discarding unsupported entities |
9 |
*/ |
10 |
|
11 |
#include <stdio.h> |
12 |
#include <math.h> |
13 |
#include <ctype.h> |
14 |
#include <string.h> |
15 |
#include "parser.h" |
16 |
#include "lookup.h" |
17 |
#include "messages.h" |
18 |
|
19 |
/* |
20 |
* Global definitions of variables declared in parser.h |
21 |
*/ |
22 |
/* entity names */ |
23 |
|
24 |
char mg_ename[MG_NENTITIES][MG_MAXELEN] = MG_NAMELIST; |
25 |
|
26 |
/* Handler routines for each entity */ |
27 |
|
28 |
int (*mg_ehand[MG_NENTITIES])(); |
29 |
|
30 |
/* error messages */ |
31 |
|
32 |
char *mg_err[MG_NERRS] = MG_ERRLIST; |
33 |
|
34 |
MG_FCTXT *mg_file; /* current file context pointer */ |
35 |
|
36 |
int mg_nqcdivs = MG_NQCD; /* number of divisions per quarter circle */ |
37 |
|
38 |
/* |
39 |
* The idea with this parser is to compensate for any missing entries in |
40 |
* mg_ehand with alternate handlers that express these entities in terms |
41 |
* of others that the calling program can handle. |
42 |
* |
43 |
* In some cases, no alternate handler is possible because the entity |
44 |
* has no approximate equivalent. These entities are simply discarded. |
45 |
* |
46 |
* Certain entities are dependent on others, and mg_init() will fail |
47 |
* if the supported entities are not consistent. |
48 |
* |
49 |
* Some alternate entity handlers require that earlier entities be |
50 |
* noted in some fashion, and we therefore keep another array of |
51 |
* parallel support handlers to assist in this effort. |
52 |
*/ |
53 |
|
54 |
/* temporary settings for testing */ |
55 |
#define e_ies e_any_toss |
56 |
/* alternate handler routines */ |
57 |
|
58 |
static int e_any_toss(), /* discard unneeded entity */ |
59 |
e_ies(), /* IES luminaire file */ |
60 |
e_include(), /* include file */ |
61 |
e_sph(), /* sphere */ |
62 |
e_cyl(), /* cylinder */ |
63 |
e_cone(), /* cone */ |
64 |
e_ring(), /* ring */ |
65 |
e_torus(); /* torus */ |
66 |
|
67 |
/* alternate handler support functions */ |
68 |
|
69 |
static int (*e_supp[MG_NENTITIES])(); |
70 |
|
71 |
static char FLTFMT[] = "%.12g"; |
72 |
|
73 |
static int warpconends; /* hack for generating good normals */ |
74 |
|
75 |
|
76 |
void |
77 |
mg_init() /* initialize alternate entity handlers */ |
78 |
{ |
79 |
unsigned long ineed = 0, uneed = 0; |
80 |
register int i; |
81 |
/* pick up slack */ |
82 |
if (mg_ehand[MG_E_IES] == NULL) |
83 |
mg_ehand[MG_E_IES] = e_ies; |
84 |
if (mg_ehand[MG_E_INCLUDE] == NULL) |
85 |
mg_ehand[MG_E_INCLUDE] = e_include; |
86 |
if (mg_ehand[MG_E_SPH] == NULL) { |
87 |
mg_ehand[MG_E_SPH] = e_sph; |
88 |
ineed |= 1<<MG_E_POINT|1<<MG_E_VERTEX; |
89 |
} else |
90 |
uneed |= 1<<MG_E_POINT|1<<MG_E_VERTEX|1<<MG_E_XF; |
91 |
if (mg_ehand[MG_E_CYL] == NULL) { |
92 |
mg_ehand[MG_E_CYL] = e_cyl; |
93 |
ineed |= 1<<MG_E_POINT|1<<MG_E_VERTEX; |
94 |
} else |
95 |
uneed |= 1<<MG_E_POINT|1<<MG_E_VERTEX|1<<MG_E_XF; |
96 |
if (mg_ehand[MG_E_CONE] == NULL) { |
97 |
mg_ehand[MG_E_CONE] = e_cone; |
98 |
ineed |= 1<<MG_E_POINT|1<<MG_E_VERTEX; |
99 |
} else |
100 |
uneed |= 1<<MG_E_POINT|1<<MG_E_VERTEX|1<<MG_E_XF; |
101 |
if (mg_ehand[MG_E_RING] == NULL) { |
102 |
mg_ehand[MG_E_RING] = e_ring; |
103 |
ineed |= 1<<MG_E_POINT|1<<MG_E_NORMAL|1<<MG_E_VERTEX; |
104 |
} else |
105 |
uneed |= 1<<MG_E_POINT|1<<MG_E_NORMAL|1<<MG_E_VERTEX|1<<MG_E_XF; |
106 |
if (mg_ehand[MG_E_TORUS] == NULL) { |
107 |
mg_ehand[MG_E_TORUS] = e_torus; |
108 |
ineed |= 1<<MG_E_POINT|1<<MG_E_NORMAL|1<<MG_E_VERTEX; |
109 |
} else |
110 |
uneed |= 1<<MG_E_POINT|1<<MG_E_NORMAL|1<<MG_E_VERTEX|1<<MG_E_XF; |
111 |
/* check for consistency */ |
112 |
if (mg_ehand[MG_E_FACE] != NULL) |
113 |
uneed |= 1<<MG_E_POINT|1<<MG_E_VERTEX|1<<MG_E_XF; |
114 |
if (mg_ehand[MG_E_CXY] != NULL) |
115 |
uneed |= 1<<MG_E_COLOR; |
116 |
if (mg_ehand[MG_E_RD] != NULL || mg_ehand[MG_E_TD] != NULL || |
117 |
mg_ehand[MG_E_ED] != NULL || |
118 |
mg_ehand[MG_E_RS] != NULL || |
119 |
mg_ehand[MG_E_TS] != NULL) |
120 |
uneed |= 1<<MG_E_MATERIAL; |
121 |
for (i = 0; i < MG_NENTITIES; i++) |
122 |
if (uneed & 1<<i && mg_ehand[i] == NULL) { |
123 |
fprintf(stderr, "Missing support for \"%s\" entity\n", |
124 |
mg_ename[i]); |
125 |
exit(1); |
126 |
} |
127 |
/* add support as needed */ |
128 |
if (ineed & 1<<MG_E_VERTEX && mg_ehand[MG_E_VERTEX] != c_hvertex) |
129 |
e_supp[MG_E_VERTEX] = c_hvertex; |
130 |
if (ineed & 1<<MG_E_POINT && mg_ehand[MG_E_POINT] != c_hvertex) |
131 |
e_supp[MG_E_POINT] = c_hvertex; |
132 |
if (ineed & 1<<MG_E_NORMAL && mg_ehand[MG_E_NORMAL] != c_hvertex) |
133 |
e_supp[MG_E_NORMAL] = c_hvertex; |
134 |
/* discard remaining entities */ |
135 |
for (i = 0; i < MG_NENTITIES; i++) |
136 |
if (mg_ehand[i] == NULL) |
137 |
mg_ehand[i] = e_any_toss; |
138 |
} |
139 |
|
140 |
|
141 |
|
142 |
int |
143 |
mg_entity(name) /* get entity number from its name */ |
144 |
char *name; |
145 |
{ |
146 |
static LUTAB ent_tab; /* entity lookup table */ |
147 |
register char *cp; |
148 |
|
149 |
if (!ent_tab.tsiz) { /* initialize hash table */ |
150 |
if (!lu_init(&ent_tab, MG_NENTITIES)) |
151 |
return(-1); /* what to do? */ |
152 |
for (cp = mg_ename[MG_NENTITIES-1]; cp >= mg_ename[0]; |
153 |
cp -= sizeof(mg_ename[0])) |
154 |
lu_find(&ent_tab, cp)->key = cp; |
155 |
} |
156 |
cp = lu_find(&ent_tab, name)->key; |
157 |
if (cp == NULL) |
158 |
return(-1); |
159 |
return((cp - mg_ename[0])/sizeof(mg_ename[0])); |
160 |
} |
161 |
|
162 |
|
163 |
static int |
164 |
handle_it(en, ac, av) /* pass entity to appropriate handler */ |
165 |
register int en; |
166 |
int ac; |
167 |
char **av; |
168 |
{ |
169 |
int rv; |
170 |
|
171 |
if (en < 0 && (en = mg_entity(av[0])) < 0) |
172 |
return(MG_EUNK); |
173 |
if (e_supp[en] != NULL) { |
174 |
if ((rv = (*e_supp[en])(ac, av)) != MG_OK) |
175 |
return(rv); |
176 |
} |
177 |
return((*mg_ehand[en])(ac, av)); |
178 |
} |
179 |
|
180 |
|
181 |
int |
182 |
mg_open(ctx, fn) /* open new input file */ |
183 |
register MG_FCTXT *ctx; |
184 |
char *fn; |
185 |
{ |
186 |
int olen; |
187 |
register char *cp; |
188 |
|
189 |
ctx->lineno = 0; |
190 |
if (fn == NULL) { |
191 |
ctx->fname = "<stdin>"; |
192 |
ctx->fp = stdin; |
193 |
ctx->prev = mg_file; |
194 |
mg_file = ctx; |
195 |
return(MG_OK); |
196 |
} |
197 |
/* get name relative to this context */ |
198 |
if (mg_file != NULL && |
199 |
(cp = strrchr(mg_file->fname, '/')) != NULL) |
200 |
olen = cp - mg_file->fname + 1; |
201 |
else |
202 |
olen = 0; |
203 |
ctx->fname = (char *)malloc(olen+strlen(fn)+1); |
204 |
if (ctx->fname == NULL) |
205 |
return(MG_EMEM); |
206 |
if (olen) |
207 |
strcpy(ctx->fname, mg_file->fname); |
208 |
strcpy(ctx->fname+olen, fn); |
209 |
ctx->fp = fopen(ctx->fname, "r"); |
210 |
if (ctx->fp == NULL) { |
211 |
free((MEM_PTR)ctx->fname); |
212 |
return(MG_ENOFILE); |
213 |
} |
214 |
ctx->prev = mg_file; /* establish new context */ |
215 |
mg_file = ctx; |
216 |
return(MG_OK); |
217 |
} |
218 |
|
219 |
|
220 |
void |
221 |
mg_close() /* close input file */ |
222 |
{ |
223 |
register MG_FCTXT *ctx = mg_file; |
224 |
|
225 |
mg_file = ctx->prev; /* restore enclosing context */ |
226 |
if (ctx->fp == stdin) |
227 |
return; /* don't close standard input */ |
228 |
fclose(ctx->fp); |
229 |
free((MEM_PTR)ctx->fname); |
230 |
} |
231 |
|
232 |
|
233 |
int |
234 |
mg_rewind() /* rewind input file */ |
235 |
{ |
236 |
if (mg_file->lineno == 0) |
237 |
return(MG_OK); |
238 |
if (mg_file->fp == stdin) |
239 |
return(MG_ESEEK); /* cannot seek on standard input */ |
240 |
if (fseek(mg_file->fp, 0L, 0) == EOF) |
241 |
return(MG_ESEEK); |
242 |
mg_file->lineno = 0; |
243 |
return(MG_OK); |
244 |
} |
245 |
|
246 |
|
247 |
int |
248 |
mg_read() /* read next line from file */ |
249 |
{ |
250 |
register int len = 0; |
251 |
|
252 |
do { |
253 |
if (fgets(mg_file->inpline+len, |
254 |
MG_MAXLINE-len, mg_file->fp) == NULL) |
255 |
return(len); |
256 |
mg_file->lineno++; |
257 |
len += strlen(mg_file->inpline+len); |
258 |
if (len > 1 && mg_file->inpline[len-2] == '\\') |
259 |
mg_file->inpline[--len-1] = ' '; |
260 |
} while (mg_file->inpline[len]); |
261 |
|
262 |
return(len); |
263 |
} |
264 |
|
265 |
|
266 |
int |
267 |
mg_parse() /* parse current input line */ |
268 |
{ |
269 |
char abuf[MG_MAXLINE]; |
270 |
char *argv[MG_MAXARGC]; |
271 |
int en; |
272 |
register char *cp, **ap; |
273 |
|
274 |
strcpy(cp=abuf, mg_file->inpline); |
275 |
ap = argv; /* break into words */ |
276 |
for ( ; ; ) { |
277 |
while (isspace(*cp)) |
278 |
*cp++ = '\0'; |
279 |
if (!*cp) |
280 |
break; |
281 |
if (ap - argv >= MG_MAXARGC-1) |
282 |
return(MG_EARGC); |
283 |
*ap++ = cp; |
284 |
while (*++cp && !isspace(*cp)) |
285 |
; |
286 |
} |
287 |
if (ap == argv) |
288 |
return(MG_OK); /* no words in line */ |
289 |
*ap = NULL; |
290 |
/* else handle it */ |
291 |
return(handle_it(-1, ap-argv, argv)); |
292 |
} |
293 |
|
294 |
|
295 |
int |
296 |
mg_load(fn) /* load an MGF file */ |
297 |
char *fn; |
298 |
{ |
299 |
MG_FCTXT cntxt; |
300 |
int rval; |
301 |
|
302 |
if ((rval = mg_open(&cntxt, fn)) != MG_OK) { |
303 |
fprintf(stderr, "%s: %s\n", fn, mg_err[rval]); |
304 |
return(rval); |
305 |
} |
306 |
while (mg_read()) /* parse each line */ |
307 |
if ((rval = mg_parse()) != MG_OK) { |
308 |
fprintf(stderr, "%s: %d: %s:\n%s", cntxt.fname, |
309 |
cntxt.lineno, mg_err[rval], |
310 |
cntxt.inpline); |
311 |
break; |
312 |
} |
313 |
mg_close(); |
314 |
return(rval); |
315 |
} |
316 |
|
317 |
|
318 |
void |
319 |
mg_clear() /* clear parser history */ |
320 |
{ |
321 |
c_clearall(); /* clear context tables */ |
322 |
mg_file = NULL; /* reset our context */ |
323 |
} |
324 |
|
325 |
|
326 |
int |
327 |
mg_iterate(ac, av, f) /* iterate on statement */ |
328 |
int ac; |
329 |
register char **av; |
330 |
int (*f)(); |
331 |
{ |
332 |
int niter, rval; |
333 |
register int i, j; |
334 |
char *argv[MG_MAXARGC]; |
335 |
char cntbuf[10]; |
336 |
/* build partial transformation */ |
337 |
for (i = 0; i < ac; i++) { |
338 |
if (av[i][0] == '-' && av[i][1] == 'a' && av[i][2] == '\0') |
339 |
break; |
340 |
argv[i+1] = av[i]; |
341 |
} |
342 |
argv[i+1] = NULL; |
343 |
if (i) { /* handle transformation */ |
344 |
argv[0] = mg_ename[MG_E_XF]; |
345 |
if ((rval = handle_it(MG_E_XF, i+1, argv)) != MG_OK) |
346 |
return(rval); |
347 |
} |
348 |
if (i < ac) { /* run array */ |
349 |
if (i+1 >= ac || !isint(av[i+1])) |
350 |
return(MG_ETYPE); |
351 |
niter = atoi(av[i+1]); |
352 |
argv[0] = mg_ename[MG_E_OBJECT]; |
353 |
argv[1] = cntbuf; |
354 |
for (j = 2; j+i < ac; j++) |
355 |
argv[j] = av[j+i]; |
356 |
argv[j] = NULL; |
357 |
for (j = 0; j < niter; j++) { |
358 |
sprintf(cntbuf, "%d", j); |
359 |
if ((rval = handle_it(MG_E_OBJECT, 2, argv)) != MG_OK) |
360 |
return(rval); |
361 |
argv[0] = "-i"; |
362 |
if ((rval = mg_iterate(ac-i, argv, f)) != MG_OK) |
363 |
return(rval); |
364 |
argv[0] = mg_ename[MG_E_OBJECT]; |
365 |
if ((rval = handle_it(MG_E_OBJECT, 1, argv)) != MG_OK) |
366 |
return(rval); |
367 |
} |
368 |
} else if ((rval = (*f)()) != MG_OK) /* else do this instance */ |
369 |
return(rval); |
370 |
if (i) { /* reset the transform */ |
371 |
argv[0] = mg_ename[MG_E_XF]; |
372 |
argv[1] = NULL; |
373 |
(void)handle_it(MG_E_XF, 1, argv); |
374 |
} |
375 |
return(MG_OK); |
376 |
} |
377 |
|
378 |
|
379 |
/**************************************************************************** |
380 |
* The following routines handle unsupported entities |
381 |
*/ |
382 |
|
383 |
|
384 |
static int |
385 |
e_any_toss(ac, av) /* discard an unwanted entity */ |
386 |
int ac; |
387 |
char **av; |
388 |
{ |
389 |
return(MG_OK); |
390 |
} |
391 |
|
392 |
|
393 |
static int |
394 |
reload_file() /* reload current MGF file */ |
395 |
{ |
396 |
register int rval; |
397 |
|
398 |
if ((rval = mg_rewind()) != MG_OK) |
399 |
return(rval); |
400 |
while (mg_read()) |
401 |
if ((rval = mg_parse()) != MG_OK) |
402 |
return(rval); |
403 |
return(MG_OK); |
404 |
} |
405 |
|
406 |
|
407 |
static int |
408 |
e_include(ac, av) /* include file */ |
409 |
int ac; |
410 |
char **av; |
411 |
{ |
412 |
MG_FCTXT ictx; |
413 |
int rv; |
414 |
|
415 |
if (ac < 2) |
416 |
return(MG_EARGC); |
417 |
if ((rv = mg_open(&ictx, av[1])) != MG_OK) |
418 |
return(rv); |
419 |
if ((rv = mg_iterate(ac-2, av+2, reload_file)) != MG_OK) { |
420 |
fprintf(stderr, "%s: %d: %s:\n%s", ictx.fname, |
421 |
ictx.lineno, mg_err[rv], ictx.inpline); |
422 |
mg_close(); |
423 |
return(MG_EINCL); |
424 |
} |
425 |
mg_close(); |
426 |
return(MG_OK); |
427 |
} |
428 |
|
429 |
|
430 |
static void |
431 |
make_axes(u, v, w) /* compute u and v given w (normalized) */ |
432 |
FVECT u, v, w; |
433 |
{ |
434 |
register int i; |
435 |
|
436 |
v[0] = v[1] = v[2] = 0.; |
437 |
for (i = 0; i < 3; i++) |
438 |
if (w[i] < .6 && w[i] > -.6) |
439 |
break; |
440 |
v[i] = 1.; |
441 |
fcross(u, v, w); |
442 |
normalize(u); |
443 |
fcross(v, w, u); |
444 |
} |
445 |
|
446 |
|
447 |
static int |
448 |
e_sph(ac, av) /* expand a sphere into cones */ |
449 |
int ac; |
450 |
char **av; |
451 |
{ |
452 |
static char p2x[24], p2y[24], p2z[24], r1[24], r2[24]; |
453 |
static char *v1ent[5] = {mg_ename[MG_E_VERTEX],"_sv1","=","_sv2"}; |
454 |
static char *v2ent[4] = {mg_ename[MG_E_VERTEX],"_sv2","="}; |
455 |
static char *p2ent[5] = {mg_ename[MG_E_POINT],p2x,p2y,p2z}; |
456 |
static char *conent[6] = {mg_ename[MG_E_CONE],"_sv1",r1,"_sv2",r2}; |
457 |
register C_VERTEX *cv; |
458 |
register int i; |
459 |
int rval; |
460 |
double rad; |
461 |
double theta; |
462 |
|
463 |
if (ac != 3) |
464 |
return(MG_EARGC); |
465 |
if ((cv = c_getvert(av[1])) == NULL) |
466 |
return(MG_EUNDEF); |
467 |
if (!isflt(av[2])) |
468 |
return(MG_ETYPE); |
469 |
rad = atof(av[2]); |
470 |
/* initialize */ |
471 |
warpconends = 1; |
472 |
if ((rval = handle_it(MG_E_VERTEX, 3, v2ent)) != MG_OK) |
473 |
return(rval); |
474 |
sprintf(p2x, FLTFMT, cv->p[0]); |
475 |
sprintf(p2y, FLTFMT, cv->p[1]); |
476 |
sprintf(p2z, FLTFMT, cv->p[2]+rad); |
477 |
if ((rval = handle_it(MG_E_POINT, 4, p2ent)) != MG_OK) |
478 |
return(rval); |
479 |
r2[0] = '0'; r2[1] = '\0'; |
480 |
for (i = 1; i <= 2*mg_nqcdivs; i++) { |
481 |
theta = i*(PI/2)/mg_nqcdivs; |
482 |
if ((rval = handle_it(MG_E_VERTEX, 4, v1ent)) != MG_OK) |
483 |
return(rval); |
484 |
sprintf(p2z, FLTFMT, cv->p[2]+rad*cos(theta)); |
485 |
if ((rval = handle_it(MG_E_VERTEX, 2, v2ent)) != MG_OK) |
486 |
return(rval); |
487 |
if ((rval = handle_it(MG_E_POINT, 4, p2ent)) != MG_OK) |
488 |
return(rval); |
489 |
strcpy(r1, r2); |
490 |
sprintf(r2, FLTFMT, rad*sin(theta)); |
491 |
if ((rval = handle_it(MG_E_CONE, 5, conent)) != MG_OK) |
492 |
return(rval); |
493 |
} |
494 |
warpconends = 0; |
495 |
return(MG_OK); |
496 |
} |
497 |
|
498 |
|
499 |
static int |
500 |
e_torus(ac, av) /* expand a torus into cones */ |
501 |
int ac; |
502 |
char **av; |
503 |
{ |
504 |
static char p2[3][24], r1[24], r2[24]; |
505 |
static char *v1ent[5] = {mg_ename[MG_E_VERTEX],"_tv1","=","_tv2"}; |
506 |
static char *v2ent[5] = {mg_ename[MG_E_VERTEX],"_tv2","="}; |
507 |
static char *p2ent[5] = {mg_ename[MG_E_POINT],p2[0],p2[1],p2[2]}; |
508 |
static char *conent[6] = {mg_ename[MG_E_CONE],"_tv1",r1,"_tv2",r2}; |
509 |
register C_VERTEX *cv; |
510 |
register int i, j; |
511 |
int rval; |
512 |
int sgn; |
513 |
double minrad, maxrad, avgrad; |
514 |
double theta; |
515 |
|
516 |
if (ac != 4) |
517 |
return(MG_EARGC); |
518 |
if ((cv = c_getvert(av[1])) == NULL) |
519 |
return(MG_EUNDEF); |
520 |
if (is0vect(cv->n)) |
521 |
return(MG_EILL); |
522 |
if (!isflt(av[2]) || !isflt(av[3])) |
523 |
return(MG_ETYPE); |
524 |
minrad = atof(av[2]); |
525 |
round0(minrad); |
526 |
maxrad = atof(av[3]); |
527 |
/* check orientation */ |
528 |
if (minrad > 0.) |
529 |
sgn = 1; |
530 |
else if (minrad < 0.) |
531 |
sgn = -1; |
532 |
else if (maxrad > 0.) |
533 |
sgn = 1; |
534 |
else if (maxrad < 0.) |
535 |
sgn = -1; |
536 |
else |
537 |
return(MG_EILL); |
538 |
if (sgn*(maxrad-minrad) <= 0.) |
539 |
return(MG_EILL); |
540 |
/* initialize */ |
541 |
warpconends = 1; |
542 |
v2ent[3] = av[1]; |
543 |
for (j = 0; j < 3; j++) |
544 |
sprintf(p2[j], FLTFMT, cv->p[j] + |
545 |
.5*sgn*(maxrad-minrad)*cv->n[j]); |
546 |
if ((rval = handle_it(MG_E_VERTEX, 4, v2ent)) != MG_OK) |
547 |
return(rval); |
548 |
if ((rval = handle_it(MG_E_POINT, 4, p2ent)) != MG_OK) |
549 |
return(rval); |
550 |
sprintf(r2, FLTFMT, avgrad=.5*(minrad+maxrad)); |
551 |
/* run outer section */ |
552 |
for (i = 1; i <= 2*mg_nqcdivs; i++) { |
553 |
theta = i*(PI/2)/mg_nqcdivs; |
554 |
if ((rval = handle_it(MG_E_VERTEX, 4, v1ent)) != MG_OK) |
555 |
return(rval); |
556 |
for (j = 0; j < 3; j++) |
557 |
sprintf(p2[j], FLTFMT, cv->p[j] + |
558 |
.5*sgn*(maxrad-minrad)*cos(theta)*cv->n[j]); |
559 |
if ((rval = handle_it(MG_E_VERTEX, 2, v2ent)) != MG_OK) |
560 |
return(rval); |
561 |
if ((rval = handle_it(MG_E_POINT, 4, p2ent)) != MG_OK) |
562 |
return(rval); |
563 |
strcpy(r1, r2); |
564 |
sprintf(r2, FLTFMT, avgrad + .5*(maxrad-minrad)*sin(theta)); |
565 |
if ((rval = handle_it(MG_E_CONE, 5, conent)) != MG_OK) |
566 |
return(rval); |
567 |
} |
568 |
/* run inner section */ |
569 |
sprintf(r2, FLTFMT, -.5*(minrad+maxrad)); |
570 |
for ( ; i <= 4*mg_nqcdivs; i++) { |
571 |
theta = i*(PI/2)/mg_nqcdivs; |
572 |
for (j = 0; j < 3; j++) |
573 |
sprintf(p2[j], FLTFMT, cv->p[j] + |
574 |
.5*sgn*(maxrad-minrad)*cos(theta)*cv->n[j]); |
575 |
if ((rval = handle_it(MG_E_VERTEX, 4, v1ent)) != MG_OK) |
576 |
return(rval); |
577 |
if ((rval = handle_it(MG_E_VERTEX, 2, v2ent)) != MG_OK) |
578 |
return(rval); |
579 |
if ((rval = handle_it(MG_E_POINT, 4, p2ent)) != MG_OK) |
580 |
return(rval); |
581 |
strcpy(r1, r2); |
582 |
sprintf(r2, FLTFMT, -avgrad - .5*(maxrad-minrad)*sin(theta)); |
583 |
if ((rval = handle_it(MG_E_CONE, 5, conent)) != MG_OK) |
584 |
return(rval); |
585 |
} |
586 |
warpconends = 0; |
587 |
return(MG_OK); |
588 |
} |
589 |
|
590 |
|
591 |
static int |
592 |
e_cyl(ac, av) /* replace a cylinder with equivalent cone */ |
593 |
int ac; |
594 |
char **av; |
595 |
{ |
596 |
static char *avnew[6] = {mg_ename[MG_E_CONE]}; |
597 |
|
598 |
if (ac != 4) |
599 |
return(MG_EARGC); |
600 |
avnew[1] = av[1]; |
601 |
avnew[2] = av[2]; |
602 |
avnew[3] = av[3]; |
603 |
avnew[4] = av[2]; |
604 |
return(handle_it(MG_E_CONE, 5, avnew)); |
605 |
} |
606 |
|
607 |
|
608 |
static int |
609 |
e_ring(ac, av) /* turn a ring into polygons */ |
610 |
int ac; |
611 |
char **av; |
612 |
{ |
613 |
static char p3[3][24], p4[3][24]; |
614 |
static char *nzent[5] = {mg_ename[MG_E_NORMAL],"0","0","0"}; |
615 |
static char *v1ent[5] = {mg_ename[MG_E_VERTEX],"_rv1","="}; |
616 |
static char *v2ent[5] = {mg_ename[MG_E_VERTEX],"_rv2","=","_rv3"}; |
617 |
static char *v3ent[4] = {mg_ename[MG_E_VERTEX],"_rv3","="}; |
618 |
static char *p3ent[5] = {mg_ename[MG_E_POINT],p3[0],p3[1],p3[2]}; |
619 |
static char *v4ent[4] = {mg_ename[MG_E_VERTEX],"_rv4","="}; |
620 |
static char *p4ent[5] = {mg_ename[MG_E_POINT],p4[0],p4[1],p4[2]}; |
621 |
static char *fent[6] = {mg_ename[MG_E_FACE],"_rv1","_rv2","_rv3","_rv4"}; |
622 |
register C_VERTEX *cv; |
623 |
register int i, j; |
624 |
FVECT u, v; |
625 |
double minrad, maxrad; |
626 |
int rv; |
627 |
double theta, d; |
628 |
|
629 |
if (ac != 4) |
630 |
return(MG_EARGC); |
631 |
if ((cv = c_getvert(av[1])) == NULL) |
632 |
return(MG_EUNDEF); |
633 |
if (is0vect(cv->n)) |
634 |
return(MG_EILL); |
635 |
if (!isflt(av[2]) || !isflt(av[3])) |
636 |
return(MG_ETYPE); |
637 |
minrad = atof(av[2]); |
638 |
round0(minrad); |
639 |
maxrad = atof(av[3]); |
640 |
if (minrad < 0. || maxrad <= minrad) |
641 |
return(MG_EILL); |
642 |
/* initialize */ |
643 |
make_axes(u, v, cv->n); |
644 |
for (j = 0; j < 3; j++) |
645 |
sprintf(p3[j], FLTFMT, cv->p[j] + maxrad*u[j]); |
646 |
if ((rv = handle_it(MG_E_VERTEX, 3, v3ent)) != MG_OK) |
647 |
return(rv); |
648 |
if ((rv = handle_it(MG_E_POINT, 4, p3ent)) != MG_OK) |
649 |
return(rv); |
650 |
if (minrad == 0.) { /* closed */ |
651 |
v1ent[3] = av[1]; |
652 |
if ((rv = handle_it(MG_E_VERTEX, 4, v1ent)) != MG_OK) |
653 |
return(rv); |
654 |
if ((rv = handle_it(MG_E_NORMAL, 4, nzent)) != MG_OK) |
655 |
return(rv); |
656 |
for (i = 1; i <= 4*mg_nqcdivs; i++) { |
657 |
theta = i*(PI/2)/mg_nqcdivs; |
658 |
if ((rv = handle_it(MG_E_VERTEX, 4, v2ent)) != MG_OK) |
659 |
return(rv); |
660 |
for (j = 0; j < 3; j++) |
661 |
sprintf(p3[j], FLTFMT, cv->p[j] + |
662 |
maxrad*u[j]*cos(theta) + |
663 |
maxrad*v[j]*sin(theta)); |
664 |
if ((rv = handle_it(MG_E_VERTEX, 2, v3ent)) != MG_OK) |
665 |
return(rv); |
666 |
if ((rv = handle_it(MG_E_POINT, 4, p3ent)) != MG_OK) |
667 |
return(rv); |
668 |
if ((rv = handle_it(MG_E_FACE, 4, fent)) != MG_OK) |
669 |
return(rv); |
670 |
} |
671 |
} else { /* open */ |
672 |
if ((rv = handle_it(MG_E_VERTEX, 3, v4ent)) != MG_OK) |
673 |
return(rv); |
674 |
for (j = 0; j < 3; j++) |
675 |
sprintf(p4[j], FLTFMT, cv->p[j] + minrad*u[j]); |
676 |
if ((rv = handle_it(MG_E_POINT, 4, p4ent)) != MG_OK) |
677 |
return(rv); |
678 |
v1ent[3] = "_rv4"; |
679 |
for (i = 1; i <= 4*mg_nqcdivs; i++) { |
680 |
theta = i*(PI/2)/mg_nqcdivs; |
681 |
if ((rv = handle_it(MG_E_VERTEX, 4, v1ent)) != MG_OK) |
682 |
return(rv); |
683 |
if ((rv = handle_it(MG_E_VERTEX, 4, v2ent)) != MG_OK) |
684 |
return(rv); |
685 |
for (j = 0; j < 3; j++) { |
686 |
d = u[j]*cos(theta) + v[j]*sin(theta); |
687 |
sprintf(p3[j], FLTFMT, cv->p[j] + maxrad*d); |
688 |
sprintf(p4[j], FLTFMT, cv->p[j] + minrad*d); |
689 |
} |
690 |
if ((rv = handle_it(MG_E_VERTEX, 2, v3ent)) != MG_OK) |
691 |
return(rv); |
692 |
if ((rv = handle_it(MG_E_POINT, 4, p3ent)) != MG_OK) |
693 |
return(rv); |
694 |
if ((rv = handle_it(MG_E_VERTEX, 2, v4ent)) != MG_OK) |
695 |
return(rv); |
696 |
if ((rv = handle_it(MG_E_POINT, 4, p4ent)) != MG_OK) |
697 |
return(rv); |
698 |
if ((rv = handle_it(MG_E_FACE, 5, fent)) != MG_OK) |
699 |
return(rv); |
700 |
} |
701 |
} |
702 |
return(MG_OK); |
703 |
} |
704 |
|
705 |
|
706 |
static int |
707 |
e_cone(ac, av) /* turn a cone into polygons */ |
708 |
int ac; |
709 |
char **av; |
710 |
{ |
711 |
static char p3[3][24], p4[3][24], n3[3][24], n4[3][24]; |
712 |
static char *v1ent[5] = {mg_ename[MG_E_VERTEX],"_cv1","="}; |
713 |
static char *v2ent[5] = {mg_ename[MG_E_VERTEX],"_cv2","=","_cv3"}; |
714 |
static char *v3ent[4] = {mg_ename[MG_E_VERTEX],"_cv3","="}; |
715 |
static char *p3ent[5] = {mg_ename[MG_E_POINT],p3[0],p3[1],p3[2]}; |
716 |
static char *n3ent[5] = {mg_ename[MG_E_NORMAL],n3[0],n3[1],n3[2]}; |
717 |
static char *v4ent[4] = {mg_ename[MG_E_VERTEX],"_cv4","="}; |
718 |
static char *p4ent[5] = {mg_ename[MG_E_POINT],p4[0],p4[1],p4[2]}; |
719 |
static char *n4ent[5] = {mg_ename[MG_E_NORMAL],n4[0],n4[1],n4[2]}; |
720 |
static char *fent[6] = {mg_ename[MG_E_FACE],"_cv1","_cv2","_cv3","_cv4"}; |
721 |
register C_VERTEX *cv1, *cv2; |
722 |
register int i, j; |
723 |
FVECT u, v, w; |
724 |
double rad1, rad2; |
725 |
int sgn; |
726 |
double n1off, n2off; |
727 |
double d; |
728 |
int rv; |
729 |
double theta; |
730 |
|
731 |
if (ac != 5) |
732 |
return(MG_EARGC); |
733 |
if ((cv1 = c_getvert(av[1])) == NULL || |
734 |
(cv2 = c_getvert(av[3])) == NULL) |
735 |
return(MG_EUNDEF); |
736 |
if (!isflt(av[2]) || !isflt(av[4])) |
737 |
return(MG_ETYPE); |
738 |
rad1 = atof(av[2]); |
739 |
round0(rad1); |
740 |
rad2 = atof(av[4]); |
741 |
round0(rad2); |
742 |
if (rad1 == 0.) { |
743 |
if (rad2 == 0.) |
744 |
return(MG_EILL); |
745 |
} else if (rad2 != 0.) { |
746 |
if (rad1 < 0. ^ rad2 < 0.) |
747 |
return(MG_EILL); |
748 |
} else { /* swap */ |
749 |
C_VERTEX *cv; |
750 |
|
751 |
cv = cv1; |
752 |
cv1 = cv2; |
753 |
cv2 = cv; |
754 |
d = rad1; |
755 |
rad1 = rad2; |
756 |
rad2 = d; |
757 |
} |
758 |
sgn = rad2 < 0. ? -1 : 1; |
759 |
/* initialize */ |
760 |
for (j = 0; j < 3; j++) |
761 |
w[j] = cv1->p[j] - cv2->p[j]; |
762 |
if ((d = normalize(w)) == 0.) |
763 |
return(MG_EILL); |
764 |
n1off = n2off = (rad2 - rad1)/d; |
765 |
if (warpconends) { /* hack for e_sph and e_torus */ |
766 |
d = atan(n2off) - (PI/4)/mg_nqcdivs; |
767 |
if (d <= -PI/2+FTINY) |
768 |
n2off = -FHUGE; |
769 |
else |
770 |
n2off = tan(d); |
771 |
} |
772 |
make_axes(u, v, w); |
773 |
for (j = 0; j < 3; j++) { |
774 |
sprintf(p3[j], FLTFMT, cv2->p[j] + rad2*u[j]); |
775 |
if (n2off <= -FHUGE) |
776 |
sprintf(n3[j], FLTFMT, -w[j]); |
777 |
else |
778 |
sprintf(n3[j], FLTFMT, u[j] + w[j]*n2off); |
779 |
} |
780 |
if ((rv = handle_it(MG_E_VERTEX, 3, v3ent)) != MG_OK) |
781 |
return(rv); |
782 |
if ((rv = handle_it(MG_E_POINT, 4, p3ent)) != MG_OK) |
783 |
return(rv); |
784 |
if ((rv = handle_it(MG_E_NORMAL, 4, n3ent)) != MG_OK) |
785 |
return(rv); |
786 |
if (rad1 == 0.) { /* triangles */ |
787 |
v1ent[3] = av[1]; |
788 |
if ((rv = handle_it(MG_E_VERTEX, 4, v1ent)) != MG_OK) |
789 |
return(rv); |
790 |
for (j = 0; j < 3; j++) |
791 |
sprintf(n4[j], FLTFMT, w[j]); |
792 |
if ((rv = handle_it(MG_E_NORMAL, 4, n4ent)) != MG_OK) |
793 |
return(rv); |
794 |
for (i = 1; i <= 4*mg_nqcdivs; i++) { |
795 |
theta = sgn*i*(PI/2)/mg_nqcdivs; |
796 |
if ((rv = handle_it(MG_E_VERTEX, 4, v2ent)) != MG_OK) |
797 |
return(rv); |
798 |
for (j = 0; j < 3; j++) { |
799 |
d = u[j]*cos(theta) + v[j]*sin(theta); |
800 |
sprintf(p3[j], FLTFMT, cv2->p[j] + rad2*d); |
801 |
if (n2off > -FHUGE) |
802 |
sprintf(n3[j], FLTFMT, d + w[j]*n2off); |
803 |
} |
804 |
if ((rv = handle_it(MG_E_VERTEX, 2, v3ent)) != MG_OK) |
805 |
return(rv); |
806 |
if ((rv = handle_it(MG_E_POINT, 4, p3ent)) != MG_OK) |
807 |
return(rv); |
808 |
if (n2off > -FHUGE && |
809 |
(rv = handle_it(MG_E_NORMAL, 4, n3ent)) != MG_OK) |
810 |
return(rv); |
811 |
if ((rv = handle_it(MG_E_FACE, 4, fent)) != MG_OK) |
812 |
return(rv); |
813 |
} |
814 |
} else { /* quads */ |
815 |
v1ent[3] = "_cv4"; |
816 |
if (warpconends) { /* hack for e_sph and e_torus */ |
817 |
d = atan(n1off) + (PI/4)/mg_nqcdivs; |
818 |
if (d >= PI/2-FTINY) |
819 |
n1off = FHUGE; |
820 |
else |
821 |
n1off = tan(atan(n1off)+(PI/4)/mg_nqcdivs); |
822 |
} |
823 |
for (j = 0; j < 3; j++) { |
824 |
sprintf(p4[j], FLTFMT, cv1->p[j] + rad1*u[j]); |
825 |
if (n1off >= FHUGE) |
826 |
sprintf(n4[j], FLTFMT, w[j]); |
827 |
else |
828 |
sprintf(n4[j], FLTFMT, u[j] + w[j]*n1off); |
829 |
} |
830 |
if ((rv = handle_it(MG_E_VERTEX, 3, v4ent)) != MG_OK) |
831 |
return(rv); |
832 |
if ((rv = handle_it(MG_E_POINT, 4, p4ent)) != MG_OK) |
833 |
return(rv); |
834 |
if ((rv = handle_it(MG_E_NORMAL, 4, n4ent)) != MG_OK) |
835 |
return(rv); |
836 |
for (i = 1; i <= 4*mg_nqcdivs; i++) { |
837 |
theta = sgn*i*(PI/2)/mg_nqcdivs; |
838 |
if ((rv = handle_it(MG_E_VERTEX, 4, v1ent)) != MG_OK) |
839 |
return(rv); |
840 |
if ((rv = handle_it(MG_E_VERTEX, 4, v2ent)) != MG_OK) |
841 |
return(rv); |
842 |
for (j = 0; j < 3; j++) { |
843 |
d = u[j]*cos(theta) + v[j]*sin(theta); |
844 |
sprintf(p3[j], FLTFMT, cv2->p[j] + rad2*d); |
845 |
if (n2off > -FHUGE) |
846 |
sprintf(n3[j], FLTFMT, d + w[j]*n2off); |
847 |
sprintf(p4[j], FLTFMT, cv1->p[j] + rad1*d); |
848 |
if (n1off < FHUGE) |
849 |
sprintf(n4[j], FLTFMT, d + w[j]*n1off); |
850 |
} |
851 |
if ((rv = handle_it(MG_E_VERTEX, 2, v3ent)) != MG_OK) |
852 |
return(rv); |
853 |
if ((rv = handle_it(MG_E_POINT, 4, p3ent)) != MG_OK) |
854 |
return(rv); |
855 |
if (n2off > -FHUGE && |
856 |
(rv = handle_it(MG_E_NORMAL, 4, n3ent)) != MG_OK) |
857 |
return(rv); |
858 |
if ((rv = handle_it(MG_E_VERTEX, 2, v4ent)) != MG_OK) |
859 |
return(rv); |
860 |
if ((rv = handle_it(MG_E_POINT, 4, p4ent)) != MG_OK) |
861 |
return(rv); |
862 |
if (n1off < FHUGE && |
863 |
(rv = handle_it(MG_E_NORMAL, 4, n4ent)) != MG_OK) |
864 |
return(rv); |
865 |
if ((rv = handle_it(MG_E_FACE, 5, fent)) != MG_OK) |
866 |
return(rv); |
867 |
} |
868 |
} |
869 |
return(MG_OK); |
870 |
} |