Add GSM full rate codec to LCR's source repository
[lcr.git] / libgsmfr / src / toast.c
diff --git a/libgsmfr/src/toast.c b/libgsmfr/src/toast.c
new file mode 100644 (file)
index 0000000..9823642
--- /dev/null
@@ -0,0 +1,800 @@
+/*
+ * Copyright 1992 by Jutta Degener and Carsten Bormann, Technische
+ * Universitaet Berlin.  See the accompanying file "COPYRIGHT" for
+ * details.  THERE IS ABSOLUTELY NO WARRANTY FOR THIS SOFTWARE.
+ */
+
+/* $Header: /tmp_amd/presto/export/kbs/jutta/src/gsm/RCS/toast.c,v 1.8 1996/07/02 10:41:04 jutta Exp $ */
+
+#include       "toast.h"
+
+/*  toast -- lossy sound compression using the gsm library.
+ */
+
+char   * progname;
+
+int    f_decode   = 0;         /* decode rather than encode     (-d) */
+int    f_cat      = 0;         /* write to stdout; implies -p   (-c) */
+int    f_force    = 0;         /* don't ask about replacements  (-f) */
+int    f_precious = 0;         /* avoid deletion of original    (-p) */
+int    f_fast     = 0;         /* use faster fpt algorithm      (-F) */
+int    f_verbose  = 0;         /* debugging                     (-V) */
+int    f_ltp_cut  = 0;         /* LTP cut-off margin            (-C) */
+
+struct stat instat;            /* stat (inname)                 */
+
+FILE   *in,     *out;
+char   *inname, *outname;
+
+/*
+ *  The function (*output)() writes a frame of 160 samples given as
+ *  160 signed 16 bit values (gsm_signals) to <out>.
+ *  The function (*input)() reads one such frame from <in>.
+ *  The function (*init_output)() begins output (e.g. writes a header).,
+ *  The function (*init_input)() begins input (e.g. skips a header).
+ *
+ *  There are different versions of input, output, init_input and init_output
+ *  for different formats understood by toast; which ones are used 
+ *  depends on the command line arguments and, in their absence, the
+ *  filename; the fallback is #defined in toast.h
+ *
+ *  The specific implementations of input, output, init_input and init_output
+ *  for a format `foo' live in toast_foo.c.
+ */
+
+int    (*output   ) P((gsm_signal *)),
+       (*input    ) P((gsm_signal *));
+int    (*init_input)  P((void)),
+       (*init_output) P((void));
+
+static int     generic_init P0() { return 0; } /* NOP */
+
+struct fmtdesc {
+
+       char * name, * longname, * suffix;
+
+       int  (* init_input )  P((void)),
+            (* init_output)  P((void));
+
+       int  (* input ) P((gsm_signal * )),
+            (* output) P((gsm_signal * ));
+
+} f_audio = {
+               "audio",
+               "8 kHz, 8 bit u-law encoding with Sun audio header", ".au",
+               audio_init_input,
+               audio_init_output,
+               ulaw_input,
+               ulaw_output
+}, f_ulaw = {
+               "u-law", "plain 8 kHz, 8 bit u-law encoding", ".u",
+               generic_init,
+               generic_init,
+               ulaw_input,
+               ulaw_output 
+
+}, f_alaw = {
+               "A-law", "8 kHz, 8 bit A-law encoding", ".A",
+               generic_init,
+               generic_init,
+               alaw_input,
+               alaw_output
+
+}, f_linear = {
+               "linear",
+               "16 bit (13 significant) signed 8 kHz signal", ".l",
+               generic_init,
+               generic_init,
+               linear_input,
+               linear_output
+};
+
+struct fmtdesc * alldescs[] = {
+       &f_audio,
+       &f_alaw,
+       &f_ulaw,
+       &f_linear,
+       (struct fmtdesc *)NULL
+};
+
+#define        DEFAULT_FORMAT  f_ulaw          /* default audio format, others */
+                                       /* are: f_alaw,f_audio,f_linear */
+struct fmtdesc * f_format  = 0;
+
+/*
+ *  basename + suffix of a pathname
+ */
+static char * endname P1((name), char * name)
+{
+       if (name) {
+               char * s = strrchr(name, '/');
+               if (s && s[1]) name = s + 1;
+       }
+       return name;
+
+}
+
+/*
+ *  Try to figure out what we're supposed to do from the argv[0], if
+ *  any, and set the parameters accordingly.
+ */
+static void parse_argv0 P1((av0), char * av0 )
+{
+       int     l;
+
+       progname = av0 = endname(av0 ? av0 : "toast");
+
+       /*  If the name starts with `un', we want to decode, not code.
+        *  If the name ends in `cat', we want to write to stdout,
+        *  and decode as well.
+        */
+
+       if (!strncmp(av0, "un", 2)) f_decode = 1;
+       if (  (l = strlen(av0)) >= 3 /* strlen("cat") */
+          && !strcmp( av0 + l - 3, "cat" )) f_cat = f_decode = 1;
+}
+
+
+/*
+ *  Check whether the name (possibly generated by appending
+ *  .gsm to something else) is short enough for this system.
+ */
+static int length_okay P1((name), char * name)
+{
+       long    max_filename_length = 0;
+       char    * end;
+
+       /* If our _pathname_ is too long, we'll usually not be
+        * able to open the file at all -- don't worry about that.
+        * 
+        * But if the _filename_ is too long, there is danger of
+        * silent truncation on some systems, which results
+        * in the target replacing the source!
+        */
+
+       if (!name) return 0;
+       end = endname(name);
+
+#ifdef NAME_MAX
+       max_filename_length  = NAME_MAX;
+#else
+#ifdef _PC_NAME_MAX
+#ifdef USE_PATHCONF
+       {       char * s, tmp; 
+               
+               /*  s = dirname(name)
+                */
+               if ((s = end) > name) {
+                       if (s > name + 1) s--;
+                       tmp = s;
+                       *s  = 0;
+               }
+
+               errno = 0;
+               max_filename_length = pathconf(s > name ? name : ".",
+                       _PC_NAME_MAX);
+               if (max_filename_length == -1 && errno) {
+                       perror( s > name ? name : "." );
+                       fprintf(stderr,
+               "%s: cannot get dynamic filename length limit for %s.\n",
+                               progname, s > name ? name : ".");
+                       return 0;
+               }
+               if (s > name) *s = tmp;
+       }
+#endif /* USE_PATHCONF  */
+#endif /* _PC_NAME_MAX  */
+#endif /* !NAME_MAX    */
+
+       if (max_filename_length > 0 && strlen(end) > max_filename_length) {
+               fprintf(stderr,
+                       "%s: filename \"%s\" is too long (maximum is %ld)\n",
+                       progname, endname(name), max_filename_length );
+               return 0;
+       }
+
+       return 1;
+}
+
+/*
+ *  Return a pointer the suffix of a string, if any.
+ *  A suffix alone has no suffix, an empty suffix can not be had.
+ */
+static char * suffix P2((name, suf), char *name, char * suf) 
+{
+       size_t nlen = strlen(name);
+       size_t slen = strlen(suf);
+
+       if (!slen || nlen <= slen) return (char *)0;
+       name += nlen - slen;
+       return memcmp(name, suf, slen) ? (char *)0 : name;
+}
+
+
+static void catch_signals P1((fun), SIGHANDLER_T (*fun) ()) 
+{
+#ifdef SIGHUP
+       signal( SIGHUP,   fun );
+#endif
+#ifdef SIGINT
+       signal( SIGINT,   fun );
+#endif
+#ifdef SIGPIPE
+       signal( SIGPIPE,  fun );
+#endif
+#ifdef SIGTERM
+       signal( SIGTERM,  fun );
+#endif
+#ifdef SIGXFSZ
+       signal( SIGXFSZ,  fun );
+#endif
+}
+
+static SIGHANDLER_T onintr P0()
+{
+       char * tmp = outname;
+
+#ifdef HAS_SYSV_SIGNALS
+       catch_signals( SIG_IGN );
+#endif
+
+       outname = (char *)0;
+       if (tmp) (void)unlink(tmp);
+
+       exit(1);
+}
+
+/*
+ *  Allocate some memory and complain if it fails.
+ */
+static char * emalloc P1((len), size_t len)
+{
+       char * s;
+       if (!(s = malloc(len))) {
+               fprintf(stderr, "%s: failed to malloc %d bytes -- abort\n",
+                       progname, len);
+               onintr();
+               exit(1);
+       }
+       return s;
+}
+
+static char* normalname P3((name, want, cut), char *name, char *want,char *cut)
+{
+       size_t  maxlen;
+       char    * s, * p;
+
+       p = (char *)0;
+       if (!name) return p;
+
+       maxlen = strlen(name) + 1 + strlen(want) + strlen(cut);
+       p = strcpy(emalloc(maxlen), name);
+
+       if (s = suffix(p, cut)) strcpy(s, want);
+       else if (*want && !suffix(p, want)) strcat(p, want);
+
+       return p;
+}
+
+/*
+ *  Generate a `plain' (non-encoded) name from a given name.
+ */
+static char * plainname P1((name), char *name)
+{
+       return normalname(name, "", SUFFIX_TOASTED );
+}
+
+/*
+ *  Generate a `code' name from a given name.
+ */
+static char * codename P1((name), char *name)
+{
+       return normalname( name, SUFFIX_TOASTED, "" );
+}
+
+/*
+ *  If we're supposed to ask (fileno (stderr) is a tty, and f_force not
+ *  set), ask the user whether to overwrite a file or not.
+ */
+static int ok_to_replace P1(( name ), char * name)
+{
+       int reply, c;
+
+       if (f_force) return 1;                  /* YES, do replace   */
+       if (!isatty(fileno(stderr))) return 0;  /* NO, don't replace */
+
+       fprintf(stderr,
+               "%s already exists; do you wish to overwrite %s (y or n)? ",
+               name, name);
+       fflush(stderr);
+
+       for (c = reply = getchar(); c != '\n' && c != EOF; c = getchar()) ;
+       if (reply == 'y') return 1;
+
+       fprintf(stderr, "\tnot overwritten\n");
+       return 0;
+}
+
+static void update_mode P0()
+{
+       if (!instat.st_nlink) return;           /* couldn't stat in */
+
+#ifdef HAS_FCHMOD
+       if (fchmod(fileno(out), instat.st_mode & 07777)) {
+               perror(outname);
+               fprintf(stderr, "%s: could not change file mode of \"%s\"\n",
+                       progname, outname);
+       }
+#else 
+#ifdef HAS_CHMOD
+       if (outname && chmod(outname, instat.st_mode & 07777)) {
+               perror(outname);
+               fprintf(stderr, "%s: could not change file mode of \"%s\"\n",
+                       progname, outname);
+       }
+#endif /* HAS_CHMOD  */
+#endif /* HAS_FCHMOD */
+}
+
+static void update_own P0()
+{
+       if (!instat.st_nlink) return; /* couldn't stat in */
+#ifdef HAS_FCHOWN
+       (void)fchown(fileno(out), instat.st_uid, instat.st_gid);
+#else 
+#ifdef HAS_CHOWN
+       (void)chown(outname, instat.st_uid, instat.st_gid);
+#endif /* HAS_CHOWN  */
+#endif /* HAS_FCHOWN */
+}
+
+static void update_times P0()
+{
+       if (!instat.st_nlink) return;   /* couldn't stat in */
+
+#ifdef HAS_UTIMES
+       if (outname) {
+               struct timeval tv[2];
+
+               tv[0].tv_sec  = instat.st_atime;
+               tv[1].tv_sec  = instat.st_mtime;
+               tv[0].tv_usec = tv[1].tv_usec = 0;
+               (void) utimes(outname, tv);
+       }
+#else
+#ifdef HAS_UTIME
+
+       if (outname) {
+
+#ifdef HAS_UTIMBUF
+               struct utimbuf ut;
+
+               ut.actime     = instat.st_atime;
+               ut.modtime    = instat.st_mtime;
+
+#      ifdef   HAS_UTIMEUSEC
+               ut.acusec     = instat.st_ausec;
+               ut.modusec    = instat.st_musec;
+#      endif   /* HAS_UTIMEUSEC */
+
+               (void) utime(outname, &ut);
+
+#else /* UTIMBUF */
+
+               time_t ut[2];
+
+               ut[0] = instat.st_atime;
+               ut[1] = instat.st_mtime;
+
+               (void) utime(outname, ut);
+
+#endif /* UTIMBUF */
+       }
+#endif /* HAS_UTIME */
+#endif /* HAS_UTIMES */
+}
+
+
+static int okay_as_input P3((name,f,st), char* name, FILE* f, struct stat * st)
+{
+# ifdef        HAS_FSTAT
+       if (fstat(fileno(f), st) < 0)
+# else
+       if (stat(name, st) < 0)
+# endif
+       {
+               perror(name);
+               fprintf(stderr, "%s: cannot stat \"%s\"\n", progname, name);
+               return 0;
+       }
+
+       if (!S_ISREG(st->st_mode)) {
+               fprintf(stderr,
+                       "%s: \"%s\" is not a regular file -- unchanged.\n",
+                       progname, name);
+               return 0;
+       }
+       if (st->st_nlink > 1 && !f_cat && !f_precious) {
+               fprintf(stderr, 
+                     "%s: \"%s\" has %s other link%s -- unchanged.\n",
+                       progname,name,st->st_nlink - 1,"s" + (st->st_nlink<=2));
+               return 0;
+       }
+       return 1;
+}
+
+static void prepare_io P1(( desc), struct fmtdesc * desc)
+{
+       output      = desc->output;
+       input       = desc->input;
+
+       init_input  = desc->init_input;
+       init_output = desc->init_output;
+}
+
+static struct fmtdesc * grok_format P1((name), char * name)
+{
+       char * c;
+       struct fmtdesc ** f;
+
+       if (name) {
+               c = plainname(name);
+
+               for (f = alldescs; *f; f++) {
+                       if (  (*f)->suffix
+                          && *(*f)->suffix
+                          && suffix(c, (*f)->suffix)) {
+
+                               free(c);
+                               return *f;
+                       }
+               }
+
+               free(c);
+       }
+       return (struct fmtdesc *)0;
+}
+
+static int open_input P2((name, st), char * name, struct stat * st)
+{
+       struct fmtdesc * f = f_format;
+
+       st->st_nlink = 0;       /* indicates `undefined' value */
+       if (!name) {
+               inname = (char *)NULL;
+               in     = stdin;
+#ifdef HAS__FSETMODE
+               _fsetmode(in, "b");
+#endif
+       }
+       else {
+               if (f_decode) inname = codename(name);
+               else {
+                       if (!f_cat && suffix(name, SUFFIX_TOASTED)) {
+                               fprintf(stderr,
+                       "%s: %s already has \"%s\" suffix -- unchanged.\n",
+                                       progname, name, SUFFIX_TOASTED );
+                               return 0;
+                       }
+                       inname = strcpy(emalloc(strlen(name)+1), name);
+               }
+               if (!(in = fopen(inname, READ))) {
+                       perror(inname); /* not guaranteed to be valid here */
+                       fprintf(stderr, "%s: cannot open \"%s\" for reading\n",
+                               progname, inname);
+                       return 0;
+               }
+               if (!okay_as_input(inname, in, st)) return 0;
+               if (!f) f = grok_format(inname);
+       }
+       prepare_io( f ? f : & DEFAULT_FORMAT );
+       return 1;
+}
+
+static int open_output P1((name), char *name)
+{
+       if (!name || f_cat) {
+               out     = stdout;
+               outname = (char *)NULL;
+#ifdef HAS__FSETMODE
+               _fsetmode(out, "b"); 
+#endif
+       }
+       else {
+               int outfd = -1;
+               char * o;
+
+               o = (*(f_decode ? plainname : codename))(name);
+               if (!length_okay(o)) return 0;
+               if ((outfd = open(o, O_WRITE_EXCL, 0666)) >= 0)
+                       out = fdopen(outfd, WRITE);
+               else if (errno != EEXIST) out = (FILE *)NULL;
+               else if (ok_to_replace(o)) out = fopen(o, WRITE);
+               else return 0;
+
+               if (!out) {
+                       perror(o);
+                       fprintf(stderr,
+                               "%s: can't open \"%s\" for writing\n",
+                               progname, o);
+                       if (outfd >= 0) (void)close(outfd);
+                       return 0;
+               }
+
+               outname = o;
+       }
+       return 1;
+}
+
+static int process_encode P0()
+{
+       gsm             r;
+       gsm_signal      s[ 160 ];
+       gsm_frame       d;
+       int             cc;
+
+       if (!(r = gsm_create())) {
+               perror(progname);
+               return -1;
+       }
+       (void)gsm_option(r, GSM_OPT_FAST,       &f_fast);
+       (void)gsm_option(r, GSM_OPT_VERBOSE,    &f_verbose);
+       (void)gsm_option(r, GSM_OPT_LTP_CUT,    &f_ltp_cut);
+
+       while ((cc = (*input)(s)) > 0) {
+               if (cc < sizeof(s) / sizeof(*s))
+                       memset((char *)(s+cc), 0, sizeof(s)-(cc * sizeof(*s)));
+               gsm_encode(r, s, d);
+               if (fwrite((char *)d, sizeof(d), 1, out) != 1) {
+                       perror(outname ? outname : "stdout");
+                       fprintf(stderr, "%s: error writing to %s\n",
+                               progname, outname ? outname : "stdout");
+                       gsm_destroy(r);
+                       return -1;
+               }
+       }
+       if (cc < 0) {
+               perror(inname ? inname : "stdin");
+               fprintf(stderr, "%s: error reading from %s\n",
+                       progname, inname ? inname : "stdin");
+               gsm_destroy(r);
+               return -1;
+       }
+       gsm_destroy(r);
+
+       return 0;
+}
+
+static int process_decode P0()
+{
+       gsm             r;
+       gsm_frame       s;
+       gsm_signal      d[ 160 ];
+       int             cc;
+
+       if (!(r = gsm_create())) {      /* malloc failed */
+               perror(progname);
+               return -1;
+       }
+       (void)gsm_option(r, GSM_OPT_FAST,    &f_fast);
+       (void)gsm_option(r, GSM_OPT_VERBOSE, &f_verbose);
+
+       while ((cc = fread(s, 1, sizeof(s), in)) > 0) {
+
+               if (cc != sizeof(s)) {
+                       if (cc >= 0) fprintf(stderr,
+                       "%s: incomplete frame (%d byte%s missing) from %s\n",
+                                       progname, sizeof(s) - cc,
+                                       "s" + (sizeof(s) - cc == 1),
+                                       inname ? inname : "stdin" );
+                       gsm_destroy(r);
+                       errno = 0;
+                       return -1;
+               }
+               if (gsm_decode(r, s, d)) {
+                       fprintf(stderr, "%s: bad frame in %s\n", 
+                               progname, inname ? inname : "stdin");
+                       gsm_destroy(r);
+                       errno = 0;
+                       return -1;
+               }
+
+               if ((*output)(d) < 0) {
+                       perror(outname);
+                       fprintf(stderr, "%s: error writing to %s\n",
+                                       progname, outname);
+                       gsm_destroy(r);
+                       return -1;
+               }
+       }
+
+       if (cc < 0) {
+               perror(inname ? inname : "stdin" );
+               fprintf(stderr, "%s: error reading from %s\n", progname,
+                       inname ? inname : "stdin");
+               gsm_destroy(r);
+               return -1;
+       }
+
+       gsm_destroy(r);
+       return 0;
+}
+
+static int process P1((name), char * name)
+{
+       int step = 0;
+
+       out     = (FILE *)0;
+       in      = (FILE *)0;
+
+       outname = (char *)0;
+       inname  = (char *)0;
+
+       if (!open_input(name, &instat) || !open_output(name))
+               goto err;
+
+       if ((*(f_decode ? init_output    : init_input))()) {
+               fprintf(stderr, "%s: error %s %s\n",
+                       progname,
+                       f_decode ? "writing header to" : "reading header from",
+                       f_decode ? (outname ? outname : "stdout")
+                                : (inname ? inname : "stdin"));
+               goto err;
+       }
+
+       if ((*(f_decode ? process_decode : process_encode))())
+               goto err;
+
+       if (fflush(out) < 0 || ferror(out)) {
+               perror(outname ? outname : "stdout");
+               fprintf(stderr, "%s: error writing \"%s\"\n", progname,
+                               outname ? outname:"stdout");
+               goto err;
+       }
+
+       if (out != stdout) {
+
+               update_times();
+               update_mode ();
+               update_own  ();
+
+               if (fclose(out) < 0) {
+                       perror(outname);
+                       fprintf(stderr, "%s: error writing \"%s\"\n",
+                               progname, outname);
+                       goto err;
+               }
+               if (outname != name) free(outname);
+               outname = (char *)0;
+       }
+       out = (FILE *)0;
+       if (in  != stdin) {
+               (void)fclose(in), in = (FILE *)0;
+               if (!f_cat && !f_precious) {
+                       if (unlink(inname) < 0) {
+                               perror(inname);
+                               fprintf(stderr,
+                                       "%s: source \"%s\" not deleted.\n",
+                                       progname, inname);
+                       }
+                       goto err;
+               }
+               if (inname != name) free(inname);
+               inname = (char *)0;
+       }
+       return 0;
+
+       /*
+        *  Error handling and cleanup.
+        */
+err:
+       if (out && out != stdout) {
+               (void)fclose(out), out = (FILE *)0;
+               if (unlink(outname) < 0 && errno != ENOENT && errno != EINTR) {
+                       perror(outname);
+                       fprintf(stderr, "%s: could not unlink \"%s\"\n",
+                               progname, outname);
+               }
+       }
+       if (in && in != stdin) (void)fclose(in), in = (FILE *)0;
+
+       if (inname  && inname  != name) free(inname);
+       if (outname && outname != name) free(outname);
+
+       return -1;
+}
+
+static void version P0()
+{
+       printf( "%s 1.0, version %s\n",
+               progname,
+               "$Id: toast.c,v 1.8 1996/07/02 10:41:04 jutta Exp $" );
+}
+
+static void help P0()
+{
+       printf("Usage: %s [-fcpdhvaulsFC] [files...]\n", progname);
+       printf("\n");
+
+       printf(" -f  force     Replace existing files without asking\n");
+       printf(" -c  cat       Write to stdout, do not remove source files\n");
+       printf(" -d  decode    Decode data (default is encode)\n");
+       printf(" -p  precious  Do not delete the source\n");
+       printf("\n");
+
+       printf(" -u  u-law     Force 8 kHz/8 bit u-law in/output format\n");
+       printf(" -s  sun .au   Force Sun .au u-law in/output format\n");
+       printf(" -a  A-law     Force 8 kHz/8 bit A-law in/output format\n");
+       printf(" -l  linear    Force 16 bit linear in/output format\n");
+       printf("\n");
+
+       printf(" -F  fast      Sacrifice conformance to performance\n");
+       printf(" -C  cutoff    Ignore most samples during LTP\n");
+       printf(" -v  version   Show version information\n");
+       printf(" -h  help      Print this text\n");
+       printf("\n");
+}
+
+
+static void set_format P1((f), struct fmtdesc * f)
+{
+       if (f_format && f_format != f) {
+               fprintf( stderr,
+       "%s: only one of -[uals] is possible (%s -h for help)\n",
+                       progname, progname);
+               exit(1);
+       }
+
+       f_format = f;
+}
+
+int main P2((ac, av), int ac, char **av)
+{
+       int             opt;
+       extern int      optind;
+       extern char     * optarg;
+
+       parse_argv0(*av);
+
+       while ((opt = getopt(ac, av, "fcdpvhuaslVFC:")) != EOF) switch (opt) {
+
+       case 'd': f_decode   = 1; break;
+       case 'f': f_force    = 1; break;
+       case 'c': f_cat      = 1; break;
+       case 'p': f_precious = 1; break;
+       case 'F': f_fast     = 1; break;
+       case 'C': f_ltp_cut  = 100; break;
+#ifndef        NDEBUG
+       case 'V': f_verbose  = 1; break;        /* undocumented */
+#endif
+
+       case 'u': set_format( &f_ulaw   ); break;
+       case 'l': set_format( &f_linear ); break;
+       case 'a': set_format( &f_alaw   ); break;
+       case 's': set_format( &f_audio  ); break;
+
+       case 'v': version(); exit(0);
+       case 'h': help();    exit(0);
+
+       default: 
+       usage:
+               fprintf(stderr,
+       "Usage: %s [-fcpdhvuaslFC] [files...] (-h for help)\n",
+                       progname);
+               exit(1);
+       }
+
+       f_precious |= f_cat;
+
+       av += optind;
+       ac -= optind;
+
+       catch_signals(onintr);
+
+       if (ac <= 0) process( (char *)0 );
+       else while (ac--) process( *av++ );
+
+       exit(0);
+}