26 |
|
|
27 |
|
#define ABS(x) ((x)>0?(x):-(x)) |
28 |
|
|
29 |
+ |
struct position {int x,y; float z;}; |
30 |
+ |
|
31 |
|
VIEW ourview = STDVIEW(512); /* desired view */ |
32 |
|
|
33 |
|
double zeps = .02; /* allowed z epsilon */ |
194 |
|
/* allocate frame */ |
195 |
|
ourpict = (COLR *)malloc(ourview.hresolu*ourview.vresolu*sizeof(COLR)); |
196 |
|
ourzbuf = (float *)calloc(ourview.hresolu*ourview.vresolu,sizeof(float)); |
197 |
< |
if (ourpict == NULL || ourzbuf == NULL) { |
198 |
< |
perror(progname); |
197 |
< |
exit(1); |
198 |
< |
} |
197 |
> |
if (ourpict == NULL || ourzbuf == NULL) |
198 |
> |
syserror(); |
199 |
|
/* get input */ |
200 |
|
for ( ; i < argc; i += 2) |
201 |
|
addpicture(argv[i], argv[i+1]); |
254 |
|
FILE *pfp, *zfp; |
255 |
|
char *err; |
256 |
|
COLR *scanin; |
257 |
< |
float *zin, *zlast; |
258 |
< |
int *plast; |
257 |
> |
float *zin; |
258 |
> |
struct position *plast; |
259 |
|
int y; |
260 |
|
/* open picture file */ |
261 |
|
if ((pfp = fopen(pfile, "r")) == NULL) { |
280 |
|
/* allocate scanlines */ |
281 |
|
scanin = (COLR *)malloc(theirview.hresolu*sizeof(COLR)); |
282 |
|
zin = (float *)malloc(theirview.hresolu*sizeof(float)); |
283 |
< |
plast = (int *)calloc(theirview.hresolu, sizeof(int)); |
284 |
< |
zlast = (float *)calloc(theirview.hresolu, sizeof(float)); |
285 |
< |
if (scanin == NULL || zin == NULL || plast == NULL || zlast == NULL) { |
286 |
< |
perror(progname); |
287 |
< |
exit(1); |
288 |
< |
} |
283 |
> |
plast = (struct position *)calloc(theirview.hresolu, |
284 |
> |
sizeof(struct position)); |
285 |
> |
if (scanin == NULL || zin == NULL || plast == NULL) |
286 |
> |
syserror(); |
287 |
|
/* get z specification or file */ |
288 |
|
if ((zfp = fopen(zspec, "r")) == NULL) { |
289 |
|
double zvalue; |
307 |
|
fprintf(stderr, "%s: read error\n", zspec); |
308 |
|
exit(1); |
309 |
|
} |
310 |
< |
addscanline(y, scanin, zin, plast, zlast); |
310 |
> |
addscanline(y, scanin, zin, plast); |
311 |
|
} |
312 |
|
/* clean up */ |
313 |
|
free((char *)scanin); |
314 |
|
free((char *)zin); |
315 |
|
free((char *)plast); |
318 |
– |
free((char *)zlast); |
316 |
|
fclose(pfp); |
317 |
|
if (zfp != NULL) |
318 |
|
fclose(zfp); |
355 |
|
} |
356 |
|
|
357 |
|
|
358 |
< |
addscanline(y, pline, zline, lasty, lastyz) /* add scanline to output */ |
358 |
> |
addscanline(y, pline, zline, lasty) /* add scanline to output */ |
359 |
|
int y; |
360 |
|
COLR *pline; |
361 |
|
float *zline; |
362 |
< |
int *lasty; /* input/output */ |
366 |
< |
float *lastyz; /* input/output */ |
362 |
> |
struct position *lasty; /* input/output */ |
363 |
|
{ |
364 |
|
extern double sqrt(); |
365 |
|
double pos[3]; |
366 |
< |
int lastx = 0; |
371 |
< |
double lastxz = 0; |
372 |
< |
double zt; |
373 |
< |
int xpos, ypos; |
366 |
> |
struct position lastx, newpos; |
367 |
|
register int x; |
368 |
|
|
369 |
|
for (x = theirview.hresolu-1; x >= 0; x--) { |
379 |
|
pos[1] *= pos[2]; |
380 |
|
} |
381 |
|
multp3(pos, pos, theirs2ours); |
382 |
< |
if (pos[2] <= 0) |
382 |
> |
if (pos[2] <= 0) { |
383 |
> |
lasty[x].z = lastx.z = 0; /* mark invalid */ |
384 |
|
continue; |
385 |
+ |
} |
386 |
|
if (ourview.type == VT_PER) { |
387 |
|
pos[0] /= pos[2]; |
388 |
|
pos[1] /= pos[2]; |
389 |
|
} |
390 |
|
pos[0] += .5*ourview.hresolu; |
391 |
|
pos[1] += .5*ourview.vresolu; |
392 |
< |
if (pos[0] < 0 || (xpos = pos[0]) >= ourview.hresolu |
393 |
< |
|| pos[1] < 0 || (ypos = pos[1]) >= ourview.vresolu) |
394 |
< |
continue; |
392 |
> |
newpos.x = pos[0]; |
393 |
> |
newpos.y = pos[1]; |
394 |
> |
newpos.z = zline[x]; |
395 |
|
/* add pixel to our image */ |
396 |
< |
zt = 2.*zeps*zline[x]; |
397 |
< |
addpixel(xpos, ypos, |
398 |
< |
(fill&F_FORE && ABS(zline[x]-lastxz) <= zt) |
399 |
< |
? lastx - xpos : 1, |
400 |
< |
(fill&F_FORE && ABS(zline[x]-lastyz[x]) <= zt) |
401 |
< |
? lasty[x] - ypos : 1, |
402 |
< |
pline[x], pos[2]); |
403 |
< |
lastx = xpos; |
409 |
< |
lasty[x] = ypos; |
410 |
< |
lastxz = lastyz[x] = zline[x]; |
396 |
> |
if (pos[0] >= 0 && newpos.x < ourview.hresolu |
397 |
> |
&& pos[1] >= 0 && newpos.y < ourview.vresolu) { |
398 |
> |
addpixel(&newpos, &lastx, &lasty[x], pline[x], pos[2]); |
399 |
> |
lasty[x].x = lastx.x = newpos.x; |
400 |
> |
lasty[x].y = lastx.y = newpos.y; |
401 |
> |
lasty[x].z = lastx.z = newpos.z; |
402 |
> |
} else |
403 |
> |
lasty[x].z = lastx.z = 0; /* mark invalid */ |
404 |
|
} |
405 |
|
} |
406 |
|
|
407 |
|
|
408 |
< |
addpixel(xstart, ystart, width, height, pix, z) /* fill in area for pixel */ |
409 |
< |
int xstart, ystart; |
417 |
< |
int width, height; |
408 |
> |
addpixel(p0, p1, p2, pix, z) /* fill in pixel parallelogram */ |
409 |
> |
struct position *p0, *p1, *p2; |
410 |
|
COLR pix; |
411 |
|
double z; |
412 |
|
{ |
413 |
< |
register int x, y; |
414 |
< |
/* make width and height positive */ |
415 |
< |
if (width < 0) { |
416 |
< |
width = -width; |
417 |
< |
xstart = xstart-width+1; |
418 |
< |
} else if (width == 0) |
419 |
< |
width = 1; |
420 |
< |
if (height < 0) { |
421 |
< |
height = -height; |
422 |
< |
ystart = ystart-height+1; |
423 |
< |
} else if (height == 0) |
424 |
< |
height = 1; |
425 |
< |
/* fill pixel(s) within rectangle */ |
426 |
< |
for (y = ystart; y < ystart+height; y++) |
427 |
< |
for (x = xstart; x < xstart+width; x++) |
428 |
< |
if (zscan(y)[x] <= 0 |
429 |
< |
|| zscan(y)[x]-z > zeps*zscan(y)[x]) { |
413 |
> |
double zt = 2.*zeps*p0->z; /* threshold */ |
414 |
> |
int s1x, s1y, s2x, s2y; /* step sizes */ |
415 |
> |
int l1, l2, c1, c2; /* side lengths and counters */ |
416 |
> |
int p1isy; /* p0p1 along y? */ |
417 |
> |
int x1, y1; /* p1 position */ |
418 |
> |
register int x, y; /* final position */ |
419 |
> |
|
420 |
> |
/* compute vector p0p1 */ |
421 |
> |
if (fill&F_FORE && ABS(p1->z-p0->z) <= zt) { |
422 |
> |
s1x = p1->x - p0->x; |
423 |
> |
s1y = p1->y - p0->y; |
424 |
> |
l1 = ABS(s1x); |
425 |
> |
if (p1isy = (ABS(s1y) > l1)) |
426 |
> |
l1 = ABS(s1y); |
427 |
> |
} else { |
428 |
> |
l1 = s1x = s1y = 1; |
429 |
> |
p1isy = -1; |
430 |
> |
} |
431 |
> |
/* compute vector p0p2 */ |
432 |
> |
if (fill&F_FORE && ABS(p2->z-p0->z) <= zt) { |
433 |
> |
s2x = p2->x - p0->x; |
434 |
> |
s2y = p2->y - p0->y; |
435 |
> |
if (p1isy == 1) |
436 |
> |
l2 = ABS(s2x); |
437 |
> |
else { |
438 |
> |
l2 = ABS(s2y); |
439 |
> |
if (p1isy != 0 && ABS(s2x) > l2) |
440 |
> |
l2 = ABS(s2x); |
441 |
> |
} |
442 |
> |
} else |
443 |
> |
l2 = s2x = s2y = 1; |
444 |
> |
/* fill the parallelogram */ |
445 |
> |
for (c1 = l1; c1-- > 0; ) { |
446 |
> |
x1 = p0->x + c1*s1x/l1; |
447 |
> |
y1 = p0->y + c1*s1y/l1; |
448 |
> |
for (c2 = l2; c2-- > 0; ) { |
449 |
> |
x = x1 + c2*s2x/l2; |
450 |
> |
y = y1 + c2*s2y/l2; |
451 |
> |
if (zscan(y)[x] <= 0 || zscan(y)[x]-z |
452 |
> |
> zeps*zscan(y)[x]) { |
453 |
|
zscan(y)[x] = z; |
454 |
|
copycolr(pscan(y)[x], pix); |
455 |
|
} |
456 |
+ |
} |
457 |
+ |
} |
458 |
|
} |
459 |
|
|
460 |
|
|
466 |
|
register int x, i; |
467 |
|
/* get back buffer */ |
468 |
|
yback = (int *)malloc(ourview.hresolu*sizeof(int)); |
469 |
< |
if (yback == NULL) { |
470 |
< |
perror(progname); |
454 |
< |
return; |
455 |
< |
} |
469 |
> |
if (yback == NULL) |
470 |
> |
syserror(); |
471 |
|
for (x = 0; x < ourview.hresolu; x++) |
472 |
|
yback[x] = -2; |
473 |
|
/* |
557 |
|
|
558 |
|
fputresolu(YMAJOR|YDECR, ourview.hresolu, ourview.vresolu, stdout); |
559 |
|
for (y = ourview.vresolu-1; y >= 0; y--) |
560 |
< |
if (fwritecolrs(pscan(y), ourview.hresolu, stdout) < 0) { |
561 |
< |
perror(progname); |
547 |
< |
exit(1); |
548 |
< |
} |
560 |
> |
if (fwritecolrs(pscan(y), ourview.hresolu, stdout) < 0) |
561 |
> |
syserror(); |
562 |
|
} |
563 |
|
|
564 |
|
|
576 |
|
exit(1); |
577 |
|
} |
578 |
|
if (donorm |
579 |
< |
&& (zout = (float *)malloc(ourview.hresolu*sizeof(float))) == NULL) { |
580 |
< |
perror(progname); |
568 |
< |
exit(1); |
569 |
< |
} |
579 |
> |
&& (zout = (float *)malloc(ourview.hresolu*sizeof(float))) == NULL) |
580 |
> |
syserror(); |
581 |
|
for (y = ourview.vresolu-1; y >= 0; y--) { |
582 |
|
if (donorm) { |
583 |
|
double vx, yzn2; |