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 ** This program is free software; you can redistribute it and/or modify
12 ** it under the terms of the GNU General Public License (version 2) as
13 ** published by the Free Software Foundation.
15 ** This program is distributed in the hope that it will be useful,
16 ** but WITHOUT ANY WARRANTY; without even the implied warranty of
17 ** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 ** GNU General Public License for more details.
20 ** You should have received a copy of the GNU General Public License
21 ** along with this program; if not, write to the Free Software
22 ** Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
23 ******************************************************************************/
28 const char* g_szIdStr = "$Id$";
31 bool g_verbose = false;
33 bool g_ignore_zero = false;
34 bool g_dont_demean = false;
43 #define O_BINARY _O_BINARY
44 #define O_RDONLY _O_RDONLY
45 #define O_WRONLY _O_WRONLY
46 #define O_RDWR _O_RDRW
47 #define O_TRUNC _O_TRUNC
48 #define O_CREAT _O_CREAT
49 const int g_fileMode = _S_IWRITE | _S_IREAD;
50 struct fpos_t std::_Fpz = {0,0};
52 const int g_fileMode = S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH;
53 // Define as NULL for non-Windows platforms
61 error_msg (const char *msg)
63 std::cerr << msg << std::endl;
67 info_msg (const char* msg)
69 std::cout << msg << std::endl;
73 info_msg_sans_newline (const char* msg)
79 fileBasename (const char* filename)
81 const char* pslash = strrchr (filename, '/');
82 const char* pbackslash = strrchr (filename, '\\');
83 const char* p = filename;
84 if (pbackslash && (! pslash || pbackslash >= pslash))
86 else if (pslash && (! pbackslash || pslash >= pbackslash))
93 str_rm_tail (char *str, const char* const charlist)
97 for (i = strlen(str) - 1; i >= 0; i--)
98 if (strchr (charlist, str[i]) != NULL)
101 break; /* found non-specified char, all done */
107 str_wrm_tail (char *str)
109 return (str_rm_tail(str, "\b\t\n\r"));
114 usage (const char* progname)
116 std::cout << "usage: " << fileBasename (progname) << " [OPTIONS] <wdq-file> <channel-number> <wav-file>\n";
117 std::cout << "OPTIONS\n";
118 std::cout << " -p Play channel through audio system\n";
119 std::cout << " -q Supress all messages\n";
120 std::cout << " -z Scale output without preserving zero point\n";
121 std::cout << " -m Do not demean the data (don't subtract the mean value from each sample)\n";
122 std::cout << " -v Verbose mode\n";
123 std::cout << " -d Debug mode\n";
124 std::cout << " -r Print program version and exit\n";
125 std::cout << " -h Print this help message\n";
130 main (int argc, char *argv[])
135 const char* progname = argv[0];
137 while ((c = getopt (argc, argv, "rqvzmdph")) != -1) {
140 std::cout << "Version " << g_szIdStr << std::endl;
147 g_dont_demean = true;
150 g_ignore_zero = true;
171 if (g_verbose || g_debug)
172 std::cout << "Version " << g_szIdStr << std::endl;
177 std::cerr << "Too many parameters\n";
182 char wdq_fname[MAX_INPUT_STR];
184 strncpy (wdq_fname, argv [0], MAX_INPUT_STR);
186 std::cout << "Enter input WinDAQ filename: ";
187 std::cin.getline (wdq_fname, MAX_INPUT_STR);
190 char channel_buf [MAX_INPUT_STR];
192 strncpy (channel_buf, argv[1], MAX_INPUT_STR);
194 std::cout << "Enter channel number: ";
195 std::cin.getline (channel_buf, MAX_INPUT_STR);
198 char *channel_endptr;
199 int channel = static_cast<int>(strtol (channel_buf, &channel_endptr, 10));
200 if (*channel_endptr != 0) {
201 std::ostringstream os;
202 os << "Error: Channel " << channel_buf << " is not an integer";
203 error_msg (os.str().c_str());
208 char wav_fname[MAX_INPUT_STR];
210 strncpy (wav_fname, argv[2], MAX_INPUT_STR);
212 std::cout << "Enter output wav filename: ";
213 std::cin.getline (wav_fname, MAX_INPUT_STR);
216 if (! wdq2wav (wdq_fname, channel, wav_fname, play))
223 wdq2wav (const char* wdq_fname, const int channel, const char *wav_fname, bool play)
225 WindaqFile wdq (wdq_fname);
227 if (! wdq.ReadHeader()) {
228 if (wdq.m_error.size()) {
229 std::ostringstream os;
230 os << "Error reading file " << wdq_fname << ": " << wdq.m_error.c_str();
231 error_msg (os.str().c_str());
233 std::ostringstream os;
234 os << "Error reading file " << wdq_fname;
235 error_msg (os.str().c_str());
240 if (wdq.any_packed_channels()) {
241 std::ostringstream os;
242 os << "File contains 'packed' channels." << std::endl;
243 os << "Convert to 'Advanced CODAS headers' before processing with wdq2wav.";
244 error_msg (os.str().c_str());
248 if (! g_quiet || g_verbose || g_debug) {
249 std::ostringstream os1;
250 os1 << "File: " << wdq_fname;
251 info_msg (os1.str().c_str());
252 std::ostringstream os;
253 os << "Legacy Format: ";
254 if (wdq.m_bLegacy_format)
258 info_msg(os.str().c_str());
259 std::ostringstream os2;
260 time_t time = wdq.m_time_acq_start;
261 struct tm* tm = gmtime (&time);
262 os2 << " Time File Creation: " << asctime(tm);
263 info_msg_sans_newline (os2.str().c_str());
264 std::ostringstream os3;
265 time = wdq.m_time_acq_stop;
267 os3 << " Time File Written: " << asctime(tm);
268 info_msg_sans_newline (os3.str().c_str());
269 std::ostringstream os4;
270 os4 << " Samples: " << wdq.m_nSamples <<
271 ", Channels: " << wdq.m_nChannels <<
272 ", Sample Rate: " << wdq.m_sample_rate;
273 info_msg (os4.str().c_str());
276 WindaqChannel wdq_channel (wdq, channel);
277 if (! wdq_channel.m_valid) {
278 error_msg ("Error reading data from channel");
282 if (! g_quiet || g_verbose || g_debug) {
283 std::ostringstream os1;
284 os1 << "Channel " << channel;
285 info_msg (os1.str().c_str());
286 std::ostringstream os2;
287 os2 << " Units: " << wdq_channel.m_units.c_str();
288 info_msg (os2.str().c_str());
289 std::ostringstream os3;
290 os3 << " Raw minimum: " << wdq_channel.m_min_raw_data <<
291 ", maximum: " << wdq_channel.m_max_raw_data;
292 info_msg (os3.str().c_str());
296 std::ostringstream os4;
297 os4 << " Scaled minimum: " << wdq_channel.m_min_scaled_data <<
298 ", maximum: " << wdq_channel.m_max_scaled_data;
299 info_msg (os4.str().c_str());
300 std::ostringstream os5;
301 os5 << " Slope " << wdq_channel.m_slope <<
302 ", Intercept " << wdq_channel.m_intercept;
303 info_msg (os5.str().c_str());
306 WavFile wav (wdq_channel, wav_fname);
309 error_msg ("Error extracting wav from channel");
313 if (! wav.WriteFile ()) {
314 error_msg ("Error writing file");
325 WindaqFile::WindaqFile (const char* fname)
326 : m_valid(false), m_fd(0), m_nChannels(0), m_nSamples(0), m_sample_rate(0),
331 WindaqFile::~WindaqFile ()
337 bool read_int1 (int fd, unsigned char& n)
340 if (read (fd, &tmp1, 1) != 1)
347 bool read_int2 (int fd, unsigned short int& n)
351 if (read (fd, &tmp1, 1) != 1)
354 if (read (fd, &tmp1, 1) != 1)
357 n = tmp2 + (tmp1 * 256);
361 bool read_int4 (int fd, unsigned int& n)
364 unsigned short int tmp2;
365 if (! read_int2 (fd, tmp2))
368 if (! read_int2 (fd, tmp2))
371 n = tmp4 + (tmp2 * 65536);
375 bool read_float8 (int fd, double& f)
377 unsigned char buf[8];
378 if (read (fd, &buf, 8) != 8)
383 c = buf[0]; buf[0] = buf[7]; buf[7] = c;
384 c = buf[1]; buf[1] = buf[6]; buf[6] = c;
385 c = buf[2]; buf[2] = buf[5]; buf[5] = c;
386 c = buf[3]; buf[3] = buf[4]; buf[4] = c;
389 f = *(reinterpret_cast<double*>(buf));
395 WindaqFile::ReadHeader ()
398 if ((m_fd = open (m_strFile.c_str(), O_RDONLY | O_BINARY)) < 0) {
399 m_error = "Unable to open file";
403 lseek (0, 0, SEEK_SET);
404 unsigned short int element1;
405 if (! read_int2 (m_fd, element1))
408 short unsigned int byte1 = (element1 & 0xFF00) >> 8;
409 short unsigned int byte2 = element1 & 0xFF;
410 if (byte1 == 0 || byte1 == 1) {
411 m_bLegacy_format = false;
412 m_sr_denom = m_sr_numer = 0;
414 m_sr_denom = (element1 & 0x7fff) >> 5;
415 m_sr_numer = (element1 & 0x8000) << 1;
416 m_bLegacy_format = true;
418 unsigned short int element2;
419 if (! read_int2 (m_fd, element2))
422 if (m_bLegacy_format)
423 m_sr_numer |= element2;
425 unsigned char element3;
426 if (! read_int1 (m_fd, element3))
428 m_channel_offset = element3;
430 std::cout << "Channel offset: " << m_channel_offset << std::endl;
432 unsigned char element4;
433 if (! read_int1 (m_fd, element4))
435 m_nBytes_channel_header = element4;
437 std::cout << "Channel header bytes: " << m_nBytes_channel_header << std::endl;
439 unsigned short int element5;
440 if (! read_int2 (m_fd, element5))
442 m_nHeader_bytes = element5;
444 std::cout << "Header bytes: " << m_nHeader_bytes << std::endl;
446 m_nMaxChannels = (m_nHeader_bytes - 112) / 36;
447 if (m_nMaxChannels >= 144)
448 m_nChannels = byte2 & 0xFF;
450 m_nChannels = byte2 & 0x1F;
452 unsigned int element6;
453 if (! read_int4 (m_fd, element6))
455 m_nData_bytes = element6;
457 std::cout << "Data bytes: " << m_nData_bytes << std::endl;
459 m_nSamples = (m_nData_bytes / m_nChannels) / 2;
461 lseek (m_fd, 28, SEEK_SET);
463 if (! read_float8 (m_fd, element13))
465 m_time_between_channel_samples = element13;
467 if (m_bLegacy_format)
468 m_sample_rate = (double) m_sr_numer / (double) (m_sr_denom * m_nChannels);
470 m_sample_rate = (double) m_nChannels / m_time_between_channel_samples;
472 lseek (m_fd, 36, SEEK_SET);
473 if (! read_int4 (m_fd, m_time_acq_start))
476 if (! read_int4 (m_fd, m_time_acq_stop))
479 lseek (m_fd, 100, SEEK_SET);
480 unsigned short int element27;
481 if (! read_int2 (m_fd, element27))
484 m_bHires = (element27 & 0x0001) ? true : false;
486 std::cout << "High resolution: ";
492 std::cout << std::endl;
495 // Verify Windaq signature
496 lseek (m_fd, m_nHeader_bytes - 2, SEEK_SET);
497 unsigned short int element35;
498 if (! read_int2 (m_fd, element35))
501 if (element35 != 0x8001) {
502 std::ostringstream os;
503 m_error = "Incorrect signagure: file is not a valid WinDAQ file";
512 WindaqFile::any_packed_channels ()
514 for (int iChannel = 0; iChannel < m_nChannels; iChannel++)
515 if (is_channel_packed (iChannel))
522 WindaqFile::is_channel_packed (const int channel)
524 long iStart = m_channel_offset + channel * m_nBytes_channel_header;
526 lseek (m_fd, iStart + 31, SEEK_SET);
527 unsigned char iReadings_per_data_point;
528 if (! read_int1 (m_fd, iReadings_per_data_point))
531 if (iReadings_per_data_point > 1)
537 WindaqChannel::WindaqChannel (WindaqFile& wdq, const int channel)
538 : r_wdq(wdq), m_data(0), m_slope(0), m_intercept (0), m_channel(channel),
542 if (channel >= 1 && channel <= wdq.m_nChannels) {
543 if (read_channel_data())
546 std::ostringstream os;
547 os << "Channel " << channel << " is invalid, valid range 1-" <<
549 error_msg (os.str().c_str());
554 WindaqChannel::~WindaqChannel ()
561 WindaqChannel::read_channel_data ()
565 m_data = new signed short int [r_wdq.m_nSamples * 2];
567 lseek (fd, r_wdq.m_channel_offset + 8 +
568 (m_channel - 1) * r_wdq.m_nBytes_channel_header,
570 if (! read_float8 (fd, m_slope))
573 if (! read_float8 (fd, m_intercept))
578 if (read (fd, units, 6) != 6) {
579 error_msg ("Error reading file");
584 long int row_bytes = 2 * r_wdq.m_nChannels;
586 signed short int *sample_row = new signed short int [row_bytes];
588 signed short int* psample = &sample_row[m_channel - 1];
590 lseek (fd, r_wdq.m_nHeader_bytes, SEEK_SET);
592 signed short int data_max = 0, data_min = 0;
593 double total_data = 0;
594 for (i = 0; i < r_wdq.m_nSamples; i++) {
595 if (read (fd, sample_row, row_bytes) != row_bytes) {
596 std::ostringstream os;
597 os << "Error reading file at " << i;
598 error_msg (os.str().c_str());
602 signed short int v = *psample;
605 unsigned char* p = reinterpret_cast<unsigned char*>(&v);
606 unsigned char c = p[0]; p[0] = p[1]; p[1] = c;
609 signed short int value = v;
610 if (! r_wdq.m_bHires)
620 if (value > data_max)
622 else if (value < data_min)
627 m_max_raw_data = data_max;
628 m_min_raw_data = data_min;
629 m_max_scaled_data = (m_slope * data_max) + m_intercept;
630 m_min_scaled_data = (m_slope * data_min) + m_intercept;
632 if (! g_dont_demean) {
633 double dmean = total_data / static_cast<double>(r_wdq.m_nSamples);
634 int mean = nearest<int>(dmean);
635 std::cout << "Removing mean: " << (dmean * m_slope) + m_intercept <<
636 " " << m_units << std::endl;
638 for (i = 0; i < r_wdq.m_nSamples; i++)
647 WavFile::WavFile (WindaqChannel& wdq_channel, const char* fname)
648 : m_valid(false), m_data(0), m_nSamples(0), m_strFile(fname), m_fd(0)
650 if (wdq_channel.m_valid) {
651 m_nSamples = wdq_channel.r_wdq.m_nSamples;
653 m_nBitsPerSample = 16;
654 m_nBytesPerSample = 2;
655 m_rate = wdq_channel.r_wdq.m_sample_rate;
657 double data_offset = 0, data_scale = 0;
659 data_offset = -wdq_channel.m_min_scaled_data;
660 if (wdq_channel.m_max_scaled_data != wdq_channel.m_min_scaled_data)
661 data_scale = 65535. / (wdq_channel.m_max_scaled_data -
662 wdq_channel.m_min_scaled_data);
664 double max_value = fabs(wdq_channel.m_max_scaled_data);
665 if (fabs (wdq_channel.m_min_scaled_data) > max_value)
666 max_value = fabs (wdq_channel.m_min_scaled_data);
668 data_scale = 32767. / max_value;
672 std::ostringstream os;
673 os << " Wav data_scale: " << data_scale << ", data_offset: " << data_offset;
674 info_msg (os.str().c_str());
678 m_nDataBytes = m_nSamples * m_nBytesPerSample * m_nChannels;
679 m_nFileBytes = m_nHeaderBytes + m_nDataBytes;
681 unsigned int nHeaderShortInts = m_nHeaderBytes / sizeof(signed short int);
683 m_data = new signed short int [m_nSamples + nHeaderShortInts];
684 signed short int* input = wdq_channel.m_data;
685 signed short int* output = &m_data[nHeaderShortInts];
686 double slope = wdq_channel.m_slope;
687 double intercept = wdq_channel.m_intercept;
689 if (! fill_header ())
694 for (i = 0; i < m_nSamples; i++) {
695 double value = input[i];
696 value = (slope * value) + intercept;
698 value = (value + data_offset) * data_scale;
699 value += 0.5 - 32768;
701 value = value * data_scale;
704 signed short int v = static_cast<signed short int>(value);
706 unsigned char* p = reinterpret_cast<unsigned char*>(&v);
707 unsigned char c = p[0]; p[0] = p[1]; p[1] = c;
727 put_int4 (char* p, unsigned int n)
730 *(p+1) = 0xFF & (n >> 8);
731 *(p+2) = 0xFF & (n >> 16);
732 *(p+3) = 0xFF & (n >> 24);
736 put_int2 (char* p, unsigned short int n)
739 *(p+1) = 0xFF & (n >> 8);
743 WavFile::fill_header ()
745 char* pData = reinterpret_cast<char*> (m_data);
747 strncpy (pData, "RIFF", 4);
749 // Length of file after 8 byte header
750 put_int4 (pData + 4, 36 + m_nDataBytes);
752 strncpy (pData + 8, "WAVEfmt ", 8);
754 // Length of header block
755 put_int4 (pData + 16, 0x10);
758 put_int2 (pData + 20, 1);
760 /* Number of channels */
761 put_int2 (pData + 22, m_nChannels);
764 put_int4 (pData + 24, static_cast<int> (m_rate + 0.5));
767 put_int4 (pData + 28, static_cast<int> (m_rate * m_nBytesPerSample + 0.5));
770 put_int2 (pData + 32, m_nBytesPerSample * m_nChannels);
773 put_int2 (pData + 34, m_nBitsPerSample);
775 strncpy (pData + 36, "data", 4);
777 put_int4 (pData + 40, m_nDataBytes);
783 WavFile::WriteFile ()
789 if ((m_fd = open (m_strFile.c_str(), O_WRONLY | O_BINARY | O_TRUNC | O_CREAT, g_fileMode)) == 0) {
790 std::ostringstream os;
791 os << "Error opening output file " << m_strFile.c_str();
792 error_msg (os.str().c_str());
796 lseek (m_fd, 0, SEEK_SET);
797 if (write (m_fd, m_data, m_nFileBytes) != m_nFileBytes) {
798 error_msg ("Error writing file");
802 if (close (m_fd) < 0)
803 error_msg ("Error closing output file");
811 #include <mmsystem.h>
812 #elif defined(__linux__)
813 #include <sys/ioctl.h>
814 #include <sys/soundcard.h>
821 if (PlaySound ((LPCSTR) m_data, 0, SND_MEMORY | SND_NODEFAULT))
823 #elif defined(__linux__)
825 if ((fd = open ("/dev/dsp",O_WRONLY)) == -1) {
826 error_msg ("Error opening /dev/dsp");
830 int format = AFMT_S16_LE;
831 if (ioctl (fd, SNDCTL_DSP_SETFMT, &format) == -1) {
832 error_msg ("Error setting DSP format");
833 close(fd); return false;
835 if (format != AFMT_S16_LE) {
836 error_msg ("DSP Format not set");
837 close(fd); return false;
840 unsigned int channels = m_nChannels;
841 if (ioctl (fd, SNDCTL_DSP_CHANNELS, &format) == -1) {
842 error_msg ("Error setting number of channels");
843 close(fd); return false;
845 if (channels != m_nChannels) {
846 error_msg ("Number of channels not set");
847 close(fd); return false;
850 unsigned int speed = static_cast<int>(m_rate + 0.5);
851 if (ioctl (fd, SNDCTL_DSP_SPEED, &speed) == -1) {
852 error_msg ("Error setting sample rate");
853 close(fd); return false;
855 if (speed != m_rate && ! g_quiet) {
856 std::ostringstream os;
857 os << "Warning: Sample rate set to " << speed << ", not " << m_rate;
858 error_msg (os.str().c_str());
861 if (write (fd, reinterpret_cast<char*>(m_data) + m_nHeaderBytes, m_nDataBytes) !=
863 error_msg ("Error writing audio samples");
864 close(fd); return false;