**
** Copyright (c) 2003 Kevin Rosenberg
**
-** $Id$
-**
** This program is free software; you can redistribute it and/or modify
** it under the terms of the GNU General Public License (version 2) as
** published by the Free Software Foundation.
** Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
******************************************************************************/
+#include <stdlib.h>
#include <wdq2wav.h>
-const char* g_szIdStr = "$Id$";
-
bool g_quiet = false;
bool g_verbose = false;
bool g_debug = false;
+bool g_dry_run = false;
bool g_ignore_zero = false;
bool g_dont_demean = false;
#define O_BINARY 0
#endif
#endif
-
+
void
error_msg (const char *msg)
{
- std::cerr << msg << "\n";
+ std::cerr << msg << std::endl;
}
void
info_msg (const char* msg)
{
- std::cout << msg << "\n";
+ std::cout << msg << std::endl;
}
void
const char* pbackslash = strrchr (filename, '\\');
const char* p = filename;
if (pbackslash && (! pslash || pbackslash >= pslash))
- p = pbackslash+1;
+ p = pbackslash+1;
else if (pslash && (! pbackslash || pslash >= pbackslash))
p = pslash+1;
char *
str_rm_tail (char *str, const char* const charlist)
{
- size_t i;
+ int i;
for (i = strlen(str) - 1; i >= 0; i--)
if (strchr (charlist, str[i]) != NULL)
std::cout << " -q Supress all messages\n";
std::cout << " -z Scale output without preserving zero point\n";
std::cout << " -m Do not demean the data (don't subtract the mean value from each sample)\n";
+ std::cout << " -n Dry run (do not create any output\n";
std::cout << " -v Verbose mode\n";
std::cout << " -d Debug mode\n";
- std::cout << " -r Print program version and exit\n";
std::cout << " -h Print this help message\n";
}
bool play = false;
const char* progname = argv[0];
-
- while ((c = getopt (argc, argv, "rqvzmdph")) != -1) {
+
+ while ((c = getopt (argc, argv, "rqvzmndph")) != -1) {
switch (c) {
- case 'r':
- std::cout << "Version " << g_szIdStr << std::endl;
- exit(0);
- break;
case 'q':
g_quiet = true;
break;
case 'm':
g_dont_demean = true;
break;
+ case 'n':
+ g_dry_run = true;
+ break;
case 'z':
g_ignore_zero = true;
break;
}
}
- if (g_verbose || g_debug)
- std::cout << "Version " << g_szIdStr << std::endl;
-
argc -= optind;
argv += optind;
if (argc > 3) {
char wdq_fname[MAX_INPUT_STR];
if (argc >= 1)
- strncpy (wdq_fname, argv [0], MAX_INPUT_STR);
+ strncpy (wdq_fname, argv [0], MAX_INPUT_STR);
else {
std::cout << "Enter input WinDAQ filename: ";
- std::cin.getline (wdq_fname, MAX_INPUT_STR);
- }
+ std::cin.getline (wdq_fname, MAX_INPUT_STR);
+ }
- char channel_buf [MAX_INPUT_STR];
- if (argc >= 2)
- strncpy (channel_buf, argv[1], MAX_INPUT_STR);
- else {
- std::cout << "Enter channel number: ";
- std::cin.getline (channel_buf, MAX_INPUT_STR);
- }
-
- char *channel_endptr;
- int channel = static_cast<int>(strtol (channel_buf, &channel_endptr, 10));
- if (*channel_endptr != 0) {
- std::ostringstream os;
- os << "Error: Channel " << channel_buf << " is not an integer";
- error_msg (os.str().c_str());
+ char channel_buf [MAX_INPUT_STR];
+ if (argc >= 2)
+ strncpy (channel_buf, argv[1], MAX_INPUT_STR);
+ else {
+ std::cout << "Enter channel number: ";
+ std::cin.getline (channel_buf, MAX_INPUT_STR);
+ }
+
+ char *channel_endptr;
+ int channel = static_cast<int>(strtol (channel_buf, &channel_endptr, 10));
+ if (*channel_endptr != 0) {
+ std::ostringstream os;
+ os << "Error: Channel " << channel_buf << " is not an integer";
+ error_msg (os.str().c_str());
usage (progname);
return (1);
- }
-
- char wav_fname[MAX_INPUT_STR];
+ }
+
+ char wav_fname[MAX_INPUT_STR];
+ if (! g_dry_run) {
if (argc >= 3)
strncpy (wav_fname, argv[2], MAX_INPUT_STR);
else {
std::cout << "Enter output wav filename: ";
std::cin.getline (wav_fname, MAX_INPUT_STR);
}
-
- if (! wdq2wav (wdq_fname, channel, wav_fname, play))
+ }
+ if (! wdq2wav (wdq_fname, channel, wav_fname, play))
return 1;
-
+
return 0;
}
}
return false;
}
+
+ if (wdq.any_packed_channels()) {
+ std::ostringstream os;
+ os << "File contains 'packed' channels." << std::endl;
+ os << "Convert to 'Advanced CODAS headers' before processing with wdq2wav.";
+ error_msg (os.str().c_str());
+ return false;
+ }
+
if (! g_quiet || g_verbose || g_debug) {
std::ostringstream os1;
- os1 << "File: " << wdq_fname;
+ os1 << "File: " << wdq_fname;
info_msg (os1.str().c_str());
- std::ostringstream os;
- os << "Legacy Format: ";
- if (wdq.m_bLegacy_format)
- os << "Yes";
- else
- os << "No";
- info_msg(os.str().c_str());
+ std::ostringstream os;
+ os << "Format: " << (wdq.m_bLegacy_format ? "Legacy" : "Non-legacy");
+ info_msg(os.str().c_str());
std::ostringstream os2;
time_t time = wdq.m_time_acq_start;
struct tm* tm = gmtime (&time);
- os2 << " Time File Creation: " << asctime(tm);
+ os2 << "Time File Creation: " << asctime(tm);
info_msg_sans_newline (os2.str().c_str());
std::ostringstream os3;
time = wdq.m_time_acq_stop;
tm = gmtime (&time);
- os3 << " Time File Written: " << asctime(tm);
+ os3 << "Time File Written: " << asctime(tm);
info_msg_sans_newline (os3.str().c_str());
std::ostringstream os4;
- os4 << " Samples: " << wdq.m_nSamples <<
+ os4 << "Samples: " << wdq.m_nSamples <<
", Channels: " << wdq.m_nChannels <<
", Sample Rate: " << wdq.m_sample_rate;
info_msg (os4.str().c_str());
}
-
+
WindaqChannel wdq_channel (wdq, channel);
if (! wdq_channel.m_valid) {
error_msg ("Error reading data from channel");
if (! g_quiet || g_verbose || g_debug) {
std::ostringstream os1;
- os1 << "Channel " << channel;
+ os1 << "Channel " << channel << ", Units: " << wdq_channel.m_units
+ << ", Minimum: " << wdq_channel.m_min_raw_data
+ << " (" << wdq_channel.raw2measured(wdq_channel.m_min_raw_data)
+ << "), Maximum: " << wdq_channel.m_max_raw_data
+ << " (" << wdq_channel.raw2measured(wdq_channel.m_max_raw_data) << ")";
info_msg (os1.str().c_str());
- std::ostringstream os2;
- os2 << " Units: " << wdq_channel.m_units.c_str();
- info_msg (os2.str().c_str());
- std::ostringstream os3;
- os3 << " Raw minimum: " << wdq_channel.m_min_raw_data <<
- ", maximum: " << wdq_channel.m_max_raw_data;
- info_msg (os3.str().c_str());
+
+ std::cout << "Mean: " << wdq_channel.raw2measured(wdq_channel.m_raw_mean) <<
+ " " << wdq_channel.m_units;
}
-
+
+ if (! g_dry_run && !g_dont_demean) {
+ std::cout << " (removing)\n";
+ int mean = nearest<int>(wdq_channel.m_raw_mean);
+ for (unsigned int i = 0; i < wdq.m_nSamples; i++)
+ wdq_channel.m_data[i] -= mean;
+ } else {
+ std::cout << " (not removing)\n";
+ }
+
if (g_debug) {
std::ostringstream os4;
os4 << " Scaled minimum: " << wdq_channel.m_min_scaled_data <<
info_msg (os4.str().c_str());
std::ostringstream os5;
os5 << " Slope " << wdq_channel.m_slope <<
- ", Intercept " << wdq_channel.m_intercept;
+ ", Intercept " << wdq_channel.m_intercept;
info_msg (os5.str().c_str());
}
+
+ if (g_dry_run)
+ return true;
WavFile wav (wdq_channel, wav_fname);
if (play)
wav.Play();
-
+
return true;
}
close (m_fd);
}
+bool read_int1 (int fd, unsigned char& n)
+{
+ unsigned char tmp1;
+ if (read (fd, &tmp1, 1) != 1)
+ return false;
+
+ n = tmp1;
+ return true;
+}
+
bool read_int2 (int fd, unsigned short int& n)
{
unsigned char tmp1;
tmp2 = tmp1;
if (read (fd, &tmp1, 1) != 1)
return false;
-
+
n = tmp2 + (tmp1 * 256);
return true;
}
tmp4 = tmp2;
if (! read_int2 (fd, tmp2))
return false;
-
+
n = tmp4 + (tmp2 * 65536);
return true;
}
bool read_float8 (int fd, double& f)
{
- unsigned char buf[8];
- if (read (fd, &buf, 8) != 8)
+ unsigned char p[8];
+ if (read (fd, p, 8) != 8)
return false;
#if WORDS_BIG_ENDIAN
unsigned char c;
- c = buf[0]; buf[0] = buf[7]; buf[7] = c;
- c = buf[1]; buf[1] = buf[6]; buf[6] = c;
- c = buf[2]; buf[2] = buf[5]; buf[5] = c;
- c = buf[3]; buf[3] = buf[4]; buf[4] = c;
+ c = p[0]; p[0] = p[7]; p[7] = c;
+ c = p[1]; p[1] = p[6]; p[6] = c;
+ c = p[2]; p[2] = p[5]; p[5] = c;
+ c = p[3]; p[3] = p[4]; p[4] = c;
#endif
- f = *(reinterpret_cast<double*>(buf));
+ double *pd = reinterpret_cast<double*>(&p[0]);
+ f = *pd;
return true;
}
bool
WindaqFile::ReadHeader ()
{
- unsigned short int tmp2;
-
m_valid = false;
if ((m_fd = open (m_strFile.c_str(), O_RDONLY | O_BINARY)) < 0) {
m_error = "Unable to open file";
}
lseek (0, 0, SEEK_SET);
- if (! read_int2 (m_fd, tmp2))
+ unsigned short int element1;
+ if (! read_int2 (m_fd, element1))
return false;
- m_sr_denom = (tmp2 & 0x7fff) >> 5;
- m_sr_numer = (tmp2 & 0x8000) << 1;
- short unsigned int byte1 = (tmp2 & 0xFF00) >> 8;
- short unsigned int byte2 = tmp2 & 0xFF;
+ short unsigned int byte1 = (element1 & 0xFF00) >> 8;
+ short unsigned int byte2 = element1 & 0xFF;
if (byte1 == 0 || byte1 == 1) {
- m_bLegacy_format = false;
+ m_bLegacy_format = false;
+ m_sr_denom = m_sr_numer = 0;
} else {
+ m_sr_denom = (element1 & 0x7fff) >> 5;
+ m_sr_numer = (element1 & 0x8000) << 1;
m_bLegacy_format = true;
}
- if (! read_int2 (m_fd, tmp2))
+ unsigned short int element2;
+ if (! read_int2 (m_fd, element2))
return false;
- m_sr_numer |= tmp2;
- if (! read_int2 (m_fd, tmp2))
+ if (m_bLegacy_format)
+ m_sr_numer |= element2;
+
+ unsigned char element3;
+ if (! read_int1 (m_fd, element3))
return false;
+ m_channel_offset = element3;
+ if (g_debug)
+ std::cout << "Channel offset: " << m_channel_offset << std::endl;
- m_channel_offset = tmp2 & 0xFF;
- m_nBytes_channel_header = tmp2 >> 8;
-
- if (! read_int2 (m_fd, m_nHeader_bytes))
+ unsigned char element4;
+ if (! read_int1 (m_fd, element4))
+ return false;
+ m_nBytes_channel_header = element4;
+ if (g_debug)
+ std::cout << "Channel header bytes: " << m_nBytes_channel_header << std::endl;
+
+ unsigned short int element5;
+ if (! read_int2 (m_fd, element5))
return false;
+ m_nHeader_bytes = element5;
+ if (g_debug)
+ std::cout << "Header bytes: " << m_nHeader_bytes << std::endl;
m_nMaxChannels = (m_nHeader_bytes - 112) / 36;
if (m_nMaxChannels >= 144)
- m_nChannels = byte2 & 0xFF;
+ m_nChannels = byte2 & 0xFF;
else
- m_nChannels = byte2 & 0x1F;
+ m_nChannels = byte2 & 0x1F;
- if (! read_int4 (m_fd, m_nData_bytes))
+ unsigned int element6;
+ if (! read_int4 (m_fd, element6))
return false;
+ m_nData_bytes = element6;
+ if (g_debug)
+ std::cout << "Data bytes: " << m_nData_bytes << std::endl;
m_nSamples = (m_nData_bytes / m_nChannels) / 2;
lseek (m_fd, 28, SEEK_SET);
- if (! read_float8 (m_fd, m_time_between_channel_samples))
- return false;
+ double element13;
+ if (! read_float8 (m_fd, element13))
+ return false;
+ m_time_between_channel_samples = element13;
if (m_bLegacy_format)
m_sample_rate = (double) m_sr_numer / (double) (m_sr_denom * m_nChannels);
- else
- m_sample_rate = (double) m_nChannels / m_time_between_channel_samples;
+ else
+ m_sample_rate = (double) 1 / m_time_between_channel_samples;
lseek (m_fd, 36, SEEK_SET);
if (! read_int4 (m_fd, m_time_acq_start))
if (! read_int4 (m_fd, m_time_acq_stop))
return false;
+ lseek (m_fd, 100, SEEK_SET);
+ unsigned short int element27;
+ if (! read_int2 (m_fd, element27))
+ return false;
+
+ m_bHires = (element27 & 0x0001) ? true : false;
+ if (g_debug) {
+ std::cout << "High resolution: ";
+ if (m_bHires)
+ std::cout << "Yes";
+ else
+ std::cout << "No";
+
+ std::cout << std::endl;
+ }
+
// Verify Windaq signature
lseek (m_fd, m_nHeader_bytes - 2, SEEK_SET);
- if (! read_int2 (m_fd, tmp2))
+ unsigned short int element35;
+ if (! read_int2 (m_fd, element35))
return false;
- if (tmp2 != 0x8001) {
+ if (element35 != 0x8001) {
std::ostringstream os;
- m_error = "File is not a valid WinDAQ file";
+ m_error = "Incorrect signagure: file is not a valid WinDAQ file";
return false;
}
m_valid = true;
return true;
}
-
+
+bool
+WindaqFile::any_packed_channels ()
+{
+ for (int iChannel = 0; iChannel < m_nChannels; iChannel++)
+ if (is_channel_packed (iChannel))
+ return true;
+
+ return false;
+}
+
+bool
+WindaqFile::is_channel_packed (const int channel)
+{
+ long iStart = m_channel_offset + channel * m_nBytes_channel_header;
+
+ lseek (m_fd, iStart + 31, SEEK_SET);
+ unsigned char iReadings_per_data_point;
+ if (! read_int1 (m_fd, iReadings_per_data_point))
+ return false;
+
+ if (iReadings_per_data_point > 1)
+ return true;
+
+ return false;
+}
+
WindaqChannel::WindaqChannel (WindaqFile& wdq, const int channel)
: r_wdq(wdq), m_data(0), m_slope(0), m_intercept (0), m_channel(channel),
m_valid(false)
if (wdq.m_valid) {
if (channel >= 1 && channel <= wdq.m_nChannels) {
if (read_channel_data())
- m_valid = true;
+ m_valid = true;
} else {
std::ostringstream os;
os << "Channel " << channel << " is invalid, valid range 1-" <<
- wdq.m_nChannels;
+ wdq.m_nChannels;
error_msg (os.str().c_str());
}
}
m_data = new signed short int [r_wdq.m_nSamples * 2];
- lseek (fd, r_wdq.m_channel_offset + 8 +
- (m_channel - 1) * r_wdq.m_nBytes_channel_header,
- SEEK_SET);
+ lseek (fd, r_wdq.m_channel_offset + 8 +
+ (m_channel - 1) * r_wdq.m_nBytes_channel_header,
+ SEEK_SET);
if (! read_float8 (fd, m_slope))
return false;
return false;
}
m_units = units;
-
+
long int row_bytes = 2 * r_wdq.m_nChannels;
signed short int *sample_row = new signed short int [row_bytes];
-
+
signed short int* psample = &sample_row[m_channel - 1];
lseek (fd, r_wdq.m_nHeader_bytes, SEEK_SET);
#if WORDS_BIG_ENDIAN
unsigned char* p = reinterpret_cast<unsigned char*>(&v);
- unsigned char c = p[0]; p[0] = p[1]; p[1] = c;
+ unsigned char c = p[0]; p[0] = p[1]; p[1] = c;
#endif
- signed short int value = v >> 2;
+ signed short int value = v;
+ if (! r_wdq.m_bHires)
+ value >>= 2;
+
m_data[i] = value;
total_data += value;
-
+
if (i == 0) {
data_max = value;
data_min = value;
} else {
if (value > data_max)
- data_max = value;
+ data_max = value;
else if (value < data_min)
- data_min = value;
+ data_min = value;
}
}
m_max_scaled_data = (m_slope * data_max) + m_intercept;
m_min_scaled_data = (m_slope * data_min) + m_intercept;
- if (! g_dont_demean) {
- double dmean = total_data / static_cast<double>(r_wdq.m_nSamples);
- int mean = nearest<int>(dmean);
- std::cout << "Removing mean: " << (dmean * m_slope) + m_intercept <<
- " " << m_units << std::endl;
-
- for (i = 0; i < r_wdq.m_nSamples; i++)
- m_data[i] -= mean;
- }
-
+ m_raw_mean = total_data / static_cast<double>(r_wdq.m_nSamples);
+
delete sample_row;
return true;
}
if (g_ignore_zero) {
data_offset = -wdq_channel.m_min_scaled_data;
if (wdq_channel.m_max_scaled_data != wdq_channel.m_min_scaled_data)
- data_scale = 65535. / (wdq_channel.m_max_scaled_data -
- wdq_channel.m_min_scaled_data);
+ data_scale = 65535. / (wdq_channel.m_max_scaled_data -
+ wdq_channel.m_min_scaled_data);
} else {
double max_value = fabs(wdq_channel.m_max_scaled_data);
if (fabs (wdq_channel.m_min_scaled_data) > max_value)
- max_value = fabs (wdq_channel.m_min_scaled_data);
+ max_value = fabs (wdq_channel.m_min_scaled_data);
if (max_value != 0.)
- data_scale = 32767. / max_value;
+ data_scale = 32767. / max_value;
}
-
+
if (g_debug) {
std::ostringstream os;
os << " Wav data_scale: " << data_scale << ", data_offset: " << data_offset;
info_msg (os.str().c_str());
}
-
+
m_nHeaderBytes = 44;
m_nDataBytes = m_nSamples * m_nBytesPerSample * m_nChannels;
m_nFileBytes = m_nHeaderBytes + m_nDataBytes;
signed short int* output = &m_data[nHeaderShortInts];
double slope = wdq_channel.m_slope;
double intercept = wdq_channel.m_intercept;
-
+
if (! fill_header ())
return;
unsigned long int i;
+
for (i = 0; i < m_nSamples; i++) {
double value = input[i];
value = (slope * value) + intercept;
if (g_ignore_zero) {
- value = (value + data_offset) * data_scale;
- value += 0.5 - 32768;
+ value = (value + data_offset) * data_scale;
+ value += 0.5 - 32768;
} else {
- value = value * data_scale;
+ value = value * data_scale;
}
-
+
signed short int v = static_cast<signed short int>(value);
#if WORDS_BIG_ENDIAN
unsigned char* p = reinterpret_cast<unsigned char*>(&v);
- unsigned char c = p[0]; p[0] = p[1]; p[1] = c;
+ unsigned char c = p[0]; p[0] = p[1]; p[1] = c;
#endif
output[i] = v;
}
{
if (m_fd != 0)
close (m_fd);
-
+
if (m_data != NULL)
delete m_data;
}
// Sample Rate
put_int4 (pData + 24, static_cast<int> (m_rate + 0.5));
- // Bytes per second
+ // Bytes per second
put_int4 (pData + 28, static_cast<int> (m_rate * m_nBytesPerSample + 0.5));
// Bytes per sample
put_int2 (pData + 32, m_nBytesPerSample * m_nChannels);
- // Bits per sample
+ // Bits per sample
put_int2 (pData + 34, m_nBitsPerSample);
strncpy (pData + 36, "data", 4);
if (close (m_fd) < 0)
error_msg ("Error closing output file");
-
+
m_fd = 0;
return true;
}
-#ifdef WIN32
+#ifdef _WIN32
#include <windows.h>
#include <mmsystem.h>
-#elif defined(LINUX)
+#elif defined(__linux__)
#include <sys/ioctl.h>
#include <sys/soundcard.h>
#endif
bool
WavFile::Play ()
{
-#ifdef WIN32
+#ifdef _WIN32
if (PlaySound ((LPCSTR) m_data, 0, SND_MEMORY | SND_NODEFAULT))
return true;
-#elif defined(LINUX)
+#elif defined(__linux__)
int fd;
if ((fd = open ("/dev/dsp",O_WRONLY)) == -1) {
error_msg ("Error opening /dev/dsp");
return false;
}
-
+
int format = AFMT_S16_LE;
if (ioctl (fd, SNDCTL_DSP_SETFMT, &format) == -1) {
error_msg ("Error setting DSP format");
error_msg ("DSP Format not set");
close(fd); return false;
}
-
+
unsigned int channels = m_nChannels;
if (ioctl (fd, SNDCTL_DSP_CHANNELS, &format) == -1) {
error_msg ("Error setting number of channels");
os << "Warning: Sample rate set to " << speed << ", not " << m_rate;
error_msg (os.str().c_str());
}
-
+
if (write (fd, reinterpret_cast<char*>(m_data) + m_nHeaderBytes, m_nDataBytes) !=
m_nDataBytes) {
error_msg ("Error writing audio samples");
return true;
#else
#endif
-
+
return false;
}
-
+
projects / wdq2wav.git / blobdiff