source: git/src/img.c @ 6dd3a20

RELEASE/1.0RELEASE/1.1RELEASE/1.2debug-cidebug-ci-sanitisersfaster-cavernloglog-selectstereostereo-2025walls-datawalls-data-hanging-as-warningwarn-only-for-hanging-survey
Last change on this file since 6dd3a20 was 6dd3a20, checked in by Olly Betts <olly@…>, 23 years ago

Fixed bug in new code so it now reads v3 3d files successfully

git-svn-id: file:///home/survex-svn/survex/trunk@1812 4b37db11-9a0c-4f06-9ece-9ab7cdaee568

  • Property mode set to 100644
File size: 30.4 KB
Line 
1/* img.c
2 * Routines for reading and writing Survex ".3d" image files
3 * Copyright (C) 1993-2002 Olly Betts
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13 * GNU General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
18 */
19
20#ifdef HAVE_CONFIG_H
21# include <config.h>
22#endif
23
24#include <stdio.h>
25#include <string.h>
26#include <stdlib.h>
27#include <time.h>
28#include <ctype.h>
29
30#include "img.h"
31
32#ifdef IMG_HOSTED
33# include "debug.h"
34# include "filelist.h"
35# include "filename.h"
36# include "message.h"
37# include "useful.h"
38# define TIMENA msg(/*Date and time not available.*/108)
39# define TIMEFMT msg(/*%a,%Y.%m.%d %H:%M:%S %Z*/107)
40#else
41# define INT32_T long
42# define TIMENA "Time not available."
43# define TIMEFMT "%a,%Y.%m.%d %H:%M:%S %Z"
44# define EXT_SVX_3D "3d"
45# define xosmalloc(L) malloc((L))
46# define xosrealloc(L,S) realloc((L),(S))
47# define osfree(P) free((P))
48# define ossizeof(T) sizeof(T)
49/* in IMG_HOSTED mode, this tests if a filename refers to a directory */
50# define fDirectory(X) 0
51/* open file FNM with mode MODE, maybe using path PTH and/or extension EXT */
52/* path isn't used in img.c, but EXT is */
53# define fopenWithPthAndExt(PTH,FNM,EXT,MODE,X) fopen(FNM,MODE)
54# define fFalse 0
55# define fTrue 1
56# define bool int
57/* dummy do {...} while(0) hack to permit stuff like
58 * if (s) fputsnl(s,fh); else exit(1);
59 * to work as intended
60 */
61# define fputsnl(S, FH) do {fputs((S), (FH)); putc('\n', (FH));} while(0)
62# define ASSERT(X)
63
64static long
65get32(FILE *fh)
66{
67   long w = getc(fh);
68   w |= (long)getc(fh) << 8l;
69   w |= (long)getc(fh) << 16l;
70   w |= (long)getc(fh) << 24l;
71   return w;
72}
73
74static void
75put32(long w, FILE *fh)
76{
77   putc((char)(w), fh);
78   putc((char)(w >> 8l), fh);
79   putc((char)(w >> 16l), fh);
80   putc((char)(w >> 24l), fh);
81}
82
83#endif
84
85#ifdef HAVE_ROUND
86# include <math.h>
87extern double round(double); /* prototype is often missing... */
88# define my_round round
89#else
90static double
91my_round(double x) {
92   if (x >= 0.0) return floor(x + 0.5);
93   return ceil(x - 0.5);
94}
95#endif
96
97/* portable case insensitive string compare */
98#if defined(strcasecmp) || defined(HAVE_STRCASECMP)
99# define my_strcasecmp strcasecmp
100#else
101/* What about top bit set chars? */
102int my_strcasecmp(const char *s1, const char *s2) {
103   register c1, c2;
104   do {
105      c1 = *s1++;
106      c2 = *s2++;
107   } while (c1 && toupper(c1) == toupper(c2));
108   /* now calculate real difference */
109   return c1 - c2;
110}
111#endif
112
113unsigned int img_output_version = 3;
114
115#ifdef IMG_HOSTED
116static enum {
117   IMG_NONE = 0,
118   IMG_FILENOTFOUND = /*Couldn't open data file `%s'*/24,
119   IMG_OUTOFMEMORY  = /*Out of memory %.0s*/38,
120   IMG_DIRECTORY    = /*Filename `%s' refers to directory*/44,
121   IMG_CANTOPENOUT  = /*Failed to open output file `%s'*/47,
122   IMG_BADFORMAT    = /*Bad 3d image file `%s'*/106,
123   IMG_READERROR    = /*Error reading from file `%s'*/109,
124   IMG_WRITEERROR   = /*Error writing to file `%s'*/110,
125   IMG_TOONEW       = /*File `%s' has a newer format than this program can understand*/114
126} img_errno = IMG_NONE;
127#else
128static img_errcode img_errno = IMG_NONE;
129#endif
130
131#define FILEID "Survex 3D Image File"
132
133#define EXT_PLT "plt"
134
135/* Attempt to string paste to ensure we are passed a literal string */
136#define LITLEN(S) (sizeof(S"") - 1)
137
138static char *
139my_strdup(const char *str)
140{
141   char *p;
142   size_t len = strlen(str) + 1;
143   p = xosmalloc(len);
144   if (p) memcpy(p, str, len);
145   return p;
146}
147
148static char *
149getline_alloc(FILE *fh)
150{
151   int ch;
152   size_t i = 0;
153   size_t len = 16;
154   char *buf = xosmalloc(len);
155   if (!buf) return NULL;
156
157   ch = getc(fh);
158   while (ch != '\n' && ch != '\r' && ch != EOF) {
159      buf[i++] = ch;
160      if (i == len - 1) {
161         char *p;
162         len += len;
163         p = xosrealloc(buf, len);
164         if (!p) {
165            osfree(buf);
166            return NULL;
167         }
168         buf = p;
169      }
170      ch = getc(fh);
171   }
172   if (ch == '\n' || ch == '\r') {
173      int otherone = ch ^ ('\n' ^ '\r');
174      ch = getc(fh);
175      /* if it's not the other eol character, put it back */
176      if (ch != otherone) ungetc(ch, fh);
177   }
178   buf[i++] = '\0';
179   return buf;
180}
181
182#ifndef IMG_HOSTED
183img_errcode
184img_error(void)
185{
186   return img_errno;
187}
188#else
189int
190img_error(void)
191{
192   return (int)img_errno;
193}
194#endif
195
196static bool
197check_label_space(img *pimg, size_t len)
198{
199   if (len > pimg->buf_len) {
200      char *b = xosrealloc(pimg->label_buf, len);
201      if (!b) return fFalse;
202      pimg->label = (pimg->label - pimg->label_buf) + b;
203      pimg->label_buf = b;
204      pimg->buf_len = len;
205   }
206   return fTrue;
207}
208
209img *
210img_open_survey(const char *fnm, const char *survey)
211{
212   img *pimg;
213   size_t len;
214   char buf[LITLEN(FILEID) + 1];
215   int ch;
216
217   if (fDirectory(fnm)) {
218      img_errno = IMG_DIRECTORY;
219      return NULL;
220   }
221
222   pimg = (img *)xosmalloc(ossizeof(img));
223   if (pimg == NULL) {
224      img_errno = IMG_OUTOFMEMORY;
225      return NULL;
226   }
227
228   pimg->buf_len = 257;
229   pimg->label_buf = xosmalloc(pimg->buf_len);
230   if (!pimg->label_buf) {
231      osfree(pimg);
232      img_errno = IMG_OUTOFMEMORY;
233      return NULL;
234   }
235
236   pimg->fh = fopenWithPthAndExt("", fnm, EXT_SVX_3D, "rb", NULL);
237   if (pimg->fh == NULL) {
238      osfree(pimg);
239      img_errno = IMG_FILENOTFOUND;
240      return NULL;
241   }
242
243   pimg->fRead = fTrue; /* reading from this file */
244   img_errno = IMG_NONE;
245
246   pimg->flags = 0;
247
248   /* for version 3 we use label_buf to store the prefix for reuse */
249   /* for version -2, 0 value indicates we haven't entered a survey yet */
250   pimg->label_len = 0;
251
252   pimg->survey = NULL;
253   pimg->survey_len = 0;
254
255   pimg->title = NULL;
256   if (survey) {
257      len = strlen(survey);
258      if (len) {
259         if (survey[len - 1] == '.') len--;
260         if (len) {
261            char *p;
262            pimg->survey = osmalloc(len + 2);
263            memcpy(pimg->survey, survey, len);
264            /* Set title to leaf survey name */
265            pimg->survey[len] = '\0';
266            p = strchr(pimg->survey, '.');
267            if (p) p++; else p = pimg->survey;
268            pimg->title = my_strdup(p);
269            if (!pimg->title) {
270               img_errno = IMG_OUTOFMEMORY;
271               goto error;
272            }
273            pimg->survey[len] = '.';
274            pimg->survey[len + 1] = '\0';
275         }
276      }
277      pimg->survey_len = len;
278   }
279
280   /* [version -2] pending IMG_LINE ('D') or IMG_MOVE ('M')
281    * [version -1] already skipped heading line, or there wasn't one
282    * [version 0] not in the middle of a 'LINE' command
283    * [version 3] not in the middle of turning a LINE into a MOVE
284    */
285   pimg->pending = 0;
286
287   len = strlen(fnm);
288   if (len > LITLEN(EXT_SVX_POS) + 1 &&
289       fnm[len - LITLEN(EXT_SVX_POS) - 1] == FNM_SEP_EXT &&
290       my_strcasecmp(fnm + len - LITLEN(EXT_SVX_POS), EXT_SVX_POS) == 0) {
291      pimg->version = -1;
292      if (!pimg->survey) pimg->title = baseleaf_from_fnm(fnm);
293      pimg->datestamp = my_strdup(TIMENA);
294      if (!pimg->datestamp) {
295         img_errno = IMG_OUTOFMEMORY;
296         goto error;
297      }
298      pimg->start = 0;
299      return pimg;
300   }
301
302   if (len > LITLEN(EXT_PLT) + 1 &&
303       fnm[len - LITLEN(EXT_PLT) - 1] == FNM_SEP_EXT &&
304       my_strcasecmp(fnm + len - LITLEN(EXT_PLT), EXT_PLT) == 0) {
305      long fpos;
306
307      pimg->version = -2;
308      pimg->start = 0;
309      if (!pimg->survey) pimg->title = baseleaf_from_fnm(fnm);
310      pimg->datestamp = my_strdup(TIMENA);
311      if (!pimg->datestamp) {
312         img_errno = IMG_OUTOFMEMORY;
313         goto error;
314      }
315      while (1) {
316         int ch = getc(pimg->fh);
317         switch (ch) {
318          case '\x1a':
319            fseek(pimg->fh, -1, SEEK_CUR);
320            /* FALL THRU */
321          case EOF:
322            pimg->start = ftell(pimg->fh);
323            return pimg;
324          case 'N': {
325            char *line, *q;
326            fpos = ftell(pimg->fh) - 1;
327            if (!pimg->survey) {
328               /* FIXME : if there's only one survey in the file, it'd be nice
329                * to use its description as the title here...
330                */
331               pimg->start = fpos;
332               return pimg;
333            }
334            line = getline_alloc(pimg->fh);
335            while (line[len] > 32) ++len;
336            if (pimg->survey_len != len ||
337                memcmp(line, pimg->survey, len) != 0) {
338               osfree(line);
339               continue;
340            }
341            q = strchr(line + len, 'C');
342            if (q && q[1]) {
343                osfree(pimg->title);
344                pimg->title = osstrdup(q + 1);
345            } else if (!pimg->title) {
346                pimg->title = osstrdup(pimg->label);
347            }
348            osfree(line);
349            if (!pimg->title) {
350                img_errno = IMG_OUTOFMEMORY;
351                goto error;
352            }
353            if (!pimg->start) pimg->start = fpos;
354            return pimg;
355          }
356          case 'M': case 'D':
357            pimg->start = ftell(pimg->fh) - 1;
358            break;
359         }
360         while (ch != '\n' && ch != '\r') {
361            ch = getc(pimg->fh);
362         }
363      }
364   }
365
366   if (fread(buf, LITLEN(FILEID) + 1, 1, pimg->fh) != 1 ||
367       memcmp(buf, FILEID"\n", LITLEN(FILEID)) != 0) {
368      img_errno = IMG_BADFORMAT;
369      goto error;
370   }
371
372   /* check file format version */
373   ch = getc(pimg->fh);
374   pimg->version = 0;
375   if (tolower(ch) == 'b') {
376      /* binary file iff B/b prefix */
377      pimg->version = 1;
378      ch = getc(pimg->fh);
379   }
380   if (ch != 'v') {
381      img_errno = IMG_BADFORMAT;
382      goto error;
383   }
384   ch = getc(pimg->fh);
385   if (ch == '0') {
386      if (fread(buf, 4, 1, pimg->fh) != 1 || memcmp(buf, ".01\n", 4) != 0) {
387         img_errno = IMG_BADFORMAT;
388         goto error;
389      }
390      /* nothing special to do */
391   } else if (pimg->version == 0) {
392      if (ch < '2' || ch > '3' || getc(pimg->fh) != '\n') {
393         img_errno = IMG_TOONEW;
394         goto error;
395      }
396      pimg->version = ch - '0';
397   } else {
398      img_errno = IMG_BADFORMAT;
399      goto error;
400   }
401
402   if (!pimg->title)
403       pimg->title = getline_alloc(pimg->fh);
404   else
405       osfree(getline_alloc(pimg->fh));
406   pimg->datestamp = getline_alloc(pimg->fh);
407   if (!pimg->title || !pimg->datestamp) {
408      img_errno = IMG_OUTOFMEMORY;
409      error:
410      osfree(pimg->title);
411      osfree(pimg->datestamp);
412      fclose(pimg->fh);
413      osfree(pimg);
414      return NULL;
415   }
416
417   pimg->start = ftell(pimg->fh);
418
419   return pimg;
420}
421
422int
423img_rewind(img *pimg)
424{
425   if (!pimg->fRead) {
426      img_errno = IMG_WRITEERROR;
427      return 0;
428   }
429   if (fseek(pimg->fh, pimg->start, SEEK_SET) != 0) {
430      img_errno = IMG_READERROR;
431      return 0;
432   }
433   clearerr(pimg->fh);
434   /* [version -1] already skipped heading line, or there wasn't one
435    * [version 0] not in the middle of a 'LINE' command
436    * [version 3] not in the middle of turning a LINE into a MOVE */
437   pimg->pending = 0;
438
439   img_errno = IMG_NONE;
440
441   /* for version 3 we use label_buf to store the prefix for reuse */
442   /* for version -2, 0 value indicates we haven't entered a survey yet */
443   pimg->label_len = 0;
444   return 1;
445}
446
447img *
448img_open_write(const char *fnm, char *title_buf, bool fBinary)
449{
450   time_t tm;
451   img *pimg;
452
453   fBinary = fBinary;
454
455   if (fDirectory(fnm)) {
456      img_errno = IMG_DIRECTORY;
457      return NULL;
458   }
459
460   pimg = (img *)xosmalloc(ossizeof(img));
461   if (pimg == NULL) {
462      img_errno = IMG_OUTOFMEMORY;
463      return NULL;
464   }
465
466   pimg->buf_len = 257;
467   pimg->label_buf = xosmalloc(pimg->buf_len);
468   if (!pimg->label_buf) {
469      osfree(pimg);
470      img_errno = IMG_OUTOFMEMORY;
471      return NULL;
472   }
473
474   pimg->fh = fopen(fnm, "wb");
475   if (!pimg->fh) {
476      osfree(pimg);
477      img_errno = IMG_CANTOPENOUT;
478      return NULL;
479   }
480
481   /* Output image file header */
482   fputs("Survex 3D Image File\n", pimg->fh); /* file identifier string */
483   if (img_output_version < 2) {
484      pimg->version = 1;
485      fputs("Bv0.01\n", pimg->fh); /* binary file format version number */
486   } else {
487      pimg->version = (img_output_version > 2) ? 3 : 2;
488      fprintf(pimg->fh, "v%d\n", pimg->version); /* file format version no. */
489   }
490   fputsnl(title_buf, pimg->fh);
491   tm = time(NULL);
492   if (tm == (time_t)-1) {
493      fputsnl(TIMENA, pimg->fh);
494   } else {
495      char date[256];
496      /* output current date and time in format specified */
497      strftime(date, 256, TIMEFMT, localtime(&tm));
498      fputsnl(date, pimg->fh);
499   }
500   pimg->fRead = fFalse; /* writing to this file */
501   img_errno = IMG_NONE;
502
503   /* for version 3 we use label_buf to store the prefix for reuse */
504   pimg->label_buf[0] = '\0';
505   pimg->label_len = 0;
506
507   /* Don't check for write errors now - let img_close() report them... */
508   return pimg;
509}
510
511static int
512read_coord(FILE *fh, img_point *pt)
513{
514   ASSERT(fh);
515   ASSERT(pt);
516   pt->x = get32(fh) / 100.0;
517   pt->y = get32(fh) / 100.0;
518   pt->z = get32(fh) / 100.0;
519   if (ferror(fh) || feof(fh)) {
520      img_errno = feof(fh) ? IMG_BADFORMAT : IMG_READERROR;
521      return 0;
522   }
523   return 1;
524}
525
526static int
527skip_coord(FILE *fh)
528{
529    return (fseek(fh, 12, SEEK_CUR) == 0);
530}
531
532int
533img_read_item(img *pimg, img_point *p)
534{
535   int result;
536   pimg->flags = 0;
537
538   if (pimg->version == 3) {
539      int opt;
540      if (pimg->pending >= 0x80) {
541         *p = pimg->mv;
542         pimg->flags = (int)(pimg->pending) & 0x3f;
543         pimg->pending = 0;
544         return img_LINE;
545      }
546      again3: /* label to goto if we get a prefix */
547      pimg->label = pimg->label_buf;
548      opt = getc(pimg->fh);
549      if (opt == EOF) {
550         img_errno = feof(pimg->fh) ? IMG_BADFORMAT : IMG_READERROR;
551         return img_BAD;
552      }
553      switch (opt >> 6) {
554       case 0:
555         if (opt == 0) {
556            if (!pimg->label_len) return img_STOP; /* end of data marker */
557            pimg->label_len = 0;
558            goto again3;
559         }
560         if (opt < 15) {
561            /* 1-14 mean trim that many levels from current prefix */
562            int c;
563            if (pimg->label_len <= 16) {
564               /* zero prefix using "0" */
565               img_errno = IMG_BADFORMAT;
566               return img_BAD;
567            }
568            c = pimg->label_len - 16 - 1;
569            while (pimg->label_buf[c] != '.' || --opt > 0) {
570               if (--c < 0) {
571                  /* zero prefix using "0" */
572                  img_errno = IMG_BADFORMAT;
573                  return img_BAD;
574               }
575            }
576            c++;
577            pimg->label_len = c;
578            goto again3;
579         }
580         if (opt == 15) {
581            result = img_MOVE;
582            break;
583         }
584         /* 16-31 mean remove (n - 15) characters from the prefix */
585         /* zero prefix using 0 */
586         if (pimg->label_len <= (size_t)(opt - 15)) {
587            img_errno = IMG_BADFORMAT;
588            return img_BAD;
589         }
590         pimg->label_len -= (opt - 15);
591         goto again3;
592       case 1: case 2: {
593         char *q;
594         long len = getc(pimg->fh);
595         if (len == EOF) {
596            img_errno = feof(pimg->fh) ? IMG_BADFORMAT : IMG_READERROR;
597            return img_BAD;
598         }
599         if (len == 0xfe) {
600            len += get16(pimg->fh);
601            if (feof(pimg->fh)) {
602               img_errno = IMG_BADFORMAT;
603               return img_BAD;
604            }
605            if (ferror(pimg->fh)) {
606               img_errno = IMG_READERROR;
607               return img_BAD;
608            }
609         } else if (len == 0xff) {
610            len = get32(pimg->fh);
611            if (ferror(pimg->fh)) {
612               img_errno = IMG_READERROR;
613               return img_BAD;
614            }
615            if (feof(pimg->fh) || len < 0xfe + 0xffff) {
616               img_errno = IMG_BADFORMAT;
617               return img_BAD;
618            }
619         }
620
621         if (!check_label_space(pimg, pimg->label_len + len + 1)) {
622            img_errno = IMG_OUTOFMEMORY;
623            return img_BAD;
624         }
625         q = pimg->label_buf + pimg->label_len;
626         pimg->label_len += len;
627         if (len && fread(q, len, 1, pimg->fh) != 1) {
628            img_errno = feof(pimg->fh) ? IMG_BADFORMAT : IMG_READERROR;
629            return img_BAD;
630         }
631         q[len] = '\0';
632
633         result = opt & 0x40 ? img_LABEL : img_LINE;
634
635         if (pimg->survey_len) {
636            size_t l = pimg->survey_len;
637            const char *s = pimg->label_buf;
638            if (result == img_LINE) {
639               if (strncmp(pimg->survey, s, l) != 0 ||
640                   !(s[l] == '.' || s[l] == '\0')) {
641                  if (!read_coord(pimg->fh, &(pimg->mv))) return img_BAD;
642                  pimg->pending = 15;
643                  goto again3;
644               }
645            } else {
646               if (strncmp(pimg->survey, s, l + 1) != 0) {
647                  if (!skip_coord(pimg->fh)) return img_BAD;
648                  pimg->pending = 0;
649                  goto again3;
650               }
651            }
652            pimg->label += l;
653            /* skip the dot if there */
654            if (*pimg->label) pimg->label++;
655         }
656
657         if (result == img_LINE && pimg->pending) {
658            *p = pimg->mv;
659            if (!read_coord(pimg->fh, &(pimg->mv))) return img_BAD;
660            pimg->pending = opt;
661            return img_MOVE;
662         }
663         pimg->flags = (int)opt & 0x3f;
664         break;
665       }
666       default:
667         img_errno = IMG_BADFORMAT;
668         return img_BAD;
669      }
670      if (!read_coord(pimg->fh, p)) return img_BAD;
671      pimg->pending = 0;
672      return result;
673   }
674
675   pimg->label = pimg->label_buf;
676
677   if (pimg->version > 0) {
678      static long opt_lookahead = 0;
679      static img_point pt = { 0.0, 0.0, 0.0 };
680      long opt;
681      again: /* label to goto if we get a cross */
682      pimg->label[0] = '\0';
683
684      if (pimg->version == 1) {
685         if (opt_lookahead) {
686            opt = opt_lookahead;
687            opt_lookahead = 0;
688         } else {
689            opt = get32(pimg->fh);
690         }
691      } else {
692         opt = getc(pimg->fh);
693      }
694
695      if (feof(pimg->fh)) {
696         img_errno = IMG_BADFORMAT;
697         return img_BAD;
698      }
699      if (ferror(pimg->fh)) {
700         img_errno = IMG_READERROR;
701         return img_BAD;
702      }
703
704      switch (opt) {
705       case -1: case 0:
706         return img_STOP; /* end of data marker */
707       case 1:
708         /* skip coordinates */
709         if (!skip_coord(pimg->fh)) {
710            img_errno = feof(pimg->fh) ? IMG_BADFORMAT : IMG_READERROR;
711            return img_BAD;
712         }
713         goto again;
714       case 2: case 3: {
715         char *q;
716         int ch;
717         result = img_LABEL;
718         ch = getc(pimg->fh);
719         if (ch == EOF) {
720            img_errno = feof(pimg->fh) ? IMG_BADFORMAT : IMG_READERROR;
721            return img_BAD;
722         }
723         if (ch != '\\') ungetc(ch, pimg->fh);
724         fgets(pimg->label_buf, 257, pimg->fh);
725         if (feof(pimg->fh)) {
726            img_errno = IMG_BADFORMAT;
727            return img_BAD;
728         }
729         if (ferror(pimg->fh)) {
730            img_errno = IMG_READERROR;
731            return img_BAD;
732         }
733         q = pimg->label_buf + strlen(pimg->label_buf) - 1;
734         if (*q != '\n') {
735            img_errno = IMG_BADFORMAT;
736            return img_BAD;
737         }
738         /* Ignore empty labels in some .3d files (caused by a bug) */
739         if (q == pimg->label_buf) goto again;
740         *q = '\0';
741         pimg->flags = img_SFLAG_UNDERGROUND; /* no flags given... */
742         if (opt == 2) goto done;
743         break;
744       }
745       case 6: case 7: {
746         long len;
747         result = img_LABEL;
748
749         if (opt == 7)
750            pimg->flags = getc(pimg->fh);
751         else
752            pimg->flags = img_SFLAG_UNDERGROUND; /* no flags given... */
753
754         len = get32(pimg->fh);
755
756         if (feof(pimg->fh)) {
757            img_errno = IMG_BADFORMAT;
758            return img_BAD;
759         }
760         if (ferror(pimg->fh)) {
761            img_errno = IMG_READERROR;
762            return img_BAD;
763         }
764
765         /* Ignore empty labels in some .3d files (caused by a bug) */
766         if (len == 0) goto again;
767         if (!check_label_space(pimg, len + 1)) {
768            img_errno = IMG_OUTOFMEMORY;
769            return img_BAD;
770         }
771         if (fread(pimg->label_buf, len, 1, pimg->fh) != 1) {
772            img_errno = feof(pimg->fh) ? IMG_BADFORMAT : IMG_READERROR;
773            return img_BAD;
774         }
775         break;
776       }
777       case 4:
778         result = img_MOVE;
779         break;
780       case 5:
781         result = img_LINE;
782         break;
783       default:
784         switch ((int)opt & 0xc0) {
785          case 0x80:
786            pimg->flags = (int)opt & 0x3f;
787            result = img_LINE;
788            break;
789          case 0x40: {
790            char *q;
791            pimg->flags = (int)opt & 0x3f;
792            result = img_LABEL;
793            if (!fgets(pimg->label_buf, 257, pimg->fh)) {
794               img_errno = feof(pimg->fh) ? IMG_BADFORMAT : IMG_READERROR;
795               return img_BAD;
796            }
797            q = pimg->label_buf + strlen(pimg->label_buf) - 1;
798            /* Ignore empty-labels in some .3d files (caused by a bug) */
799            if (q == pimg->label_buf) goto again;
800            if (*q != '\n') {
801               img_errno = IMG_BADFORMAT;
802               return img_BAD;
803            }
804            *q = '\0';
805            break;
806          }
807          case 0xc0:
808            /* use this for an extra leg or station flag if we need it */
809          default:
810            img_errno = IMG_BADFORMAT;
811            return img_BAD;
812         }
813         break;
814      }
815
816      if (!read_coord(pimg->fh, &pt)) return img_BAD;
817
818      if (result == img_LABEL && pimg->survey_len) {
819         if (strncmp(pimg->label_buf, pimg->survey, pimg->survey_len + 1) != 0)
820            goto again;
821         pimg->label += pimg->survey_len + 1;
822      }
823
824      done:
825      *p = pt;
826
827      if (result == img_MOVE && pimg->version == 1) {
828         /* peek at next code and see if it's an old-style label */
829         opt_lookahead = get32(pimg->fh);
830
831         if (feof(pimg->fh)) {
832            img_errno = IMG_BADFORMAT;
833            return img_BAD;
834         }
835         if (ferror(pimg->fh)) {
836            img_errno = IMG_READERROR;
837            return img_BAD;
838         }
839
840         if (opt_lookahead == 2) return img_read_item(pimg, p);
841      }
842
843      return result;
844   } else if (pimg->version == 0) {
845      ascii_again:
846      pimg->label[0] = '\0';
847      if (feof(pimg->fh)) return img_STOP;
848      if (pimg->pending) {
849         pimg->pending = 0;
850         result = img_LINE;
851      } else {
852         char cmd[7];
853         /* Stop if nothing found */
854         if (fscanf(pimg->fh, "%6s", cmd) < 1) return img_STOP;
855         if (strcmp(cmd, "move") == 0)
856            result = img_MOVE;
857         else if (strcmp(cmd, "draw") == 0)
858            result = img_LINE;
859         else if (strcmp(cmd, "line") == 0) {
860            /* set flag to indicate to process second triplet as LINE */
861            pimg->pending = 1;
862            result = img_MOVE;
863         } else if (strcmp(cmd, "cross") == 0) {
864            if (fscanf(pimg->fh, "%lf%lf%lf", &p->x, &p->y, &p->z) < 3) {
865               img_errno = feof(pimg->fh) ? IMG_BADFORMAT : IMG_READERROR;
866               return img_BAD;
867            }
868            goto ascii_again;
869         } else if (strcmp(cmd, "name") == 0) {
870            size_t off = 0;
871            int ch = getc(pimg->fh);
872            if (ch == ' ') ch = getc(pimg->fh);
873            while (ch != ' ') {
874               if (ch == '\n' || ch == EOF) {
875                  img_errno = ferror(pimg->fh) ? IMG_READERROR : IMG_BADFORMAT;
876                  return img_BAD;
877               }
878               if (off == pimg->buf_len) {
879                  if (!check_label_space(pimg, pimg->buf_len * 2)) {
880                     img_errno = IMG_OUTOFMEMORY;
881                     return img_BAD;
882                  }
883               }
884               pimg->label_buf[off++] = ch;
885               ch = getc(pimg->fh);
886            }
887            pimg->label_buf[off] = '\0';
888
889            pimg->label = pimg->label_buf;
890            if (pimg->label[0] == '\\') pimg->label++;
891
892            result = img_LABEL;
893         } else {
894            img_errno = IMG_BADFORMAT;
895            return img_BAD; /* unknown keyword */
896         }
897      }
898
899      if (fscanf(pimg->fh, "%lf%lf%lf", &p->x, &p->y, &p->z) < 3) {
900         img_errno = ferror(pimg->fh) ? IMG_READERROR : IMG_BADFORMAT;
901         return img_BAD;
902      }
903
904      if (result == img_LABEL && pimg->survey_len) {
905         if (strncmp(pimg->label, pimg->survey, pimg->survey_len + 1) != 0)
906            goto ascii_again;
907         pimg->label += pimg->survey_len + 1;
908      }
909
910      return result;
911   } else if (pimg->version == -1) {
912      /* version -1: .pos file */
913      size_t off;
914      pimg->flags = img_SFLAG_UNDERGROUND; /* default flags */
915      againpos:
916      off = 0;
917      while (fscanf(pimg->fh, "(%lf,%lf,%lf ) ", &p->x, &p->y, &p->z) != 3) {
918         int ch;
919         if (ferror(pimg->fh)) {
920            img_errno = IMG_READERROR;
921            return img_BAD;
922         }
923         if (feof(pimg->fh)) return img_STOP;
924         if (pimg->pending) {
925            img_errno = IMG_BADFORMAT;
926            return img_BAD;
927         }
928         pimg->pending = 1;
929         /* ignore rest of line */
930         do {
931            ch = getc(pimg->fh);
932         } while (ch != '\n' && ch != '\r' && ch != EOF);
933      }
934
935      pimg->label_buf[0] = '\0';
936      while (!feof(pimg->fh)) {
937         char *b;
938         if (!fgets(pimg->label_buf + off, pimg->buf_len - off, pimg->fh)) {
939            img_errno = IMG_READERROR;
940            return img_BAD;
941         }
942
943         off += strlen(pimg->label_buf + off);
944         if (off && pimg->label_buf[off - 1] == '\n') {
945            pimg->label_buf[off - 1] = '\0';
946            break;
947         }
948         if (!check_label_space(pimg, pimg->buf_len * 2)) {
949            img_errno = IMG_OUTOFMEMORY;
950            return img_BAD;
951         }
952      }
953
954      pimg->label = pimg->label_buf;
955
956      if (pimg->label[0] == '\\') pimg->label++;
957
958      if (pimg->survey_len) {
959         size_t l = pimg->survey_len + 1;
960         if (strncmp(pimg->survey, pimg->label, l) != 0) goto againpos;
961         pimg->label += l;
962      }
963
964      return img_LABEL;
965   } else {
966      /* version -2: Compass .plt file */
967      if (pimg->pending > 0) {
968         /* -1 signals we've entered the first survey we want to
969          * read, and need to fudge lots if the first action is 'D'...
970          */
971         /* pending MOVE or LINE */
972         int r = pimg->pending - 4;
973         pimg->pending = 0;
974         pimg->flags = 0;
975         pimg->label[pimg->label_len] = '\0';
976         return r;
977      }
978
979      while (1) {
980         char *line;
981         char *q;
982         size_t len = 0;
983         int ch = getc(pimg->fh);
984
985         switch (ch) {
986            case '\x1a': case EOF: /* Don't insist on ^Z at end of file */
987               return img_STOP;
988            case 'N':
989               line = getline_alloc(pimg->fh);
990               while (line[len] > 32) ++len;
991               if (pimg->survey && pimg->label_len == 0)
992                  pimg->pending = -1;
993               if (!check_label_space(pimg, len + 1)) {
994                  osfree(line);
995                  img_errno = IMG_OUTOFMEMORY;
996                  return img_BAD;
997               }
998               pimg->label_len = len;
999               pimg->label = pimg->label_buf;
1000               memcpy(pimg->label, line, len);
1001               pimg->label[len] = '\0';
1002               osfree(line);
1003               break;
1004            case 'M': case 'D': {
1005               /* Move or Draw */
1006               long fpos = -1;
1007               if (pimg->label_len == 0) {
1008                  /* We're only holding onto this line in case the first line
1009                   * of the 'N' is a 'D', so reprocess this line as an 'X'
1010                   * to skip it for now...
1011                   */
1012                  ungetc('X', pimg->fh);
1013                  break;
1014               }
1015               if (ch == 'D' && pimg->pending == -1) {
1016                  fpos = ftell(pimg->fh) - 1;
1017                  fseek(pimg->fh, pimg->start, SEEK_SET);
1018                  ch = getc(pimg->fh);
1019               }
1020               line = getline_alloc(pimg->fh);
1021               if (sscanf(line, "%lf %lf %lf", &p->x, &p->y, &p->z) != 3) {
1022                  osfree(line);
1023                  if (ferror(pimg->fh)) {
1024                     img_errno = IMG_READERROR;
1025                  } else {
1026                     img_errno = IMG_BADFORMAT;
1027                  }
1028                  return img_BAD;
1029               }
1030               q = strchr(line, 'S');
1031               if (!q) {
1032                  osfree(line);
1033                  img_errno = IMG_BADFORMAT;
1034                  return img_BAD;
1035               }
1036               ++q;
1037               len = 0;
1038               while (q[len] > ' ') ++len;
1039               q[len] = '\0';
1040               len += 2; /* '.' and '\0' */
1041               if (!check_label_space(pimg, pimg->label_len + len)) {
1042                  img_errno = IMG_OUTOFMEMORY;
1043                  return img_BAD;
1044               }
1045               pimg->label = pimg->label_buf;
1046               pimg->label[pimg->label_len] = '.';
1047               memcpy(pimg->label + pimg->label_len + 1, q, len - 1);
1048               pimg->pending = (ch ? img_MOVE : img_LINE) + 4;
1049               osfree(line);
1050               pimg->flags = img_SFLAG_UNDERGROUND; /* default flags */
1051               if (fpos != -1) fseek(pimg->fh, fpos, SEEK_SET);
1052               return img_LABEL;
1053            }
1054            case 'X': case 'F': case 'S':
1055               /* bounding boX (marks end of survey), Feature survey, or
1056                * new Section - skip to next survey */
1057               if (pimg->survey) return img_STOP;
1058               while (1) {
1059                  do {
1060                     ch = getc(pimg->fh);
1061                  } while (ch != '\n' && ch != '\r');
1062                  ch = getc(pimg->fh);
1063                  if (ch == 'N') break;
1064                  if (ch == '\x1a' || ch == EOF) return img_STOP;
1065               }
1066               ungetc('N', pimg->fh);
1067               break;
1068            default:
1069               img_errno = IMG_BADFORMAT;
1070               return img_BAD;
1071         }
1072      }
1073   }
1074}
1075
1076static int
1077write_v3label(img *pimg, int opt, const char *s)
1078{
1079   size_t len, n, dot;
1080
1081   /* find length of common prefix */
1082   dot = 0;
1083   for (len = 0; s[len] == pimg->label_buf[len] && s[len] != '\0'; len++) {
1084      if (s[len] == '.') dot = len + 1;
1085   }
1086
1087   ASSERT(len <= pimg->label_len);
1088   n = pimg->label_len - len;
1089   if (len == 0) {
1090      if (pimg->label_len) putc(0, pimg->fh);
1091   } else if (n <= 16) {
1092      if (n) putc(n + 15, pimg->fh);
1093   } else if (dot == 0) {
1094      if (pimg->label_len) putc(0, pimg->fh);
1095      len = 0;
1096   } else {
1097      const char *p = pimg->label_buf + dot;
1098      n = 1;
1099      for (len = pimg->label_len - dot - 17; len; len--) {
1100         if (*p++ == '.') n++;
1101      }
1102      if (n <= 14) {
1103         putc(n, pimg->fh);
1104         len = dot;
1105      } else {
1106         if (pimg->label_len) putc(0, pimg->fh);
1107         len = 0;
1108      }
1109   }
1110
1111   n = strlen(s + len);
1112   putc(opt, pimg->fh);
1113   if (n < 0xfe) {
1114      putc(n, pimg->fh);
1115   } else if (n < 0xffff + 0xfe) {
1116      putc(0xfe, pimg->fh);
1117      put16(n - 0xfe, pimg->fh);
1118   } else {
1119      putc(0xff, pimg->fh);
1120      put32(n, pimg->fh);
1121   }
1122   fwrite(s + len, n, 1, pimg->fh);
1123
1124   n += len;
1125   pimg->label_len = n;
1126   if (!check_label_space(pimg, n + 1))
1127      return 0; /* FIXME: distinguish out of memory... */
1128   memcpy(pimg->label_buf + len, s + len, n - len + 1);
1129
1130   return !ferror(pimg->fh);
1131}
1132
1133void
1134img_write_item(img *pimg, int code, int flags, const char *s,
1135               double x, double y, double z)
1136{
1137   if (!pimg) return;
1138   if (pimg->version == 3) {
1139      int opt = 0;
1140      switch (code) {
1141       case img_LABEL:
1142         write_v3label(pimg, 0x40 | flags, s);
1143         opt = 0;
1144         break;
1145       case img_MOVE:
1146         opt = 15;
1147         break;
1148       case img_LINE:
1149         write_v3label(pimg, 0x80 | flags, s ? s : "");
1150         opt = 0;
1151         break;
1152       default: /* ignore for now */
1153         return;
1154      }
1155      if (opt) putc(opt, pimg->fh);
1156      /* Output in cm */
1157      put32((INT32_T)my_round(x * 100.0), pimg->fh);
1158      put32((INT32_T)my_round(y * 100.0), pimg->fh);
1159      put32((INT32_T)my_round(z * 100.0), pimg->fh);
1160   } else {
1161      size_t len;
1162      INT32_T opt = 0;
1163      ASSERT(pimg->version > 0);
1164      switch (code) {
1165       case img_LABEL:
1166         if (pimg->version == 1) {
1167            /* put a move before each label */
1168            img_write_item(pimg, img_MOVE, 0, NULL, x, y, z);
1169            put32(2, pimg->fh);
1170            fputsnl(s, pimg->fh);
1171            return;
1172         }
1173         len = strlen(s);
1174         if (len > 255 || strchr(s, '\n')) {
1175            /* long label - not in early incarnations of v2 format, but few
1176             * 3d files will need these, so better not to force incompatibility
1177             * with a new version I think... */
1178            putc(7, pimg->fh);
1179            putc(flags, pimg->fh);
1180            put32(len, pimg->fh);
1181            fputs(s, pimg->fh);
1182         } else {
1183            putc(0x40 | (flags & 0x3f), pimg->fh);
1184            fputsnl(s, pimg->fh);
1185         }
1186         opt = 0;
1187         break;
1188       case img_MOVE:
1189         opt = 4;
1190         break;
1191       case img_LINE:
1192         if (pimg->version > 1) {
1193            opt = 0x80 | (flags & 0x3f);
1194            break;
1195         }
1196         opt = 5;
1197         break;
1198       default: /* ignore for now */
1199         return;
1200      }
1201      if (pimg->version == 1) {
1202         put32(opt, pimg->fh);
1203      } else {
1204         if (opt) putc(opt, pimg->fh);
1205      }
1206      /* Output in cm */
1207      put32((INT32_T)my_round(x * 100.0), pimg->fh);
1208      put32((INT32_T)my_round(y * 100.0), pimg->fh);
1209      put32((INT32_T)my_round(z * 100.0), pimg->fh);
1210   }
1211}
1212
1213int
1214img_close(img *pimg)
1215{
1216   int result = 1;
1217   if (pimg) {
1218      if (pimg->fh) {
1219         if (pimg->fRead) {
1220            osfree(pimg->survey);
1221            osfree(pimg->title);
1222            osfree(pimg->datestamp);
1223         } else {
1224            /* write end of data marker */
1225            switch (pimg->version) {
1226             case 1:
1227               put32((INT32_T)-1, pimg->fh);
1228               break;
1229             case 2:
1230               putc(0, pimg->fh);
1231               break;
1232             case 3:
1233               if (pimg->label_len) putc(0, pimg->fh);
1234               putc(0, pimg->fh);
1235               break;
1236            }
1237         }
1238         if (ferror(pimg->fh)) result = 0;
1239         if (fclose(pimg->fh)) result = 0;
1240         img_errno = pimg->fRead ? IMG_READERROR : IMG_WRITEERROR;
1241      }
1242      osfree(pimg->label_buf);
1243      osfree(pimg);
1244   }
1245   return result;
1246}
Note: See TracBrowser for help on using the repository browser.