1 /*****************************************************************************
5 ** Purpose: Converts a channel of WinDAQ file to .WAV format
6 ** Programmer: Kevin Rosenberg <kevin@rosenberg.net>
7 ** Date Started: Jan 2003
9 ** Copyright (c) 2003 Kevin Rosenberg
11 ** $Id: wdq2wav.cpp,v 1.26 2003/02/28 04:12:17 kevin Exp $
13 ** This program is free software; you can redistribute it and/or modify
14 ** it under the terms of the GNU General Public License (version 2) as
15 ** published by the Free Software Foundation.
17 ** This program is distributed in the hope that it will be useful,
18 ** but WITHOUT ANY WARRANTY; without even the implied warranty of
19 ** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
20 ** GNU General Public License for more details.
22 ** You should have received a copy of the GNU General Public License
23 ** along with this program; if not, write to the Free Software
24 ** Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
25 ******************************************************************************/
29 const char* g_szIdStr = "$Id: wdq2wav.cpp,v 1.26 2003/02/28 04:12:17 kevin Exp $";
32 bool g_verbose = false;
34 bool g_preserve_zero = false;
35 bool g_demean = false;
44 #define O_BINARY _O_BINARY
45 #define O_RDONLY _O_RDONLY
46 #define O_WRONLY _O_WRONLY
47 #define O_RDWR _O_RDRW
48 #define O_TRUNC _O_TRUNC
49 #define O_CREAT _O_CREAT
50 const int g_fileMode = _S_IWRITE | _S_IREAD;
51 struct fpos_t std::_Fpz = {0,0};
53 const int g_fileMode = S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH;
54 // Define as NULL for non-Windows platforms
62 error_msg (const char *msg)
64 std::cerr << msg << "\n";
68 info_msg (const char* msg)
70 std::cout << msg << "\n";
74 info_msg_sans_newline (const char* msg)
80 fileBasename (const char* filename)
82 const char* p = strrchr (filename, '/');
83 return (p ? p + 1 : filename);
87 str_rm_tail (char *str, const char* const charlist)
91 for (i = strlen(str) - 1; i >= 0; i--)
92 if (strchr (charlist, str[i]) != NULL)
95 break; /* found non-specified char, all done */
101 str_wrm_tail (char *str)
103 return (str_rm_tail(str, "\b\t\n\r"));
108 usage (const char* progname)
110 std::cout << "usage: " << fileBasename (progname) << " [OPTIONS] <wdq-file> <channel-number> <wav-file>\n";
111 std::cout << "OPTIONS\n";
112 std::cout << " -p Play channel through audio system\n";
113 std::cout << " -q Supress all messages\n";
114 std::cout << " -z Scale output with preserving zero point\n";
115 std::cout << " -m Demean the data (subtract the mean value from each sample)\n";
116 std::cout << " [Selecting this option automatically sets the -z option]\n";
117 std::cout << " -v Verbose mode\n";
118 std::cout << " -d Debug mode\n";
119 std::cout << " -r Print program version\n";
120 std::cout << " -h Print this help message\n";
125 main (int argc, char *argv[])
130 const char* progname = argv[0];
132 while ((c = getopt (argc, argv, "rqvzmdph")) != -1) {
135 std::cout << "Version " << g_szIdStr << std::endl;
142 g_preserve_zero = true; // auto set
145 g_preserve_zero = true;
168 std::cerr << "Too many parameters\n";
173 char wdq_fname[MAX_INPUT_STR];
175 strncpy (wdq_fname, argv [0], MAX_INPUT_STR);
177 std::cout << "Enter input WinDAQ filename: ";
178 std::cin.getline (wdq_fname, MAX_INPUT_STR);
181 char channel_buf [MAX_INPUT_STR];
183 strncpy (channel_buf, argv[1], MAX_INPUT_STR);
185 std::cout << "Enter channel number: ";
186 std::cin.getline (channel_buf, MAX_INPUT_STR);
189 char *channel_endptr;
190 int channel = static_cast<int>(strtol (channel_buf, &channel_endptr, 10));
191 if (*channel_endptr != 0) {
192 std::ostringstream os;
193 os << "Error: Channel " << channel_buf << " is not an integer";
194 error_msg (os.str().c_str());
199 char wav_fname[MAX_INPUT_STR];
201 strncpy (wav_fname, argv[2], MAX_INPUT_STR);
203 std::cout << "Enter output wav filename: ";
204 std::cin.getline (wav_fname, MAX_INPUT_STR);
207 if (! wdq2wav (wdq_fname, channel, wav_fname, play))
214 wdq2wav (const char* wdq_fname, const int channel, const char *wav_fname, bool play)
216 WindaqFile wdq (wdq_fname);
218 if (! wdq.ReadHeader()) {
219 if (wdq.m_error.size()) {
220 std::ostringstream os;
221 os << "Error reading file " << wdq_fname << ": " << wdq.m_error.c_str();
222 error_msg (os.str().c_str());
224 std::ostringstream os;
225 os << "Error reading file " << wdq_fname;
226 error_msg (os.str().c_str());
230 if (! g_quiet || g_verbose || g_debug) {
231 std::ostringstream os1;
232 os1 << "File " << wdq_fname;
233 info_msg (os1.str().c_str());
234 std::ostringstream os2;
235 time_t time = wdq.m_time_acq_start;
236 struct tm* tm = gmtime (&time);
237 os2 << " Time File Creation: " << asctime(tm);
238 info_msg_sans_newline (os2.str().c_str());
239 std::ostringstream os3;
240 time = wdq.m_time_acq_stop;
242 os3 << " Time File Written: " << asctime(tm);
243 info_msg_sans_newline (os3.str().c_str());
244 std::ostringstream os4;
245 os4 << " Samples: " << wdq.m_nSamples <<
246 ", Channels: " << wdq.m_nChannels <<
247 ", Sample Rate: " << wdq.m_sample_rate;
248 info_msg (os4.str().c_str());
251 WindaqChannel wdq_channel (wdq, channel);
252 if (! wdq_channel.m_valid) {
253 error_msg ("Error reading data from channel");
257 if (! g_quiet || g_verbose || g_debug) {
258 std::ostringstream os1;
259 os1 << "Channel " << channel;
260 info_msg (os1.str().c_str());
261 std::ostringstream os2;
262 os2 << " Units: " << wdq_channel.m_units.c_str();
263 info_msg (os2.str().c_str());
264 std::ostringstream os3;
265 os3 << " Raw minimum: " << wdq_channel.m_min_raw_data <<
266 ", maximum: " << wdq_channel.m_max_raw_data;
267 info_msg (os3.str().c_str());
271 std::ostringstream os4;
272 os4 << " Scaled minimum: " << wdq_channel.m_min_scaled_data <<
273 ", maximum: " << wdq_channel.m_max_scaled_data;
274 info_msg (os4.str().c_str());
275 std::ostringstream os5;
276 os5 << " Slope " << wdq_channel.m_slope <<
277 ", Intercept " << wdq_channel.m_intercept;
278 info_msg (os5.str().c_str());
281 WavFile wav (wdq_channel, wav_fname);
284 error_msg ("Error extracting wav from channel");
288 if (! wav.WriteFile ()) {
289 error_msg ("Error writing file");
300 WindaqFile::WindaqFile (const char* fname)
301 : m_valid(false), m_fd(0), m_nChannels(0), m_nSamples(0), m_sample_rate(0),
306 WindaqFile::~WindaqFile ()
312 bool read_int2 (int fd, unsigned short int& n)
316 if (read (fd, &tmp1, 1) != 1)
319 if (read (fd, &tmp1, 1) != 1)
322 n = tmp2 + (tmp1 * 256);
326 bool read_int4 (int fd, unsigned int& n)
329 unsigned short int tmp2;
330 if (! read_int2 (fd, tmp2))
333 if (! read_int2 (fd, tmp2))
336 n = tmp4 + (tmp2 * 65536);
341 WindaqFile::ReadHeader ()
343 unsigned short int tmp2;
346 if ((m_fd = open (m_strFile.c_str(), O_RDONLY | O_BINARY)) < 0) {
347 m_error = "Unable to open file";
351 lseek (0, 0, SEEK_SET);
352 if (! read_int2 (m_fd, tmp2))
355 m_nChannels = tmp2 & 0x1f;
356 m_sr_denom = (tmp2 & 0x7fff) >> 5;
357 m_sr_numer = (tmp2 & 0x8000) << 1;
359 if (! read_int2 (m_fd, tmp2))
363 m_sample_rate = (double) m_sr_numer / (double) (m_sr_denom * m_nChannels);
365 if (! read_int2 (m_fd, tmp2))
368 m_channel_offset = tmp2 & 0xFF;
369 m_nBytes_channel_header = tmp2 >> 8;
371 if (! read_int2 (m_fd, m_nHeader_bytes))
374 if (! read_int4 (m_fd, m_nData_bytes))
377 m_nSamples = (m_nData_bytes / m_nChannels) / 2;
379 lseek (m_fd, 36, SEEK_SET);
380 if (! read_int4 (m_fd, m_time_acq_start))
383 if (! read_int4 (m_fd, m_time_acq_stop))
386 // Verify Windaq signature
387 lseek (m_fd, m_nHeader_bytes - 2, SEEK_SET);
388 if (! read_int2 (m_fd, tmp2))
391 if (tmp2 != 0x8001) {
392 std::ostringstream os;
393 m_error = "File is not a valid WinDAQ file";
402 WindaqChannel::WindaqChannel (WindaqFile& wdq, const int channel)
403 : r_wdq(wdq), m_data(0), m_slope(0), m_intercept (0), m_channel(channel),
407 if (channel >= 1 && channel <= wdq.m_nChannels) {
408 if (read_channel_data())
411 std::ostringstream os;
412 os << "Channel " << channel << " is invalid, valid range 1-" <<
414 error_msg (os.str().c_str());
419 WindaqChannel::~WindaqChannel ()
425 bool get_float8 (int fd, double& f)
427 unsigned char buf[8];
428 if (read (fd, &buf, 8) != 8)
433 c = buf[0]; buf[0] = buf[7]; buf[7] = c;
434 c = buf[1]; buf[1] = buf[6]; buf[6] = c;
435 c = buf[2]; buf[2] = buf[5]; buf[5] = c;
436 c = buf[3]; buf[3] = buf[4]; buf[4] = c;
439 f = *(reinterpret_cast<double*>(buf));
446 WindaqChannel::read_channel_data ()
450 m_data = new signed short int [r_wdq.m_nSamples * 2];
452 lseek (fd, r_wdq.m_channel_offset + 8 +
453 (m_channel - 1) * r_wdq.m_nBytes_channel_header,
455 if (! get_float8 (fd, m_slope))
458 if (! get_float8 (fd, m_intercept))
463 if (read (fd, units, 6) != 6) {
464 error_msg ("Error reading file");
469 long int row_bytes = 2 * r_wdq.m_nChannels;
470 signed short int *sample_row = new signed short int [row_bytes];
472 signed short int* psample = &sample_row[m_channel - 1];
474 lseek (fd, r_wdq.m_nHeader_bytes, SEEK_SET);
476 signed short int data_max = 0, data_min = 0;
477 double total_data = 0;
478 for (i = 0; i < r_wdq.m_nSamples; i++) {
479 if (read (fd, sample_row, row_bytes) != row_bytes) {
480 std::ostringstream os;
481 os << "Error reading file at " << i;
482 error_msg (os.str().c_str());
486 signed short int v = *psample;
489 unsigned char* p = reinterpret_cast<unsigned char*>(&v);
490 unsigned char c = p[0]; p[0] = p[1]; p[1] = c;
493 signed short int value = v >> 2;
501 if (value > data_max)
503 else if (value < data_min)
508 m_max_raw_data = data_max;
509 m_min_raw_data = data_min;
510 m_max_scaled_data = (m_slope * data_max) + m_intercept;
511 m_min_scaled_data = (m_slope * data_min) + m_intercept;
514 double dmean = total_data / static_cast<double>(r_wdq.m_nSamples);
515 int mean = nearest<int>(dmean);
516 std::cout << "Removing mean: " << (dmean * m_slope) + m_intercept <<
517 " " << m_units << std::endl;
519 for (i = 0; i < r_wdq.m_nSamples; i++)
528 WavFile::WavFile (WindaqChannel& wdq_channel, const char* fname)
529 : m_valid(false), m_data(0), m_nSamples(0), m_strFile(fname), m_fd(0)
531 if (wdq_channel.m_valid) {
532 m_nSamples = wdq_channel.r_wdq.m_nSamples;
534 m_nBitsPerSample = 16;
535 m_nBytesPerSample = 2;
536 m_rate = wdq_channel.r_wdq.m_sample_rate;
538 double data_offset = 0, data_scale = 0;
539 if (g_preserve_zero) {
540 double max_value = fabs(wdq_channel.m_max_scaled_data);
541 if (fabs (wdq_channel.m_min_scaled_data) > max_value)
542 max_value = fabs (wdq_channel.m_min_scaled_data);
544 data_scale = 32767. / max_value;
546 data_offset = -wdq_channel.m_min_scaled_data;
547 if (wdq_channel.m_max_scaled_data != wdq_channel.m_min_scaled_data)
548 data_scale = 65535. / (wdq_channel.m_max_scaled_data -
549 wdq_channel.m_min_scaled_data);
553 std::ostringstream os;
554 os << " Wav data_scale: " << data_scale << ", data_offset: " << data_offset;
555 info_msg (os.str().c_str());
559 m_nDataBytes = m_nSamples * m_nBytesPerSample * m_nChannels;
560 m_nFileBytes = m_nHeaderBytes + m_nDataBytes;
562 unsigned int nHeaderShortInts = m_nHeaderBytes / sizeof(signed short int);
564 m_data = new signed short int [m_nSamples + nHeaderShortInts];
565 signed short int* input = wdq_channel.m_data;
566 signed short int* output = &m_data[nHeaderShortInts];
567 double slope = wdq_channel.m_slope;
568 double intercept = wdq_channel.m_intercept;
570 if (! fill_header ())
574 for (i = 0; i < m_nSamples; i++) {
575 double value = input[i];
576 value = (slope * value) + intercept;
577 if (g_preserve_zero) {
578 value = value * data_scale;
580 value = (value + data_offset) * data_scale;
581 value += 0.5 - 32768;
584 signed short int v = static_cast<signed short int>(value);
586 unsigned char* p = reinterpret_cast<unsigned char*>(&v);
587 unsigned char c = p[0]; p[0] = p[1]; p[1] = c;
607 put_int4 (char* p, unsigned int n)
610 *(p+1) = 0xFF & (n >> 8);
611 *(p+2) = 0xFF & (n >> 16);
612 *(p+3) = 0xFF & (n >> 24);
616 put_int2 (char* p, unsigned short int n)
619 *(p+1) = 0xFF & (n >> 8);
623 WavFile::fill_header ()
625 char* pData = reinterpret_cast<char*> (m_data);
627 strncpy (pData, "RIFF", 4);
629 // Length of file after 8 byte header
630 put_int4 (pData + 4, 36 + m_nDataBytes);
632 strncpy (pData + 8, "WAVEfmt ", 8);
634 // Length of header block
635 put_int4 (pData + 16, 0x10);
638 put_int2 (pData + 20, 1);
640 /* Number of channels */
641 put_int2 (pData + 22, m_nChannels);
644 put_int4 (pData + 24, static_cast<int> (m_rate + 0.5));
647 put_int4 (pData + 28, static_cast<int> (m_rate * m_nBytesPerSample + 0.5));
650 put_int2 (pData + 32, m_nBytesPerSample * m_nChannels);
653 put_int2 (pData + 34, m_nBitsPerSample);
655 strncpy (pData + 36, "data", 4);
657 put_int4 (pData + 40, m_nDataBytes);
663 WavFile::WriteFile ()
669 if ((m_fd = open (m_strFile.c_str(), O_WRONLY | O_BINARY | O_TRUNC | O_CREAT, g_fileMode)) == 0) {
670 std::ostringstream os;
671 os << "Error opening output file " << m_strFile.c_str();
672 error_msg (os.str().c_str());
676 lseek (m_fd, 0, SEEK_SET);
677 if (write (m_fd, m_data, m_nFileBytes) != m_nFileBytes) {
678 error_msg ("Error writing file");
682 if (close (m_fd) < 0)
683 error_msg ("Error closing output file");
691 #include <mmsystem.h>
693 #include <sys/ioctl.h>
694 #include <sys/soundcard.h>
701 if (PlaySound ((LPCSTR) m_data, 0, SND_MEMORY | SND_NODEFAULT))
705 if ((fd = open ("/dev/dsp",O_WRONLY)) == -1) {
706 error_msg ("Error opening /dev/dsp");
710 int format = AFMT_S16_LE;
711 if (ioctl (fd, SNDCTL_DSP_SETFMT, &format) == -1) {
712 error_msg ("Error setting DSP format");
713 close(fd); return false;
715 if (format != AFMT_S16_LE) {
716 error_msg ("DSP Format not set");
717 close(fd); return false;
720 unsigned int channels = m_nChannels;
721 if (ioctl (fd, SNDCTL_DSP_CHANNELS, &format) == -1) {
722 error_msg ("Error setting number of channels");
723 close(fd); return false;
725 if (channels != m_nChannels) {
726 error_msg ("Number of channels not set");
727 close(fd); return false;
730 unsigned int speed = static_cast<int>(m_rate + 0.5);
731 if (ioctl (fd, SNDCTL_DSP_SPEED, &speed) == -1) {
732 error_msg ("Error setting sample rate");
733 close(fd); return false;
735 if (speed != m_rate && ! g_quiet) {
736 std::ostringstream os;
737 os << "Warning: Sample rate set to " << speed << ", not " << m_rate;
738 error_msg (os.str().c_str());
741 if (write (fd, reinterpret_cast<char*>(m_data) + m_nHeaderBytes, m_nDataBytes) !=
743 error_msg ("Error writing audio samples");
744 close(fd); return false;