//
// Written by Curtis Olson, started March 2001.
//
-// Copyright (C) 2001 Curtis L. Olson - curt@flightgear.org
+// Copyright (C) 2001 Curtis L. Olson - http://www.flightgear.org/~curt
//
// This program is free software; you can redistribute it and/or
// modify it under the terms of the GNU General Public License as
//
// You should have received a copy of the GNU General Public License
// along with this program; if not, write to the Free Software
-// Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
+// Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
//
// $Id$
+#include <simgear/constants.h>
+
#include "morse.hxx"
{ DA, DA, DI, DIT } /* Z */
};
+static const char numerals[10][5] = {
+ { DA, DA, DA, DA, DAH }, // 0
+ { DI, DA, DA, DA, DAH }, // 1
+ { DI, DI, DA, DA, DAH }, // 2
+ { DI, DI, DI, DA, DAH }, // 3
+ { DI, DI, DI, DI, DAH }, // 4
+ { DI, DI, DI, DI, DIT }, // 5
+ { DA, DI, DI, DI, DIT }, // 6
+ { DA, DA, DI, DI, DIT }, // 7
+ { DA, DA, DA, DI, DIT }, // 8
+ { DA, DA, DA, DA, DIT } // 9
+};
+
// constructor
FGMorse::FGMorse() {
}
-// allocate and initialize sound samples
-bool FGMorse::init() {
+// Make a tone of specified freq and total_len with trans_len ramp in
+// and out and only the first len bytes with sound, the rest with
+// silence
+void make_tone( unsigned char *buf, int freq,
+ int len, int total_len, int trans_len )
+{
int i, j;
- // Make Low DIT
- for ( i = 0; i < TRANSITION_BYTES; ++i ) {
- float level = ( sin( (double) i * 2.0 * M_PI
- / (8000.0 / LO_FREQUENCY) ) )
- * ((double)i / TRANSITION_BYTES)
- / 2.0 + 0.5;
+ for ( i = 0; i < trans_len; ++i ) {
+ float level = ( sin( (double) i * SGD_2PI / (BYTES_PER_SECOND / freq) ) )
+ * ((double)i / trans_len) / 2.0 + 0.5;
/* Convert to unsigned byte */
- lo_dit[ i ] = (unsigned char) ( level * 255.0 ) ;
+ buf[ i ] = (unsigned char) ( level * 255.0 ) ;
}
- for ( i = TRANSITION_BYTES;
- i < DIT_SIZE - TRANSITION_BYTES - COUNT_SIZE; ++i ) {
- float level = ( sin( (double) i * 2.0 * M_PI
- / (8000.0 / LO_FREQUENCY) ) )
+ for ( i = trans_len; i < len - trans_len; ++i ) {
+ float level = ( sin( (double) i * SGD_2PI / (BYTES_PER_SECOND / freq) ) )
/ 2.0 + 0.5;
/* Convert to unsigned byte */
- lo_dit[ i ] = (unsigned char) ( level * 255.0 ) ;
+ buf[ i ] = (unsigned char) ( level * 255.0 ) ;
}
- j = TRANSITION_BYTES;
- for ( i = DIT_SIZE - TRANSITION_BYTES - COUNT_SIZE;
- i < DIT_SIZE - COUNT_SIZE;
- ++i ) {
- float level = ( sin( (double) i * 2.0 * M_PI
- / (8000.0 / LO_FREQUENCY) ) )
- * ((double)j / TRANSITION_BYTES) / 2.0 + 0.5;
+ j = trans_len;
+ for ( i = len - trans_len; i < len; ++i ) {
+ float level = ( sin( (double) i * SGD_2PI / (BYTES_PER_SECOND / freq) ) )
+ * ((double)j / trans_len) / 2.0 + 0.5;
--j;
/* Convert to unsigned byte */
- lo_dit[ i ] = (unsigned char) ( level * 255.0 ) ;
+ buf[ i ] = (unsigned char) ( level * 255.0 ) ;
}
- for ( i = DIT_SIZE - COUNT_SIZE; i < DIT_SIZE; ++i ) {
- lo_dit[ i ] = (unsigned char) ( 0.5 * 255.0 ) ;
- }
-
- // Make High DIT
- for ( i = 0; i < TRANSITION_BYTES; ++i ) {
- float level = ( sin( (double) i * 2.0 * M_PI
- / (8000.0 / HI_FREQUENCY)) )
- * ((double)i / TRANSITION_BYTES) / 2.0 + 0.5;
-
- /* Convert to unsigned byte */
- hi_dit[ i ] = (unsigned char) ( level * 255.0 ) ;
+ for ( i = len; i < total_len; ++i ) {
+ buf[ i ] = (unsigned char) ( 0.5 * 255.0 ) ;
}
+}
- for ( i = TRANSITION_BYTES;
- i < DIT_SIZE - TRANSITION_BYTES - COUNT_SIZE; ++i ) {
- float level = ( sin( (double) i * 2.0 * M_PI
- / (8000.0 / HI_FREQUENCY) ) )
- / 2.0 + 0.5;
- /* Convert to unsigned byte */
- hi_dit[ i ] = (unsigned char) ( level * 255.0 ) ;
- }
- j = TRANSITION_BYTES;
- for ( i = DIT_SIZE - TRANSITION_BYTES - COUNT_SIZE;
- i < DIT_SIZE - COUNT_SIZE;
- ++i ) {
- float level = ( sin( (double) i * 2.0 * M_PI
- / (8000.0 / HI_FREQUENCY) ) )
- * ((double)j / TRANSITION_BYTES) / 2.0 + 0.5;
- --j;
+// allocate and initialize sound samples
+bool FGMorse::init() {
+ // Make Low DIT
+ make_tone( lo_dit, LO_FREQUENCY, DIT_SIZE - COUNT_SIZE, DIT_SIZE,
+ TRANSITION_BYTES );
- /* Convert to unsigned byte */
- hi_dit[ i ] = (unsigned char) ( level * 255.0 ) ;
- }
- for ( i = DIT_SIZE - COUNT_SIZE; i < DIT_SIZE; ++i ) {
- hi_dit[ i ] = (unsigned char) ( 0.5 * 255.0 ) ;
- }
+ // Make High DIT
+ make_tone( hi_dit, HI_FREQUENCY, DIT_SIZE - COUNT_SIZE, DIT_SIZE,
+ TRANSITION_BYTES );
// Make Low DAH
- for ( i = 0; i < TRANSITION_BYTES; ++i ) {
- float level = ( sin( (double) i * 2.0 * M_PI
- / (8000.0 / LO_FREQUENCY) ) )
- * ((double)i / TRANSITION_BYTES) / 2.0 + 0.5;
-
- /* Convert to unsigned byte */
- lo_dah[ i ] = (unsigned char) ( level * 255.0 ) ;
- }
-
- for ( i = TRANSITION_BYTES;
- i < DAH_SIZE - TRANSITION_BYTES - COUNT_SIZE;
- ++i ) {
- float level = ( sin( (double) i * 2.0 * M_PI
- / (8000.0 / LO_FREQUENCY) ) )
- / 2.0 + 0.5;
-
- /* Convert to unsigned byte */
- lo_dah[ i ] = (unsigned char) ( level * 255.0 ) ;
- }
- j = TRANSITION_BYTES;
- for ( int i = DAH_SIZE - TRANSITION_BYTES - COUNT_SIZE;
- i < DAH_SIZE - COUNT_SIZE;
- ++i ) {
- float level = ( sin( (double) i * 2.0 * M_PI
- / (8000.0 / LO_FREQUENCY) ) )
- * ((double)j / TRANSITION_BYTES) / 2.0 + 0.5;
- --j;
-
- /* Convert to unsigned byte */
- lo_dah[ i ] = (unsigned char) ( level * 255.0 ) ;
- }
- for ( int i = DAH_SIZE - COUNT_SIZE; i < DAH_SIZE; ++i ) {
- lo_dah[ i ] = (unsigned char) ( 0.5 * 255.0 ) ;
- }
+ make_tone( lo_dah, LO_FREQUENCY, DAH_SIZE - COUNT_SIZE, DAH_SIZE,
+ TRANSITION_BYTES );
// Make High DAH
- for ( i = 0; i < TRANSITION_BYTES; ++i ) {
- float level = ( sin( (double) i * 2.0 * M_PI
- / (8000.0 / HI_FREQUENCY) ) )
- * ((double)i / TRANSITION_BYTES) / 2.0 + 0.5;
-
- /* Convert to unsigned byte */
- hi_dah[ i ] = (unsigned char) ( level * 255.0 ) ;
- }
-
- for ( i = TRANSITION_BYTES;
- i < DAH_SIZE - TRANSITION_BYTES - COUNT_SIZE;
- ++i ) {
- float level = ( sin( (double) i * 2.0 * M_PI
- / (8000.0 / HI_FREQUENCY) ) )
- / 2.0 + 0.5;
-
- /* Convert to unsigned byte */
- hi_dah[ i ] = (unsigned char) ( level * 255.0 ) ;
- }
- j = TRANSITION_BYTES;
- for ( int i = DAH_SIZE - TRANSITION_BYTES - COUNT_SIZE;
- i < DAH_SIZE - COUNT_SIZE;
- ++i ) {
- float level = ( sin( (double) i * 2.0 * M_PI
- / (8000.0 / HI_FREQUENCY) ) )
- * ((double)j / TRANSITION_BYTES) / 2.0 + 0.5;
- --j;
-
- /* Convert to unsigned byte */
- hi_dah[ i ] = (unsigned char) ( level * 255.0 ) ;
- }
- for ( int i = DAH_SIZE - COUNT_SIZE; i < DAH_SIZE; ++i ) {
- hi_dah[ i ] = (unsigned char) ( 0.5 * 255.0 ) ;
- }
+ make_tone( hi_dah, HI_FREQUENCY, DAH_SIZE - COUNT_SIZE, DAH_SIZE,
+ TRANSITION_BYTES );
// Make SPACE
- for ( int i = 0; i < SPACE_SIZE; ++i ) {
+ int i;
+ for ( i = 0; i < SPACE_SIZE; ++i ) {
space[ i ] = (unsigned char) ( 0.5 * 255 ) ;
}
// allocate and initialize sound samples
bool FGMorse::cust_init(const int freq ) {
- int i, j;
+ int i;
// Make DIT
- for ( i = 0; i < TRANSITION_BYTES; ++i ) {
- float level = ( sin( (double) i * 2.0 * M_PI / (8000.0 / freq)) )
- * ((double)i / TRANSITION_BYTES) / 2.0 + 0.5;
-
- /* Convert to unsigned byte */
- cust_dit[ i ] = (unsigned char) ( level * 255.0 ) ;
- }
-
- for ( i = TRANSITION_BYTES;
- i < DIT_SIZE - TRANSITION_BYTES - COUNT_SIZE; ++i ) {
- float level = ( sin( (double) i * 2.0 * M_PI / (8000.0 / freq) ) )
- / 2.0 + 0.5;
-
- /* Convert to unsigned byte */
- cust_dit[ i ] = (unsigned char) ( level * 255.0 ) ;
- }
- j = TRANSITION_BYTES;
- for ( i = DIT_SIZE - TRANSITION_BYTES - COUNT_SIZE;
- i < DIT_SIZE - COUNT_SIZE;
- ++i ) {
- float level = ( sin( (double) i * 2.0 * M_PI / (8000.0 / freq) ) )
- * ((double)j / TRANSITION_BYTES) / 2.0 + 0.5;
- --j;
-
- /* Convert to unsigned byte */
- cust_dit[ i ] = (unsigned char) ( level * 255.0 ) ;
- }
- for ( i = DIT_SIZE - COUNT_SIZE; i < DIT_SIZE; ++i ) {
- cust_dit[ i ] = (unsigned char) ( 0.5 * 255.0 ) ;
- }
+ make_tone( cust_dit, freq, DIT_SIZE - COUNT_SIZE, DIT_SIZE,
+ TRANSITION_BYTES );
// Make DAH
- for ( i = 0; i < TRANSITION_BYTES; ++i ) {
- float level = ( sin( (double) i * 2.0 * M_PI / (8000.0 / freq) ) )
- * ((double)i / TRANSITION_BYTES) / 2.0 + 0.5;
-
- /* Convert to unsigned byte */
- cust_dah[ i ] = (unsigned char) ( level * 255.0 ) ;
- }
-
- for ( i = TRANSITION_BYTES;
- i < DAH_SIZE - TRANSITION_BYTES - COUNT_SIZE;
- ++i ) {
- float level = ( sin( (double) i * 2.0 * M_PI / (8000.0 / freq) ) )
- / 2.0 + 0.5;
-
- /* Convert to unsigned byte */
- cust_dah[ i ] = (unsigned char) ( level * 255.0 ) ;
- }
- j = TRANSITION_BYTES;
- for ( int i = DAH_SIZE - TRANSITION_BYTES - COUNT_SIZE;
- i < DAH_SIZE - COUNT_SIZE;
- ++i ) {
- float level = ( sin( (double) i * 2.0 * M_PI / (8000.0 / freq) ) )
- * ((double)j / TRANSITION_BYTES) / 2.0 + 0.5;
- --j;
-
- /* Convert to unsigned byte */
- cust_dah[ i ] = (unsigned char) ( level * 255.0 ) ;
- }
- for ( int i = DAH_SIZE - COUNT_SIZE; i < DAH_SIZE; ++i ) {
- cust_dah[ i ] = (unsigned char) ( 0.5 * 255.0 ) ;
- }
+ make_tone( cust_dah, freq, DAH_SIZE - COUNT_SIZE, DAH_SIZE,
+ TRANSITION_BYTES );
// Make SPACE
- for ( int i = 0; i < SPACE_SIZE; ++i ) {
+ for ( i = 0; i < SPACE_SIZE; ++i ) {
space[ i ] = (unsigned char) ( 0.5 * 255 ) ;
}
}
-// make a FGSimpleSound morse code transmission for the specified string
-FGSimpleSound *FGMorse::make_ident( const string& id, const int freq ) {
+// make a SGSoundSample morse code transmission for the specified string
+SGSoundSample *FGMorse::make_ident( const string& id, const int freq ) {
+
char *idptr = (char *)id.c_str();
int length = 0;
// 1. Determine byte length of message
for ( i = 0; i < (int)id.length(); ++i ) {
if ( idptr[i] >= 'A' && idptr[i] <= 'Z' ) {
- char c = idptr[i] - 'A';
+ int c = (int)(idptr[i] - 'A');
for ( j = 0; j < 4 || alphabet[c][j] == end; ++j ) {
if ( alphabet[c][j] == DIT ) {
length += DIT_SIZE;
}
}
length += SPACE_SIZE;
+ } else if ( idptr[i] >= '0' && idptr[i] <= '9' ) {
+ int c = (int)(idptr[i] - '0');
+ for ( j = 0; j < 5; ++j) {
+ if ( numerals[c][j] == DIT ) {
+ length += DIT_SIZE;
+ } else if ( numerals[c][j] == DAH ) {
+ length += DAH_SIZE;
+ }
+ }
+ length += SPACE_SIZE;
} else {
// skip unknown character
}
length += 2 * SPACE_SIZE;
// 2. Allocate space for the message
- unsigned char *buffer = new unsigned char[length];
+ const unsigned char* buffer = (const unsigned char *)malloc(length);
// 3. Assemble the message;
- unsigned char *buf_ptr = buffer;
+ unsigned char *buf_ptr = (unsigned char*)buffer;
for ( i = 0; i < (int)id.length(); ++i ) {
if ( idptr[i] >= 'A' && idptr[i] <= 'Z' ) {
- char c = idptr[i] - 'A';
+ int c = (int)(idptr[i] - 'A');
for ( j = 0; j < 4 || alphabet[c][j] == end; ++j ) {
if ( alphabet[c][j] == DIT ) {
memcpy( buf_ptr, dit_ptr, DIT_SIZE );
}
memcpy( buf_ptr, space, SPACE_SIZE );
buf_ptr += SPACE_SIZE;
+ } else if ( idptr[i] >= '0' && idptr[i] <= '9' ) {
+ int c = (int)(idptr[i] - '0');
+ for ( j = 0; j < 5; ++j ) {
+ if ( numerals[c][j] == DIT ) {
+ memcpy( buf_ptr, dit_ptr, DIT_SIZE );
+ buf_ptr += DIT_SIZE;
+ } else if ( numerals[c][j] == DAH ) {
+ memcpy( buf_ptr, dah_ptr, DAH_SIZE );
+ buf_ptr += DAH_SIZE;
+ }
+ }
+ memcpy( buf_ptr, space, SPACE_SIZE );
+ buf_ptr += SPACE_SIZE;
} else {
// skip unknown character
}
buf_ptr += SPACE_SIZE;
// 4. create the simple sound and return
- FGSimpleSound *sample = new FGSimpleSound( buffer, length );
+ SGSoundSample *sample = new SGSoundSample( &buffer, length,
+ BYTES_PER_SECOND );
+
+ sample->set_reference_dist( 10.0 );
+ sample->set_max_dist( 20.0 );
return sample;
}