mirror of
https://github.com/radio95-rnt/rds95.git
synced 2026-02-27 04:43:52 +01:00
change name
This commit is contained in:
293
src/rds95.c
Normal file
293
src/rds95.c
Normal file
@@ -0,0 +1,293 @@
|
||||
/*
|
||||
* mpxgen - FM multiplex encoder with Stereo and RDS
|
||||
* Copyright (C) 2019 Anthony96922
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 3 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
#include "common.h"
|
||||
#include <signal.h>
|
||||
#include <getopt.h>
|
||||
#include <pthread.h>
|
||||
#include <pulse/simple.h>
|
||||
#include <pulse/error.h>
|
||||
|
||||
#include "rds.h"
|
||||
#include "control_pipe.h"
|
||||
#include "lib.h"
|
||||
#include "ascii_cmd.h"
|
||||
|
||||
#define NUM_MPX_FRAMES 512
|
||||
|
||||
static uint8_t stop_rds;
|
||||
|
||||
static void stop() {
|
||||
printf("Received an stopping signal\n");
|
||||
stop_rds = 1;
|
||||
}
|
||||
|
||||
|
||||
/* threads */
|
||||
static void *control_pipe_worker() {
|
||||
while (!stop_rds) {
|
||||
poll_control_pipe();
|
||||
msleep(READ_TIMEOUT_MS);
|
||||
}
|
||||
|
||||
close_control_pipe();
|
||||
pthread_exit(NULL);
|
||||
}
|
||||
|
||||
static void show_help(char *name) {
|
||||
printf(
|
||||
"This is MiniRDS, a lightweight RDS encoder.\n"
|
||||
"Version %f\n"
|
||||
"\n"
|
||||
"Usage: %s [options]\n"
|
||||
"\n"
|
||||
" -i,--pi Program Identification code\n"
|
||||
" [default: 305F]\n"
|
||||
" -s,--ps Program Service name\n"
|
||||
" [default: \"radio95\"]\n"
|
||||
" -r,--rt1 Radio Text 1\n"
|
||||
" [default: (nothing)]\n"
|
||||
" -p,--pty Program Type\n"
|
||||
" [default: 0]\n"
|
||||
" -T,--tp Traffic Program\n"
|
||||
" [default: 0]\n"
|
||||
" -A,--af Alternative Frequency (FM/LF/MF)\n"
|
||||
" (more than one AF may be passed)\n"
|
||||
" -P,--ptyn Program Type Name\n"
|
||||
" -l,--lps Long PS\n"
|
||||
" -e,--ecc ECC code\n"
|
||||
" -d,--di DI code\n"
|
||||
" -C,--ctl FIFO control pipe\n"
|
||||
" -h,--help Show this help text and exit\n"
|
||||
" -v,--version Show version and exit\n"
|
||||
"\n",
|
||||
VERSION,
|
||||
name
|
||||
);
|
||||
}
|
||||
|
||||
static void show_version() {
|
||||
printf("MiniRDS version (radio95 Edit) %f\n", VERSION);
|
||||
}
|
||||
|
||||
int main(int argc, char **argv) {
|
||||
int opt;
|
||||
char control_pipe[51];
|
||||
struct rds_params_t rds_params = {
|
||||
.ps = "radio95",
|
||||
.rt1 = "",
|
||||
.pi = 0x305F,
|
||||
.ecc = 0xE2,
|
||||
.lps = "radio95 - Radio Nowotomyskie"
|
||||
};
|
||||
/* buffers */
|
||||
float *mpx_buffer;
|
||||
int8_t r;
|
||||
|
||||
/* PASIMPLE */
|
||||
pa_simple *device;
|
||||
pa_sample_spec format;
|
||||
|
||||
/* pthread */
|
||||
pthread_attr_t attr;
|
||||
pthread_t control_pipe_thread;
|
||||
pthread_mutex_t control_pipe_mutex = PTHREAD_MUTEX_INITIALIZER;
|
||||
pthread_cond_t control_pipe_cond;
|
||||
|
||||
|
||||
const char *short_opt = "R:i:s:r:p:T:A:P:l:e:L:d:C:"
|
||||
"hv";
|
||||
|
||||
struct option long_opt[] =
|
||||
{
|
||||
{"rds", required_argument, NULL, 'R'},
|
||||
{"pi", required_argument, NULL, 'i'},
|
||||
{"ps", required_argument, NULL, 's'},
|
||||
{"rt1", required_argument, NULL, 'r'},
|
||||
{"pty", required_argument, NULL, 'p'},
|
||||
{"tp", required_argument, NULL, 'T'},
|
||||
{"af", required_argument, NULL, 'A'},
|
||||
{"ptyn", required_argument, NULL, 'P'},
|
||||
{"lps", required_argument, NULL, 'l'},
|
||||
{"ecc", required_argument, NULL, 'e'},
|
||||
{"lic", required_argument, NULL, 'L'},
|
||||
{"di", required_argument, NULL, 'd'},
|
||||
{"ctl", required_argument, NULL, 'C'},
|
||||
|
||||
{"help", no_argument, NULL, 'h'},
|
||||
{"version", no_argument, NULL, 'v'},
|
||||
{ 0, 0, 0, 0 }
|
||||
};
|
||||
|
||||
memset(control_pipe, 0, 51);
|
||||
|
||||
keep_parsing_opts:
|
||||
|
||||
opt = getopt_long(argc, argv, short_opt, long_opt, NULL);
|
||||
if (opt == -1) goto done_parsing_opts;
|
||||
|
||||
switch (opt) {
|
||||
case 'i': /* pi */
|
||||
rds_params.pi = strtoul(optarg, NULL, 16);
|
||||
break;
|
||||
|
||||
case 's': /* ps */
|
||||
memcpy(rds_params.ps, xlat((unsigned char *)optarg), PS_LENGTH);
|
||||
break;
|
||||
|
||||
case 'r': /* rt1 */
|
||||
memcpy(rds_params.rt1, xlat((unsigned char *)optarg), RT_LENGTH);
|
||||
break;
|
||||
|
||||
case 'p': /* pty */
|
||||
rds_params.pty = strtoul(optarg, NULL, 10);
|
||||
break;
|
||||
|
||||
case 'T': /* tp */
|
||||
rds_params.tp = strtoul(optarg, NULL, 10);
|
||||
break;
|
||||
|
||||
case 'A': /* af */
|
||||
if (add_rds_af(&rds_params.af, strtof(optarg, NULL)) == 1) return 1;
|
||||
break;
|
||||
|
||||
case 'P': /* ptyn */
|
||||
memcpy(rds_params.ptyn, xlat((unsigned char *)optarg), PTYN_LENGTH);
|
||||
break;
|
||||
|
||||
case 'l': /* lps */
|
||||
memcpy(rds_params.lps, (unsigned char *)optarg, LPS_LENGTH);
|
||||
break;
|
||||
|
||||
case 'e': /* ecc */
|
||||
rds_params.ecc = strtoul(optarg, NULL, 16);
|
||||
break;
|
||||
|
||||
case 'L': /* lic */
|
||||
rds_params.lic = strtoul(optarg, NULL, 16);
|
||||
break;
|
||||
|
||||
case 'C': /* ctl */
|
||||
memcpy(control_pipe, optarg, 50);
|
||||
break;
|
||||
|
||||
case 'v': /* version */
|
||||
show_version();
|
||||
return 0;
|
||||
|
||||
case 'h': /* help */
|
||||
case '?':
|
||||
default:
|
||||
show_help(argv[0]);
|
||||
return 1;
|
||||
}
|
||||
|
||||
goto keep_parsing_opts;
|
||||
|
||||
done_parsing_opts:
|
||||
|
||||
/* Initialize pthread stuff */
|
||||
pthread_mutex_init(&control_pipe_mutex, NULL);
|
||||
pthread_cond_init(&control_pipe_cond, NULL);
|
||||
pthread_attr_init(&attr);
|
||||
|
||||
/* Setup buffers */
|
||||
mpx_buffer = malloc(NUM_MPX_FRAMES * 2 * sizeof(float));
|
||||
|
||||
/* Gracefully stop the encoder on SIGINT or SIGTERM */
|
||||
signal(SIGINT, stop);
|
||||
signal(SIGTERM, stop);
|
||||
|
||||
/* Initialize the RDS modulator */
|
||||
init_rds_encoder(rds_params);
|
||||
|
||||
/* PASIMPLE format */
|
||||
format.format = PA_SAMPLE_FLOAT32NE;
|
||||
format.channels = 1;
|
||||
format.rate = RDS_SAMPLE_RATE;
|
||||
|
||||
device = pa_simple_new(
|
||||
NULL, // Default PulseAudio server
|
||||
"MiniRDS", // Application name
|
||||
PA_STREAM_PLAYBACK, // Direction (playback)
|
||||
"RDS", // Default device
|
||||
"RDS Generator", // Stream description
|
||||
&format, // Sample format
|
||||
NULL, // Default channel map
|
||||
NULL, // Default buffering attributes
|
||||
NULL // Error variable
|
||||
);
|
||||
if (device == NULL) {
|
||||
fprintf(stderr, "Error: cannot open sound device.\n");
|
||||
goto exit;
|
||||
}
|
||||
|
||||
/* Initialize the control pipe reader */
|
||||
if (control_pipe[0]) {
|
||||
if (open_control_pipe(control_pipe) == 0) {
|
||||
fprintf(stderr, "Reading control commands on %s.\n", control_pipe);
|
||||
/* Create control pipe polling worker */
|
||||
r = pthread_create(&control_pipe_thread, &attr, control_pipe_worker, NULL);
|
||||
if (r < 0) {
|
||||
fprintf(stderr, "Could not create control pipe thread.\n");
|
||||
control_pipe[0] = 0;
|
||||
goto exit;
|
||||
} else {
|
||||
fprintf(stderr, "Created control pipe thread.\n");
|
||||
}
|
||||
} else {
|
||||
fprintf(stderr, "Failed to open control pipe: %s.\n", control_pipe);
|
||||
control_pipe[0] = 0;
|
||||
}
|
||||
}
|
||||
|
||||
int pulse_error;
|
||||
|
||||
for (;;) {
|
||||
for (size_t i = 0; i < NUM_MPX_FRAMES; i++) {
|
||||
mpx_buffer[i] = fminf(1.0f, fmaxf(-1.0f, get_rds_sample()));
|
||||
}
|
||||
|
||||
/* num_bytes = audio frames( * channels) * bytes per sample */
|
||||
if (pa_simple_write(device, mpx_buffer, NUM_MPX_FRAMES * sizeof(float), &pulse_error) != 0) {
|
||||
fprintf(stderr, "Error: could not play audio. (%s : %d)\n", pa_strerror(pulse_error), pulse_error);
|
||||
break;
|
||||
}
|
||||
|
||||
if (stop_rds) {
|
||||
fprintf(stderr, "Stopping the loop...\n");
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
exit:
|
||||
if (control_pipe[0]) {
|
||||
/* shut down threads */
|
||||
fprintf(stderr, "Waiting for pipe thread to shut down.\n");
|
||||
pthread_cond_signal(&control_pipe_cond);
|
||||
pthread_join(control_pipe_thread, NULL);
|
||||
}
|
||||
|
||||
pthread_attr_destroy(&attr);
|
||||
pa_simple_free(device);
|
||||
exit_rds_encoder();
|
||||
|
||||
free(mpx_buffer);
|
||||
|
||||
return 0;
|
||||
}
|
||||
Reference in New Issue
Block a user