aboutsummaryrefslogtreecommitdiff
path: root/src/freedv_mixed_tx.c
diff options
context:
space:
mode:
Diffstat (limited to 'src/freedv_mixed_tx.c')
-rw-r--r--src/freedv_mixed_tx.c610
1 files changed, 302 insertions, 308 deletions
diff --git a/src/freedv_mixed_tx.c b/src/freedv_mixed_tx.c
index e323537..b902b12 100644
--- a/src/freedv_mixed_tx.c
+++ b/src/freedv_mixed_tx.c
@@ -27,350 +27,344 @@
*/
#include <assert.h>
-#include <stdlib.h>
-#include <stdio.h>
-#include <string.h>
-#include <errno.h>
#include <ctype.h>
-#include <stdint.h>
+#include <errno.h>
#include <stdbool.h>
+#include <stdint.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
-#include "freedv_api.h"
#include "codec2.h"
+#include "freedv_api.h"
/**********************************************************
- Encoding an ITU callsign (and 4 bit secondary station ID to a valid MAC address.
- http://dmlinking.net/eth_ar.html
+ Encoding an ITU callsign (and 4 bit secondary station ID to a valid MAC
+ address. http://dmlinking.net/eth_ar.html
*/
// Lookup table for valid callsign characters
-static char alnum2code[37] = {
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- 'A', 'B', 'C', 'D', 'E', 'F', 'G', 'H', 'I', 'J', 'K', 'L', 'M',
- 'N', 'O', 'P', 'Q', 'R', 'S', 'T', 'U', 'V', 'W', 'X', 'Y', 'Z',
- 0
-};
+static char alnum2code[37] = {'0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
+ 'A', 'B', 'C', 'D', 'E', 'F', 'G', 'H', 'I', 'J',
+ 'K', 'L', 'M', 'N', 'O', 'P', 'Q', 'R', 'S', 'T',
+ 'U', 'V', 'W', 'X', 'Y', 'Z', 0};
// Encode a callsign and ssid into a valid MAC address
-static int eth_ar_call2mac(uint8_t mac[6], char *callsign, int ssid, bool multicast)
-{
- uint64_t add = 0;
- int i;
-
- if (ssid > 15 || ssid < 0)
- return -1;
-
- for (i = 7; i >= 0; i--) {
- char c;
-
- if (i >= strlen(callsign)) {
- c = 0;
- } else {
- c = toupper(callsign[i]);
- }
-
- int j;
-
- for (j = 0; j < sizeof(alnum2code); j++) {
- if (alnum2code[j] == c)
- break;
- }
- if (j == sizeof(alnum2code))
- return -1;
-
- add *= 37;
- add += j;
- }
-
- mac[0] = ((add >> (40 - 6)) & 0xc0) | (ssid << 2) | 0x02 | multicast;
- mac[1] = (add >> 32) & 0xff;
- mac[2] = (add >> 24) & 0xff;
- mac[3] = (add >> 16) & 0xff;
- mac[4] = (add >> 8) & 0xff;
- mac[5] = add & 0xff;
-
- return 0;
-}
+static int eth_ar_call2mac(uint8_t mac[6], char *callsign, int ssid,
+ bool multicast) {
+ uint64_t add = 0;
+ int i;
+
+ if (ssid > 15 || ssid < 0) return -1;
+
+ for (i = 7; i >= 0; i--) {
+ char c;
+
+ if (i >= strlen(callsign)) {
+ c = 0;
+ } else {
+ c = toupper(callsign[i]);
+ }
+ int j;
+
+ for (j = 0; j < sizeof(alnum2code); j++) {
+ if (alnum2code[j] == c) break;
+ }
+ if (j == sizeof(alnum2code)) return -1;
+
+ add *= 37;
+ add += j;
+ }
+
+ mac[0] = ((add >> (40 - 6)) & 0xc0) | (ssid << 2) | 0x02 | multicast;
+ mac[1] = (add >> 32) & 0xff;
+ mac[2] = (add >> 24) & 0xff;
+ mac[3] = (add >> 16) & 0xff;
+ mac[4] = (add >> 8) & 0xff;
+ mac[5] = add & 0xff;
+
+ return 0;
+}
/**********************************************************
- Data channel callback functions
+ Data channel callback functions
*/
-
struct my_callback_state {
- int calls;
-
- unsigned char mac[6];
+ int calls;
+
+ unsigned char mac[6];
};
/*
- Called when a packet has been received
- Should not be called in this tx-only test program
+ Called when a packet has been received
+ Should not be called in this tx-only test program
*/
-void my_datarx(void *callback_state, unsigned char *packet, size_t size)
-{
- /* This should not happen while sending... */
- fprintf(stderr, "datarx callback called, this should not happen!\n");
+void my_datarx(void *callback_state, unsigned char *packet, size_t size) {
+ /* This should not happen while sending... */
+ fprintf(stderr, "datarx callback called, this should not happen!\n");
}
+/*
+ Called when a new packet can be send.
-/*
- Called when a new packet can be send.
-
- callback_state Private state variable, not touched by freedv.
- packet Data array where new packet data is expected
- size Available size in packet. On return the actual size of the packet
+ callback_state Private state variable, not touched by freedv.
+ packet Data array where new packet data is expected
+ size Available size in packet. On return the actual size of
+ the packet
*/
-void my_datatx(void *callback_state, unsigned char *packet, size_t *size)
-{
- static int data_type;
- struct my_callback_state *my_cb_state = callback_state;
- my_cb_state->calls++;
-
- /* Data could come from a network interface, here we just make up some */
-
- if (data_type % 4 == 1) {
- /*
- Generate a packet with simple test pattern (counting
- */
-
- /* Send a packet with data */
- int i;
-
- /* Destination: broadcast */
- memset(packet, 0xff, 6);
- /* Source: our eth_ar encoded callsign+ssid */
- memcpy(packet+6, my_cb_state->mac, 6);
- /* Ether type: experimental (since this is just a test pattern) */
- packet[12] = 0x01;
- packet[13] = 0x01;
-
- for (i = 0; i < 64; i++)
- packet[i + 14] = i;
- *size = i + 14;
- } else if (data_type % 4 == 2) {
- /*
- Generate an FPRS position report
- */
-
- /* Destination: broadcast */
- memset(packet, 0xff, 6);
- /* Source: our eth_ar encoded callsign+ssid */
- memcpy(packet+6, my_cb_state->mac, 6);
- /* Ether type: FPRS */
- packet[12] = 0x73;
- packet[13] = 0x70;
-
- packet[14] = 0x07; // Position element Lon 86.925026 Lat 27.987850
- packet[15] = 0x3d; //
- packet[16] = 0xd0;
- packet[17] = 0x37;
- packet[18] = 0xd0 | 0x08 | 0x01;
- packet[19] = 0x3e;
- packet[20] = 0x70;
- packet[21] = 0x85;
-
- *size = 22;
- } else {
- /*
- Set size to zero, the freedv api will insert a header frame
- This is useful for identifying ourselves
- */
- *size = 0;
- }
-
- data_type++;
+void my_datatx(void *callback_state, unsigned char *packet, size_t *size) {
+ static int data_type;
+ struct my_callback_state *my_cb_state = callback_state;
+ my_cb_state->calls++;
+
+ /* Data could come from a network interface, here we just make up some */
+
+ if (data_type % 4 == 1) {
+ /*
+ Generate a packet with simple test pattern (counting
+ */
+
+ /* Send a packet with data */
+ int i;
+
+ /* Destination: broadcast */
+ memset(packet, 0xff, 6);
+ /* Source: our eth_ar encoded callsign+ssid */
+ memcpy(packet + 6, my_cb_state->mac, 6);
+ /* Ether type: experimental (since this is just a test pattern) */
+ packet[12] = 0x01;
+ packet[13] = 0x01;
+
+ for (i = 0; i < 64; i++) packet[i + 14] = i;
+ *size = i + 14;
+ } else if (data_type % 4 == 2) {
+ /*
+ Generate an FPRS position report
+ */
+
+ /* Destination: broadcast */
+ memset(packet, 0xff, 6);
+ /* Source: our eth_ar encoded callsign+ssid */
+ memcpy(packet + 6, my_cb_state->mac, 6);
+ /* Ether type: FPRS */
+ packet[12] = 0x73;
+ packet[13] = 0x70;
+
+ packet[14] = 0x07; // Position element Lon 86.925026 Lat 27.987850
+ packet[15] = 0x3d; //
+ packet[16] = 0xd0;
+ packet[17] = 0x37;
+ packet[18] = 0xd0 | 0x08 | 0x01;
+ packet[19] = 0x3e;
+ packet[20] = 0x70;
+ packet[21] = 0x85;
+
+ *size = 22;
+ } else {
+ /*
+ Set size to zero, the freedv api will insert a header frame
+ This is useful for identifying ourselves
+ */
+ *size = 0;
+ }
+
+ data_type++;
}
-
-/* Determine the amount of 'energy' in the samples by squaring them
- This is not a perfect VAD as noise may trigger it, but works well for demonstrations.
+/* Determine the amount of 'energy' in the samples by squaring them
+ This is not a perfect VAD as noise may trigger it, but works well for
+ demonstrations.
*/
-static float samples_get_energy(short *samples, int nr)
-{
- float e = 0;
- int i;
-
- for (i = 0; i < nr; i++) {
- e += (float)(samples[i] * samples[i]) / (8192);
- }
- e /= nr;
-
- return e;
-}
-
-int main(int argc, char *argv[]) {
- FILE *fin, *fout;
- short *speech_in;
- short *mod_out;
- struct freedv *freedv;
- struct my_callback_state my_cb_state;
- int mode;
- int n_speech_samples;
- int n_nom_modem_samples;
- char *callsign = "NOCALL";
- int ssid = 0;
- bool multicast = false;
- int use_codectx;
- struct CODEC2 *c2;
- int i;
- float data_threshold = 15;
-
- if (argc < 4) {
- printf("usage: %s 2400A|2400B|800XA InputRawSpeechFile OutputModemRawFile\n"
- " [--codectx] [--callsign callsign] [--ssid ssid] [--mac-multicast 0|1] [--data-threshold val]\n", argv[0]);
- printf("e.g %s 2400A hts1a.raw hts1a_fdmdv.raw\n", argv[0]);
- exit(1);
- }
+static float samples_get_energy(short *samples, int nr) {
+ float e = 0;
+ int i;
- mode = -1;
- if (!strcmp(argv[1],"2400A"))
- mode = FREEDV_MODE_2400A;
- if (!strcmp(argv[1],"2400B"))
- mode = FREEDV_MODE_2400B;
- if (!strcmp(argv[1],"800XA"))
- mode = FREEDV_MODE_800XA;
- if (mode == -1) {
- fprintf(stderr, "Error in mode: %s\n", argv[1]);
- exit(0);
- }
+ for (i = 0; i < nr; i++) {
+ e += (float)(samples[i] * samples[i]) / (8192);
+ }
+ e /= nr;
- if (strcmp(argv[2], "-") == 0) fin = stdin;
- else if ( (fin = fopen(argv[2],"rb")) == NULL ) {
- fprintf(stderr, "Error opening input raw speech sample file: %s: %s.\n", argv[2], strerror(errno));
- exit(1);
- }
-
- if (strcmp(argv[3], "-") == 0) fout = stdout;
- else if ( (fout = fopen(argv[3],"wb")) == NULL ) {
- fprintf(stderr, "Error opening output modem sample file: %s: %s.\n", argv[3], strerror(errno));
- exit(1);
- }
-
- use_codectx = 0;
-
- if (argc > 4) {
- for (i = 4; i < argc; i++) {
- if (strcmp(argv[i], "--codectx") == 0) {
- int c2_mode;
-
- if ((mode == FREEDV_MODE_700C) || (mode == FREEDV_MODE_700D) || (mode == FREEDV_MODE_800XA)) {
- c2_mode = CODEC2_MODE_700C;
- } else {
- c2_mode = CODEC2_MODE_1300;
- }
- use_codectx = 1;
- c2 = codec2_create(c2_mode);
- assert(c2 != NULL);
- }
- if (strcmp(argv[i], "--callsign") == 0) {
- callsign = argv[i+1];
- }
- if (strcmp(argv[i], "--ssid") == 0) {
- ssid = atoi(argv[i+1]);
- }
- if (strcmp(argv[i], "--mac-multicast") == 0) {
- multicast = atoi(argv[i+1]);
- }
- if (strcmp(argv[i], "--data-threshold") == 0) {
- data_threshold = atof(argv[i+1]);
- }
- }
- }
+ return e;
+}
- freedv = freedv_open(mode);
- assert(freedv != NULL);
-
- /* Generate our address */
- eth_ar_call2mac(my_cb_state.mac, callsign, ssid, multicast);
-
- freedv_set_data_header(freedv, my_cb_state.mac);
-
- freedv_set_verbose(freedv, 1);
-
- n_speech_samples = freedv_get_n_speech_samples(freedv);
- n_nom_modem_samples = freedv_get_n_nom_modem_samples(freedv);
- speech_in = (short*)malloc(sizeof(short)*n_speech_samples);
- assert(speech_in != NULL);
- mod_out = (short*)malloc(sizeof(short)*n_nom_modem_samples);
- assert(mod_out != NULL);
- //fprintf(stderr, "n_speech_samples: %d n_nom_modem_samples: %d\n", n_speech_samples, n_nom_modem_samples);
-
- /* set up callback for data packets */
- freedv_set_callback_data(freedv, my_datarx, my_datatx, &my_cb_state);
-
- /* OK main loop */
-
- while(fread(speech_in, sizeof(short), n_speech_samples, fin) == n_speech_samples) {
- if (use_codectx == 0) {
- /* Use the freedv_api to do everything: speech encoding, modulating
- */
- float energy = samples_get_energy(speech_in, n_speech_samples);
-
- /* Is the audio fragment quiet? */
- if (energy < data_threshold) {
- /* Insert a frame with data instead of speech */
- freedv_datatx(freedv, mod_out);
- } else {
- /* transmit voice frame */
- freedv_tx(freedv, mod_out, speech_in);
- }
+int main(int argc, char *argv[]) {
+ FILE *fin, *fout;
+ short *speech_in;
+ short *mod_out;
+ struct freedv *freedv;
+ struct my_callback_state my_cb_state;
+ int mode;
+ int n_speech_samples;
+ int n_nom_modem_samples;
+ char *callsign = "NOCALL";
+ int ssid = 0;
+ bool multicast = false;
+ int use_codectx;
+ struct CODEC2 *c2;
+ int i;
+ float data_threshold = 15;
+
+ if (argc < 4) {
+ printf(
+ "usage: %s 2400A|2400B|800XA InputRawSpeechFile OutputModemRawFile\n"
+ " [--codectx] [--callsign callsign] [--ssid ssid] [--mac-multicast "
+ "0|1] [--data-threshold val]\n",
+ argv[0]);
+ printf("e.g %s 2400A hts1a.raw hts1a_fdmdv.raw\n", argv[0]);
+ exit(1);
+ }
+
+ mode = -1;
+ if (!strcmp(argv[1], "2400A")) mode = FREEDV_MODE_2400A;
+ if (!strcmp(argv[1], "2400B")) mode = FREEDV_MODE_2400B;
+ if (!strcmp(argv[1], "800XA")) mode = FREEDV_MODE_800XA;
+ if (mode == -1) {
+ fprintf(stderr, "Error in mode: %s\n", argv[1]);
+ exit(0);
+ }
+
+ if (strcmp(argv[2], "-") == 0)
+ fin = stdin;
+ else if ((fin = fopen(argv[2], "rb")) == NULL) {
+ fprintf(stderr, "Error opening input raw speech sample file: %s: %s.\n",
+ argv[2], strerror(errno));
+ exit(1);
+ }
+
+ if (strcmp(argv[3], "-") == 0)
+ fout = stdout;
+ else if ((fout = fopen(argv[3], "wb")) == NULL) {
+ fprintf(stderr, "Error opening output modem sample file: %s: %s.\n",
+ argv[3], strerror(errno));
+ exit(1);
+ }
+
+ use_codectx = 0;
+
+ if (argc > 4) {
+ for (i = 4; i < argc; i++) {
+ if (strcmp(argv[i], "--codectx") == 0) {
+ int c2_mode;
+
+ if ((mode == FREEDV_MODE_700C) || (mode == FREEDV_MODE_700D) ||
+ (mode == FREEDV_MODE_800XA)) {
+ c2_mode = CODEC2_MODE_700C;
} else {
- /* Use the freedv_api to do the modem part, encode ourselves
- - First encode the frames
- - Get activity from codec2 api
- - Based on activity either send encoded voice or data
- */
- int bits_per_codec_frame = freedv_get_bits_per_codec_frame(freedv);
- int bits_per_modem_frame = freedv_get_bits_per_modem_frame(freedv);
- int bytes_per_codec_frame = (bits_per_codec_frame + 7) / 8;
- int bytes_per_modem_frame = (bits_per_modem_frame + 7) / 8;
- int codec_frames = bits_per_modem_frame / bits_per_codec_frame;
- int samples_per_frame = codec2_samples_per_frame(c2);
- unsigned char encoded[bytes_per_codec_frame * codec_frames];
- unsigned char rawdata[bytes_per_modem_frame];
- unsigned char *enc_frame = encoded;
- short *speech_frame = speech_in;
- float energy = 0;
-
- /* Encode the speech ourself (or get it from elsewhere, e.g. network) */
- for (i = 0; i < codec_frames; i++) {
- codec2_encode(c2, enc_frame, speech_frame);
- energy += codec2_get_energy(c2, enc_frame);
- enc_frame += bytes_per_codec_frame;
- speech_frame += samples_per_frame;
- }
- energy /= codec_frames;
-
- /* Is the audio fragment quiet? */
- if (energy < data_threshold) {
- /* Insert a frame with data instead of speech */
- freedv_datatx(freedv, mod_out);
- } else {
- /* Use the freedv_api to modulate already encoded frames */
- freedv_rawdata_from_codec_frames(freedv, rawdata, encoded);
- freedv_rawdatatx(freedv, mod_out, rawdata);
- }
+ c2_mode = CODEC2_MODE_1300;
}
+ use_codectx = 1;
+ c2 = codec2_create(c2_mode);
+ assert(c2 != NULL);
+ }
+ if (strcmp(argv[i], "--callsign") == 0) {
+ callsign = argv[i + 1];
+ }
+ if (strcmp(argv[i], "--ssid") == 0) {
+ ssid = atoi(argv[i + 1]);
+ }
+ if (strcmp(argv[i], "--mac-multicast") == 0) {
+ multicast = atoi(argv[i + 1]);
+ }
+ if (strcmp(argv[i], "--data-threshold") == 0) {
+ data_threshold = atof(argv[i + 1]);
+ }
+ }
+ }
+
+ freedv = freedv_open(mode);
+ assert(freedv != NULL);
+
+ /* Generate our address */
+ eth_ar_call2mac(my_cb_state.mac, callsign, ssid, multicast);
+
+ freedv_set_data_header(freedv, my_cb_state.mac);
+
+ freedv_set_verbose(freedv, 1);
+
+ n_speech_samples = freedv_get_n_speech_samples(freedv);
+ n_nom_modem_samples = freedv_get_n_nom_modem_samples(freedv);
+ speech_in = (short *)malloc(sizeof(short) * n_speech_samples);
+ assert(speech_in != NULL);
+ mod_out = (short *)malloc(sizeof(short) * n_nom_modem_samples);
+ assert(mod_out != NULL);
+ // fprintf(stderr, "n_speech_samples: %d n_nom_modem_samples: %d\n",
+ // n_speech_samples, n_nom_modem_samples);
+
+ /* set up callback for data packets */
+ freedv_set_callback_data(freedv, my_datarx, my_datatx, &my_cb_state);
+
+ /* OK main loop */
+
+ while (fread(speech_in, sizeof(short), n_speech_samples, fin) ==
+ n_speech_samples) {
+ if (use_codectx == 0) {
+ /* Use the freedv_api to do everything: speech encoding, modulating
+ */
+ float energy = samples_get_energy(speech_in, n_speech_samples);
+
+ /* Is the audio fragment quiet? */
+ if (energy < data_threshold) {
+ /* Insert a frame with data instead of speech */
+ freedv_datatx(freedv, mod_out);
+ } else {
+ /* transmit voice frame */
+ freedv_tx(freedv, mod_out, speech_in);
+ }
+ } else {
+ /* Use the freedv_api to do the modem part, encode ourselves
+ - First encode the frames
+ - Get activity from codec2 api
+ - Based on activity either send encoded voice or data
+ */
+ int bits_per_codec_frame = freedv_get_bits_per_codec_frame(freedv);
+ int bits_per_modem_frame = freedv_get_bits_per_modem_frame(freedv);
+ int bytes_per_codec_frame = (bits_per_codec_frame + 7) / 8;
+ int bytes_per_modem_frame = (bits_per_modem_frame + 7) / 8;
+ int codec_frames = bits_per_modem_frame / bits_per_codec_frame;
+ int samples_per_frame = codec2_samples_per_frame(c2);
+ unsigned char encoded[bytes_per_codec_frame * codec_frames];
+ unsigned char rawdata[bytes_per_modem_frame];
+ unsigned char *enc_frame = encoded;
+ short *speech_frame = speech_in;
+ float energy = 0;
+
+ /* Encode the speech ourself (or get it from elsewhere, e.g. network) */
+ for (i = 0; i < codec_frames; i++) {
+ codec2_encode(c2, enc_frame, speech_frame);
+ energy += codec2_get_energy(c2, enc_frame);
+ enc_frame += bytes_per_codec_frame;
+ speech_frame += samples_per_frame;
+ }
+ energy /= codec_frames;
+
+ /* Is the audio fragment quiet? */
+ if (energy < data_threshold) {
+ /* Insert a frame with data instead of speech */
+ freedv_datatx(freedv, mod_out);
+ } else {
+ /* Use the freedv_api to modulate already encoded frames */
+ freedv_rawdata_from_codec_frames(freedv, rawdata, encoded);
+ freedv_rawdatatx(freedv, mod_out, rawdata);
+ }
+ }
- fwrite(mod_out, sizeof(short), n_nom_modem_samples, fout);
-
- /* if this is in a pipeline, we probably don't want the usual
- buffering to occur */
- if (fout == stdout) fflush(stdout);
+ fwrite(mod_out, sizeof(short), n_nom_modem_samples, fout);
- }
+ /* if this is in a pipeline, we probably don't want the usual
+ buffering to occur */
+ if (fout == stdout) fflush(stdout);
+ }
- free(speech_in);
- free(mod_out);
- freedv_close(freedv);
- fclose(fin);
- fclose(fout);
+ free(speech_in);
+ free(mod_out);
+ freedv_close(freedv);
+ fclose(fin);
+ fclose(fout);
- fclose(stdin);
- fclose(stderr);
+ fclose(stdin);
+ fclose(stderr);
- return 0;
+ return 0;
}
-
generated by cgit v1.2.3 (git 2.46.0) at 2026-01-26 22:02:49 +0000