ref: bced4f4ff6fdd3820348c17b6ffadc515800074d
dir: /src/misc.c/
/*
* July 5, 1991
* Copyright 1991 Lance Norskog And Sundry Contributors
* This source code is freely redistributable and may be used for
* any purpose. This copyright notice must be maintained.
* Lance Norskog And Sundry Contributors are not responsible for
* the consequences of using this software.
*/
/*
* Sound Tools miscellaneous stuff.
*/
#include "st_i.h"
#include <math.h>
#include <stdio.h>
#include <stdlib.h>
#include <stddef.h>
#include <string.h>
#include <ctype.h>
#include <errno.h>
/* for fstat */
#include <sys/stat.h>
#ifdef HAVE_UNISTD_H
#include <unistd.h>
#endif
#ifdef HAVE_BYTESWAP_H
#include <byteswap.h>
#endif
const char * const st_sizes_str[] = {
"NONSENSE!",
"1 byte",
"2 bytes",
"3 bytes",
"4 bytes",
"NONSENSE",
"NONSENSE",
"NONSENSE",
"8 bytes"
};
const char * const st_size_bits_str[] = {
"NONSENSE!",
"8-bit",
"16-bit",
"24-bit",
"32-bit",
"NONSENSE",
"NONSENSE",
"NONSENSE",
"64-bit"
};
const char * const st_encodings_str[] = {
"NONSENSE!",
"u-law",
"A-law",
"G72x-ADPCM",
"MS-ADPCM",
"IMA-ADPCM",
"OKI-ADPCM",
"", /* FIXME, see st.h */
"unsigned",
"signed (2's complement)",
"floating point",
"GSM",
"MPEG audio (layer I, II or III)",
"Vorbis",
"FLAC",
};
assert_static(array_length(st_encodings_str) == ST_ENCODINGS,
SIZE_MISMATCH_BETWEEN_st_encodings_t_AND_st_encodings_str);
static const char readerr[] = "Premature EOF while reading sample file.";
static const char writerr[] = "Error writing sample file. You are probably out of disk space.";
/* Lookup table to reverse the bit order of a byte. ie MSB become LSB */
static uint8_t const cswap[256] = {
0x00, 0x80, 0x40, 0xC0, 0x20, 0xA0, 0x60, 0xE0, 0x10, 0x90, 0x50, 0xD0,
0x30, 0xB0, 0x70, 0xF0, 0x08, 0x88, 0x48, 0xC8, 0x28, 0xA8, 0x68, 0xE8,
0x18, 0x98, 0x58, 0xD8, 0x38, 0xB8, 0x78, 0xF8, 0x04, 0x84, 0x44, 0xC4,
0x24, 0xA4, 0x64, 0xE4, 0x14, 0x94, 0x54, 0xD4, 0x34, 0xB4, 0x74, 0xF4,
0x0C, 0x8C, 0x4C, 0xCC, 0x2C, 0xAC, 0x6C, 0xEC, 0x1C, 0x9C, 0x5C, 0xDC,
0x3C, 0xBC, 0x7C, 0xFC, 0x02, 0x82, 0x42, 0xC2, 0x22, 0xA2, 0x62, 0xE2,
0x12, 0x92, 0x52, 0xD2, 0x32, 0xB2, 0x72, 0xF2, 0x0A, 0x8A, 0x4A, 0xCA,
0x2A, 0xAA, 0x6A, 0xEA, 0x1A, 0x9A, 0x5A, 0xDA, 0x3A, 0xBA, 0x7A, 0xFA,
0x06, 0x86, 0x46, 0xC6, 0x26, 0xA6, 0x66, 0xE6, 0x16, 0x96, 0x56, 0xD6,
0x36, 0xB6, 0x76, 0xF6, 0x0E, 0x8E, 0x4E, 0xCE, 0x2E, 0xAE, 0x6E, 0xEE,
0x1E, 0x9E, 0x5E, 0xDE, 0x3E, 0xBE, 0x7E, 0xFE, 0x01, 0x81, 0x41, 0xC1,
0x21, 0xA1, 0x61, 0xE1, 0x11, 0x91, 0x51, 0xD1, 0x31, 0xB1, 0x71, 0xF1,
0x09, 0x89, 0x49, 0xC9, 0x29, 0xA9, 0x69, 0xE9, 0x19, 0x99, 0x59, 0xD9,
0x39, 0xB9, 0x79, 0xF9, 0x05, 0x85, 0x45, 0xC5, 0x25, 0xA5, 0x65, 0xE5,
0x15, 0x95, 0x55, 0xD5, 0x35, 0xB5, 0x75, 0xF5, 0x0D, 0x8D, 0x4D, 0xCD,
0x2D, 0xAD, 0x6D, 0xED, 0x1D, 0x9D, 0x5D, 0xDD, 0x3D, 0xBD, 0x7D, 0xFD,
0x03, 0x83, 0x43, 0xC3, 0x23, 0xA3, 0x63, 0xE3, 0x13, 0x93, 0x53, 0xD3,
0x33, 0xB3, 0x73, 0xF3, 0x0B, 0x8B, 0x4B, 0xCB, 0x2B, 0xAB, 0x6B, 0xEB,
0x1B, 0x9B, 0x5B, 0xDB, 0x3B, 0xBB, 0x7B, 0xFB, 0x07, 0x87, 0x47, 0xC7,
0x27, 0xA7, 0x67, 0xE7, 0x17, 0x97, 0x57, 0xD7, 0x37, 0xB7, 0x77, 0xF7,
0x0F, 0x8F, 0x4F, 0xCF, 0x2F, 0xAF, 0x6F, 0xEF, 0x1F, 0x9F, 0x5F, 0xDF,
0x3F, 0xBF, 0x7F, 0xFF
};
/* Utilities */
/* Read in a buffer of data of length len and each element is size bytes.
* Returns number of elements read, not bytes read.
*/
size_t st_readbuf(ft_t ft, void *buf, size_t size, st_size_t len)
{
return fread(buf, size, len, ft->fp);
}
/* Skip input without seeking. */
int st_skipbytes(ft_t ft, st_size_t n)
{
unsigned char trash;
while (n--)
if (st_readb(ft, &trash) == ST_EOF)
return (ST_EOF);
return (ST_SUCCESS);
}
/* Pad output. */
int st_padbytes(ft_t ft, st_size_t n)
{
while (n--)
if (st_writeb(ft, '\0') == ST_EOF)
return (ST_EOF);
return (ST_SUCCESS);
}
/* Write a buffer of data of length len and each element is size bytes.
* Returns number of elements writen, not bytes written.
*/
size_t st_writebuf(ft_t ft, void const *buf, size_t size, st_size_t len)
{
return fwrite(buf, size, len, ft->fp);
}
st_size_t st_filelength(ft_t ft)
{
struct stat st;
fstat(fileno(ft->fp), &st);
return (st_size_t)st.st_size;
}
int st_flush(ft_t ft)
{
return fflush(ft->fp);
}
st_size_t st_tell(ft_t ft)
{
return (st_size_t)ftello(ft->fp);
}
int st_eof(ft_t ft)
{
return feof(ft->fp);
}
int st_error(ft_t ft)
{
return ferror(ft->fp);
}
void st_rewind(ft_t ft)
{
rewind(ft->fp);
}
void st_clearerr(ft_t ft)
{
clearerr(ft->fp);
}
/* Read and write known datatypes in "machine format". Swap if indicated.
* They all return ST_EOF on error and ST_SUCCESS on success.
*/
/* Read n-char string (and possibly null-terminating).
* Stop reading and null-terminate string if either a 0 or \n is reached.
*/
int st_reads(ft_t ft, char *c, st_size_t len)
{
char *sc;
char in;
sc = c;
do
{
if (st_readbuf(ft, &in, 1, 1) != 1)
{
*sc = 0;
st_fail_errno(ft,errno,readerr);
return (ST_EOF);
}
if (in == 0 || in == '\n')
break;
*sc = in;
sc++;
} while (sc - c < (ptrdiff_t)len);
*sc = 0;
return(ST_SUCCESS);
}
/* Write null-terminated string (without \0). */
int st_writes(ft_t ft, char *c)
{
if (st_writebuf(ft, c, 1, strlen(c)) != strlen(c))
{
st_fail_errno(ft,errno,writerr);
return(ST_EOF);
}
return(ST_SUCCESS);
}
/* Read byte. */
int st_readb(ft_t ft, uint8_t *ub)
{
if (st_readbuf(ft, ub, 1, 1) != 1) {
st_fail_errno(ft,errno,readerr);
return ST_EOF;
}
if (ft->signal.reverse_bits)
*ub = cswap[*ub];
if (ft->signal.reverse_nibbles)
*ub = ((*ub & 15) << 4) | (*ub >> 4);
return ST_SUCCESS;
}
/* Write byte. */
int st_writeb(ft_t ft, uint8_t ub)
{
if (ft->signal.reverse_nibbles)
ub = ((ub & 15) << 4) | (ub >> 4);
if (ft->signal.reverse_bits)
ub = cswap[ub];
if (st_writebuf(ft, &ub, 1, 1) != 1) {
st_fail_errno(ft,errno,writerr);
return ST_EOF;
}
return ST_SUCCESS;
}
/* Read word. */
int st_readw(ft_t ft, uint16_t *uw)
{
if (st_readbuf(ft, uw, 2, 1) != 1)
{
st_fail_errno(ft,errno,readerr);
return (ST_EOF);
}
if (ft->signal.reverse_bytes)
*uw = st_swapw(*uw);
return ST_SUCCESS;
}
/* Write word. */
int st_writew(ft_t ft, uint16_t uw)
{
if (ft->signal.reverse_bytes)
uw = st_swapw(uw);
if (st_writebuf(ft, &uw, 2, 1) != 1)
{
st_fail_errno(ft,errno,writerr);
return (ST_EOF);
}
return(ST_SUCCESS);
}
/* Read three bytes. */
int st_read3(ft_t ft, uint24_t *u3)
{
if (st_readbuf(ft, u3, 3, 1) != 1)
{
st_fail_errno(ft,errno,readerr);
return (ST_EOF);
}
if (ft->signal.reverse_bytes)
*u3 = st_swap24(*u3);
return ST_SUCCESS;
}
/* Write three bytes. */
int st_write3(ft_t ft, uint24_t u3)
{
if (ft->signal.reverse_bytes)
u3 = st_swap24(u3);
if (st_writebuf(ft, &u3, 3, 1) != 1)
{
st_fail_errno(ft,errno,writerr);
return (ST_EOF);
}
return(ST_SUCCESS);
}
/* Read double word. */
int st_readdw(ft_t ft, uint32_t *udw)
{
if (st_readbuf(ft, udw, 4, 1) != 1)
{
st_fail_errno(ft,errno,readerr);
return (ST_EOF);
}
if (ft->signal.reverse_bytes)
*udw = st_swapdw(*udw);
return ST_SUCCESS;
}
/* Write double word. */
int st_writedw(ft_t ft, uint32_t udw)
{
if (ft->signal.reverse_bytes)
udw = st_swapdw(udw);
if (st_writebuf(ft, &udw, 4, 1) != 1)
{
st_fail_errno(ft,errno,writerr);
return (ST_EOF);
}
return(ST_SUCCESS);
}
/* Read float. */
int st_readf(ft_t ft, float *f)
{
if (st_readbuf(ft, f, sizeof(float), 1) != 1)
{
st_fail_errno(ft,errno,readerr);
return(ST_EOF);
}
if (ft->signal.reverse_bytes)
*f = st_swapf(*f);
return ST_SUCCESS;
}
/* Write float. */
int st_writef(ft_t ft, float f)
{
float t = f;
if (ft->signal.reverse_bytes)
t = st_swapf(t);
if (st_writebuf(ft, &t, sizeof(float), 1) != 1)
{
st_fail_errno(ft,errno,writerr);
return (ST_EOF);
}
return (ST_SUCCESS);
}
/* Read double. */
int st_readdf(ft_t ft, double *d)
{
if (st_readbuf(ft, d, sizeof(double), 1) != 1)
{
st_fail_errno(ft,errno,readerr);
return(ST_EOF);
}
if (ft->signal.reverse_bytes)
*d = st_swapd(*d);
return ST_SUCCESS;
}
/* Write double. */
int st_writedf(ft_t ft, double d)
{
if (ft->signal.reverse_bytes)
d = st_swapd(d);
if (st_writebuf(ft, &d, sizeof(double), 1) != 1)
{
st_fail_errno(ft,errno,writerr);
return (ST_EOF);
}
return (ST_SUCCESS);
}
uint32_t get32_le(unsigned char **p)
{
uint32_t val = (((*p)[3]) << 24) | (((*p)[2]) << 16) |
(((*p)[1]) << 8) | (**p);
(*p) += 4;
return val;
}
uint16_t get16_le(unsigned char **p)
{
unsigned val = (((*p)[1]) << 8) | (**p);
(*p) += 2;
return val;
}
void put32_le(unsigned char **p, uint32_t val)
{
*(*p)++ = val & 0xff;
*(*p)++ = (val >> 8) & 0xff;
*(*p)++ = (val >> 16) & 0xff;
*(*p)++ = (val >> 24) & 0xff;
}
void put16_le(unsigned char **p, int16_t val)
{
*(*p)++ = val & 0xff;
*(*p)++ = (val >> 8) & 0xff;
}
void put32_be(unsigned char **p, int32_t val)
{
*(*p)++ = (val >> 24) & 0xff;
*(*p)++ = (val >> 16) & 0xff;
*(*p)++ = (val >> 8) & 0xff;
*(*p)++ = val & 0xff;
}
void put16_be(unsigned char **p, short val)
{
*(*p)++ = (val >> 8) & 0xff;
*(*p)++ = val & 0xff;
}
/* generic swap routine. Swap l and place in to f (datatype length = n) */
static void st_swapb(char *l, char *f, int n)
{
register int i;
for (i= 0; i< n; i++)
f[i]= l[n-i-1];
}
/* return swapped 32-bit float */
float st_swapf(float f)
{
union {
uint32_t dw;
float f;
} u;
u.f= f;
u.dw= (u.dw>>24) | ((u.dw>>8)&0xff00) | ((u.dw<<8)&0xff0000L) | (u.dw<<24);
return u.f;
}
uint32_t st_swap24(uint24_t udw)
{
return ((udw >> 16) & 0xff) | (udw & 0xff00) | ((udw << 16) & 0xff0000L);
}
double st_swapd(double df)
{
double sdf;
st_swapb((char *)&df, (char *)&sdf, sizeof(double));
return (sdf);
}
/* dummy format routines for do-nothing functions */
int st_format_nothing(ft_t ft UNUSED) { return(ST_SUCCESS); }
st_size_t st_format_nothing_read_io(ft_t ft UNUSED, st_sample_t *buf UNUSED, st_size_t len UNUSED) { return(0); }
st_size_t st_format_nothing_write_io(ft_t ft UNUSED, const st_sample_t *buf UNUSED, st_size_t len UNUSED) { return(0); }
int st_format_nothing_seek(ft_t ft UNUSED, st_size_t offset UNUSED) { st_fail_errno(ft, ST_ENOTSUP, "operation not supported"); return(ST_EOF); }
/* dummy effect routine for do-nothing functions */
int st_effect_nothing(eff_t effp UNUSED)
{
return ST_SUCCESS;
}
int st_effect_nothing_flow(eff_t effp UNUSED, const st_sample_t *ibuf UNUSED, st_sample_t *obuf UNUSED, st_size_t *isamp, st_size_t *osamp)
{
/* Pass through samples verbatim */
*isamp = *osamp = min(*isamp, *osamp);
memcpy(obuf, ibuf, *isamp * sizeof(st_sample_t));
return ST_SUCCESS;
}
int st_effect_nothing_drain(eff_t effp UNUSED, st_sample_t *obuf UNUSED, st_size_t *osamp)
{
/* Inform no more samples to drain */
*osamp = 0;
return ST_EOF;
}
int st_effect_nothing_getopts(eff_t effp, int n, char **argv UNUSED)
{
if (n) {
st_fail(effp->h->usage);
return (ST_EOF);
}
return (ST_SUCCESS);
}
/* here for linear interp. might be useful for other things */
st_sample_t st_gcd(st_sample_t a, st_sample_t b)
{
if (b == 0)
return a;
else
return st_gcd(b, a % b);
}
st_sample_t st_lcm(st_sample_t a, st_sample_t b)
{
/* parenthesize this way to avoid st_sample_t overflow in product term */
return a * (b / st_gcd(a, b));
}
#ifndef HAVE_STRCASECMP
/*
* Portable strcasecmp() function
*/
int strcasecmp(const char *s1, const char *s2)
{
while (*s1 && (toupper(*s1) == toupper(*s2)))
s1++, s2++;
return toupper(*s1) - toupper(*s2);
}
int strncasecmp(char const *s1, char const * s2, size_t n)
{
while (--n && *s1 && (toupper(*s1) == toupper(*s2)))
s1++, s2++;
return toupper(*s1) - toupper(*s2);
}
#endif
#ifndef HAVE_STRDUP
/*
* Portable strdup() function
*/
char *strdup(const char *s)
{
return strcpy((char *)xmalloc(strlen(s) + 1), s);
}
#endif
void st_generate_wave_table(
st_wave_t wave_type,
st_data_t data_type,
void *table,
uint32_t table_size,
double min,
double max,
double phase)
{
uint32_t t;
uint32_t phase_offset = phase / M_PI / 2 * table_size + 0.5;
for (t = 0; t < table_size; t++)
{
uint32_t point = (t + phase_offset) % table_size;
double d;
switch (wave_type)
{
case ST_WAVE_SINE:
d = (sin((double)point / table_size * 2 * M_PI) + 1) / 2;
break;
case ST_WAVE_TRIANGLE:
d = (double)point * 2 / table_size;
switch (4 * point / table_size)
{
case 0: d = d + 0.5; break;
case 1: case 2: d = 1.5 - d; break;
case 3: d = d - 1.5; break;
}
break;
default: /* Oops! FIXME */
d = 0.0; /* Make sure we have a value */
break;
}
d = d * (max - min) + min;
switch (data_type)
{
case ST_FLOAT:
{
float *fp = (float *)table;
*fp++ = (float)d;
table = fp;
continue;
}
case ST_DOUBLE:
{
double *dp = (double *)table;
*dp++ = d;
table = dp;
continue;
}
default: break;
}
d += d < 0? -0.5 : +0.5;
switch (data_type)
{
case ST_SHORT:
{
short *sp = table;
*sp++ = (short)d;
table = sp;
continue;
}
case ST_INT:
{
int *ip = table;
*ip++ = (int)d;
table = ip;
continue;
}
default: break;
}
}
}
const char *st_version(void)
{
static char versionstr[20];
sprintf(versionstr, "%d.%d.%d",
(ST_LIB_VERSION_CODE & 0xff0000) >> 16,
(ST_LIB_VERSION_CODE & 0x00ff00) >> 8,
(ST_LIB_VERSION_CODE & 0x0000ff));
return(versionstr);
}
/* Implements traditional fseek() behavior. Meant to abstract out
* file operations so that they could one day also work on memory
* buffers.
*
* N.B. Can only seek forwards!
*/
int st_seeki(ft_t ft, st_size_t offset, int whence)
{
if (ft->seekable == 0) {
/* If a stream peel off chars else EPERM */
if (whence == SEEK_CUR) {
while (offset > 0 && !feof(ft->fp)) {
getc(ft->fp);
offset--;
}
if (offset)
st_fail_errno(ft,ST_EOF, "offset past EOF");
else
ft->st_errno = ST_SUCCESS;
} else
st_fail_errno(ft,ST_EPERM, "file not seekable");
} else {
if (fseeko(ft->fp, offset, whence) == -1)
st_fail_errno(ft,errno,strerror(errno));
else
ft->st_errno = ST_SUCCESS;
}
/* Empty the st file buffer */
if (ft->st_errno == ST_SUCCESS)
ft->eof = 0;
return ft->st_errno;
}
enum_item const * find_enum_text(char const * text, enum_item const * enum_items)
{
enum_item const * result = NULL; /* Assume not found */
while (enum_items->text)
{
if (strncasecmp(text, enum_items->text, strlen(text)) == 0)
{
if (result != NULL && result->value != enum_items->value)
return NULL; /* Found ambiguity */
result = enum_items; /* Found match */
}
++enum_items;
}
return result;
}
enum_item const st_wave_enum[] = {
ENUM_ITEM(ST_WAVE_,SINE)
ENUM_ITEM(ST_WAVE_,TRIANGLE)
{0, 0}};