mirror of
https://github.com/radio95-rnt/rds95.git
synced 2026-02-27 04:43:52 +01:00
718 lines
22 KiB
C
718 lines
22 KiB
C
#include "common.h"
|
|
#include "rds.h"
|
|
#include "modulator.h"
|
|
#include "lib.h"
|
|
#include "ascii_cmd.h"
|
|
|
|
#define CMD_MATCHES(a) (strcmp(cmd, (char *)a) == 0)
|
|
|
|
typedef struct {
|
|
const char *cmd;
|
|
void (*handler)(char *arg, RDSModulator* mod, char* output);
|
|
uint8_t cmd_length;
|
|
} command_handler_t;
|
|
|
|
typedef struct {
|
|
const char *prefix;
|
|
const char *suffix;
|
|
void (*handler)(char *arg, char *pattern, RDSModulator* mod, char* output);
|
|
} pattern_command_handler_t;
|
|
|
|
static void handle_ptyn(char *arg, RDSModulator* mod, char* output) {
|
|
arg[PTYN_LENGTH] = 0;
|
|
set_rds_ptyn(mod->enc, xlat(arg));
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_afch(char *arg, RDSModulator* mod, char* output) {
|
|
if(arg[0] == '\0') {
|
|
memset(&(mod->enc->data[mod->enc->program].af), 0, sizeof(mod->enc->data[mod->enc->program].af));
|
|
return;
|
|
}
|
|
|
|
memset(&(mod->enc->data[mod->enc->program].af), 0, sizeof(mod->enc->data[mod->enc->program].af));
|
|
uint8_t arg_count;
|
|
RDSAFs new_af;
|
|
uint8_t af[MAX_AFS], *af_iter;
|
|
|
|
arg_count = sscanf((char *)arg,
|
|
"%hhx,%hhx,%hhx,%hhx,%hhx,"
|
|
"%hhx,%hhx,%hhx,%hhx,%hhx,"
|
|
"%hhx,%hhx,%hhx,%hhx,%hhx,"
|
|
"%hhx,%hhx,%hhx,%hhx,%hhx,"
|
|
"%hhx,%hhx,%hhx,%hhx,%hhx",
|
|
&af[0], &af[1], &af[2], &af[3], &af[4],
|
|
&af[5], &af[6], &af[7], &af[8], &af[9],
|
|
&af[10], &af[11], &af[12], &af[13], &af[14],
|
|
&af[15], &af[16], &af[17], &af[18], &af[19],
|
|
&af[20], &af[21], &af[22], &af[23], &af[24]);
|
|
|
|
af_iter = af;
|
|
memset(&new_af, 0, sizeof(RDSAFs));
|
|
|
|
while (arg_count-- != 0) {
|
|
uint8_t current_value = *af_iter;
|
|
float frequency = (875.0 + current_value) / 10.0;
|
|
add_rds_af(&new_af, frequency);
|
|
af_iter++;
|
|
}
|
|
|
|
memcpy(&(mod->enc->data[mod->enc->program].af), &new_af, sizeof(mod->enc->data[mod->enc->program].af));
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_tps(char *arg, RDSModulator* mod, char* output) {
|
|
arg[PS_LENGTH * 2] = 0;
|
|
set_rds_tps(mod->enc, xlat(arg));
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_rt1(char *arg, RDSModulator* mod, char* output) {
|
|
arg[RT_LENGTH * 2] = 0;
|
|
set_rds_rt1(mod->enc, xlat(arg));
|
|
if(mod->enc->data[mod->enc->program].eqtext1) set_rds_dps1(mod->enc, xlat(arg));
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_dps1(char *arg, RDSModulator* mod, char* output) {
|
|
arg[DPS_LENGTH * 2] = 0;
|
|
set_rds_dps1(mod->enc, xlat(arg));
|
|
if(mod->enc->data[mod->enc->program].eqtext1) set_rds_rt1(mod->enc, xlat(arg));
|
|
strcpy(output, "+\0");
|
|
}
|
|
static void handle_dps1mod(char *arg, RDSModulator* mod, char* output) {
|
|
mod->enc->data[mod->enc->program].dps1_mode = atoi(arg);
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_scrlspd(char *arg, RDSModulator* mod, char* output) {
|
|
mod->enc->data[mod->enc->program].dps_speed = atoi(arg);
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_dps1enq(char *arg, RDSModulator* mod, char* output) {
|
|
arg[127 * 2] = 0;
|
|
set_rds_next_dps1(mod->enc, xlat(arg));
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_pty(char *arg, RDSModulator* mod, char* output) {
|
|
mod->enc->data[mod->enc->program].pty = atoi(arg);
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_ecc(char *arg, RDSModulator* mod, char* output) {
|
|
mod->enc->data[mod->enc->program].ecc = strtoul(arg, NULL, 16);
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_lic(char *arg, RDSModulator* mod, char* output) {
|
|
mod->enc->data[mod->enc->program].lic = strtoul(arg, NULL, 16);
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_rtp(char *arg, RDSModulator* mod, char* output) {
|
|
uint8_t tags[6];
|
|
|
|
if (sscanf((char *)arg, "%hhu,%hhu,%hhu,%hhu,%hhu,%hhu", &tags[0], &tags[1], &tags[2], &tags[3], &tags[4], &tags[5]) == 6) {
|
|
set_rds_rtplus_tags(mod->enc, tags);
|
|
strcpy(output, "+\0");
|
|
} else {
|
|
strcpy(output, "-\0");
|
|
}
|
|
}
|
|
|
|
static void handle_lps(char *arg, RDSModulator* mod, char* output) {
|
|
arg[LPS_LENGTH] = 0;
|
|
set_rds_lps(mod->enc, arg);
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_pin(char *arg, RDSModulator* mod, char* output) {
|
|
uint8_t pin[3];
|
|
if (sscanf((char *)arg, "%hhu,%hhu,%hhu", &pin[0], &pin[1], &pin[2]) == 3) {
|
|
for (int i = 0; i < 3; i++) {
|
|
mod->enc->data[mod->enc->program].pin[i+1] = pin[i];
|
|
}
|
|
strcpy(output, "+\0");
|
|
} else {
|
|
strcpy(output, "-\0");
|
|
}
|
|
}
|
|
|
|
static void handle_ps(char *arg, RDSModulator* mod, char* output) {
|
|
arg[PS_LENGTH * 2] = 0;
|
|
set_rds_ps(mod->enc, xlat(arg));
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_ct(char *arg, RDSModulator* mod, char* output) {
|
|
arg[2] = 1;
|
|
mod->enc->data[mod->enc->program].ct = atoi(arg);
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_di(char *arg, RDSModulator* mod, char* output) {
|
|
mod->enc->data[mod->enc->program].di = atoi(arg);
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_tp(char *arg, RDSModulator* mod, char* output) {
|
|
mod->enc->data[mod->enc->program].tp = atoi(arg);
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_ta(char *arg, RDSModulator* mod, char* output) {
|
|
mod->enc->data[mod->enc->program].ta = atoi(arg);
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_ms(char *arg, RDSModulator* mod, char* output) {
|
|
mod->enc->data[mod->enc->program].ms = atoi(arg);
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_pi(char *arg, RDSModulator* mod, char* output) {
|
|
mod->enc->data[mod->enc->program].pi = strtoul(arg, NULL, 16);
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_af(char *arg, RDSModulator* mod, char* output) {
|
|
if (arg[0] == 'A' || arg[0] == 'B') {
|
|
strcpy(output, "-\0");
|
|
return;
|
|
}
|
|
if(arg[0] == '\0') {
|
|
memset(&(mod->enc->data[mod->enc->program].af), 0, sizeof(mod->enc->data[mod->enc->program].af));
|
|
return;
|
|
}
|
|
|
|
memset(&(mod->enc->data[mod->enc->program].af), 0, sizeof(mod->enc->data[mod->enc->program].af));
|
|
uint8_t arg_count;
|
|
RDSAFs new_af;
|
|
float af[MAX_AFS], *af_iter;
|
|
|
|
arg_count = sscanf((char *)arg,
|
|
"%f,%f,%f,%f,%f,"
|
|
"%f,%f,%f,%f,%f,"
|
|
"%f,%f,%f,%f,%f,"
|
|
"%f,%f,%f,%f,%f,"
|
|
"%f,%f,%f,%f,%f",
|
|
&af[0], &af[1], &af[2], &af[3], &af[4],
|
|
&af[5], &af[6], &af[7], &af[8], &af[9],
|
|
&af[10], &af[11], &af[12], &af[13], &af[14],
|
|
&af[15], &af[16], &af[17], &af[18], &af[19],
|
|
&af[20], &af[21], &af[22], &af[23], &af[24]);
|
|
|
|
af_iter = af;
|
|
memset(&new_af, 0, sizeof(RDSAFs));
|
|
|
|
while (arg_count-- != 0) {
|
|
add_rds_af(&new_af, *af_iter++);
|
|
}
|
|
|
|
memcpy(&(mod->enc->data[mod->enc->program].af), &new_af, sizeof(mod->enc->data[mod->enc->program].af));
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_g(char *arg, RDSModulator* mod, char* output) {
|
|
uint16_t blocks[3];
|
|
int count = sscanf((char *)arg, "%4hx%4hx%4hx", &blocks[0], &blocks[1], &blocks[2]);
|
|
if (count == 3) {
|
|
mod->enc->state[mod->enc->program].custom_group[0] = 1;
|
|
mod->enc->state[mod->enc->program].custom_group[1] = blocks[0];
|
|
mod->enc->state[mod->enc->program].custom_group[2] = blocks[1];
|
|
mod->enc->state[mod->enc->program].custom_group[3] = blocks[2];
|
|
strcpy(output, "+\0");
|
|
} else {
|
|
strcpy(output, "-\0");
|
|
}
|
|
}
|
|
|
|
static void handle_pinen(char *arg, RDSModulator* mod, char* output) {
|
|
mod->enc->data[mod->enc->program].pin[0] = atoi(arg);
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_rt1en(char *arg, RDSModulator* mod, char* output) {
|
|
mod->enc->data[mod->enc->program].rt1_enabled = atoi(arg);
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_dps1en(char *arg, RDSModulator* mod, char* output) {
|
|
mod->enc->data[mod->enc->program].dps1_enabled = atoi(arg);
|
|
mod->enc->state[mod->enc->program].ps_update = 1;
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_labper(char *arg, RDSModulator* mod, char* output) {
|
|
mod->enc->data[mod->enc->program].dps_label_period = atoi(arg);
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_spsper(char *arg, RDSModulator* mod, char* output) {
|
|
mod->enc->data[mod->enc->program].static_ps_period = atoi(arg);
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_ptynen(char *arg, RDSModulator* mod, char* output) {
|
|
mod->enc->data[mod->enc->program].ptyn_enabled = atoi(arg);
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_rtprun(char *arg, RDSModulator* mod, char* output) {
|
|
set_rds_rtplus_flags(mod->enc, atoi(arg));
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_eccen(char *arg, RDSModulator* mod, char* output) {
|
|
mod->enc->data[mod->enc->program].ecclic_enabled = arg[0];
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_shortrt(char *arg, RDSModulator* mod, char* output) {
|
|
mod->enc->data[mod->enc->program].shortrt = arg[0];
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_program(char *arg, RDSModulator* mod, char* output) {
|
|
int16_t program = atoi(arg)-1;
|
|
if(program == '\0') {
|
|
strcpy(output, "-\0");
|
|
return;
|
|
}
|
|
if(program >= PROGRAMS) program = (PROGRAMS-1);
|
|
if(program < 0) program = 0;
|
|
mod->enc->data[mod->enc->program].ta = 0;
|
|
mod->enc->data[(uint8_t)program].ta = 0;
|
|
mod->enc->program = (uint8_t)program;
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_grpseq(char *arg, RDSModulator* mod, char* output) {
|
|
if (arg[0] == '\0') {
|
|
set_rds_grpseq(mod->enc, DEFAULT_GRPSQC);
|
|
} else {
|
|
set_rds_grpseq(mod->enc, arg);
|
|
}
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_level(char *arg, RDSModulator* mod, char* output) {
|
|
mod->params.level = atoi(arg)/255.0f;
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_reset(char *arg, RDSModulator* mod, char* output) {
|
|
(void)arg;
|
|
loadFromFile(mod->enc);
|
|
for(int i = 0; i < PROGRAMS; i++) {
|
|
reset_rds_state(mod->enc, i);
|
|
}
|
|
Modulator_loadFromFile(&mod->params);
|
|
strcpy(output, "\0");
|
|
}
|
|
|
|
static void handle_rdsgen(char *arg, RDSModulator* mod, char* output) {
|
|
mod->params.rdsgen = atoi(arg);
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_udg1(char *arg, RDSModulator* mod, char* output) {
|
|
uint8_t all_scanned = 1, bad_format = 0;
|
|
uint16_t blocks[8][3];
|
|
int sets = 0;
|
|
char *ptr = arg;
|
|
|
|
while (sets < 8) {
|
|
int count = sscanf((char *)ptr, "%4hx%4hx%4hx",
|
|
&blocks[sets][0], &blocks[sets][1], &blocks[sets][2]);
|
|
|
|
if (count != 3) {
|
|
all_scanned = 0;
|
|
break;
|
|
}
|
|
|
|
sets++;
|
|
|
|
while (*ptr && *ptr != ',') {
|
|
ptr++;
|
|
}
|
|
|
|
if (*ptr == ',') {
|
|
ptr++;
|
|
} else {
|
|
bad_format = 1;
|
|
break;
|
|
}
|
|
}
|
|
|
|
memcpy(&(mod->enc->data[mod->enc->program].udg1), &blocks, sets * sizeof(uint16_t[3]));
|
|
mod->enc->data[mod->enc->program].udg1_len = sets;
|
|
if(bad_format) strcpy(output, "-\0");
|
|
else if(all_scanned) strcpy(output, "+\0");
|
|
else strcpy(output, "/\0");
|
|
}
|
|
static void handle_udg2(char *arg, RDSModulator* mod, char* output) {
|
|
uint8_t all_scanned = 1, bad_format = 0;
|
|
uint16_t blocks[8][3];
|
|
int sets = 0;
|
|
char *ptr = arg;
|
|
|
|
while (sets < 8) {
|
|
int count = sscanf((char *)ptr, "%4hx%4hx%4hx",
|
|
&blocks[sets][0], &blocks[sets][1], &blocks[sets][2]);
|
|
|
|
if (count != 3) {
|
|
all_scanned = 0;
|
|
break;
|
|
}
|
|
|
|
sets++;
|
|
|
|
while (*ptr && *ptr != ',') {
|
|
ptr++;
|
|
}
|
|
|
|
if (*ptr == ',') {
|
|
ptr++;
|
|
} else {
|
|
bad_format = 1;
|
|
break;
|
|
}
|
|
}
|
|
|
|
memcpy(&(mod->enc->data[mod->enc->program].udg2), &blocks, sets * sizeof(uint16_t[3]));
|
|
mod->enc->data[mod->enc->program].udg2_len = sets;
|
|
if(bad_format) strcpy(output, "-\0");
|
|
else if(all_scanned) strcpy(output, "+\0");
|
|
else strcpy(output, "/\0");
|
|
}
|
|
|
|
static void handle_init(char *arg, RDSModulator* mod, char* output) {
|
|
(void)arg;
|
|
set_rds_defaults(mod->enc, mod->enc->program);
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_ver(char *arg, RDSModulator* mod, char* output) {
|
|
(void)arg;
|
|
(void)mod;
|
|
strcpy(output, "Firmware v. 1.1a - (C) 2025 radio95\0");
|
|
}
|
|
|
|
static void handle_eonen(char *arg, char *pattern, RDSModulator* mod, char* output) {
|
|
mod->enc->data[mod->enc->program].eon[atoi(pattern)-1].enabled = atoi(arg);
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_eonpi(char *arg, char *pattern, RDSModulator* mod, char* output) {
|
|
mod->enc->data[mod->enc->program].eon[atoi(pattern)-1].pi = strtoul(arg, NULL, 16);
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_eonpin(char *arg, char *pattern, RDSModulator* mod, char* output) {
|
|
if (arg[0] == '\0') {
|
|
mod->enc->data[mod->enc->program].eon[atoi(pattern)-1].pin[0] = 0;
|
|
} else {
|
|
uint8_t pin[3];
|
|
if (sscanf((char *)arg, "%hhu,%hhu,%hhu", &pin[0], &pin[1], &pin[2]) == 3) {
|
|
for (int i = 0; i < 3; i++) {
|
|
mod->enc->data[mod->enc->program].eon[atoi(pattern)-1].pin[i + 1] = pin[i];
|
|
}
|
|
}
|
|
}
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_eonps(char *arg, char *pattern, RDSModulator* mod, char* output) {
|
|
arg[PS_LENGTH * 2] = 0;
|
|
|
|
RDSEON *eon = &mod->enc->data[mod->enc->program].eon[atoi(pattern)-1];
|
|
memset(eon->ps, ' ', sizeof(eon->ps));
|
|
|
|
uint16_t len = 0;
|
|
while (*arg != 0 && len < 24) eon->ps[len++] = *arg++;
|
|
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_eonpty(char *arg, char *pattern, RDSModulator* mod, char* output) {
|
|
mod->enc->data[mod->enc->program].eon[atoi(pattern)-1].pty = atoi(arg);
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_eonta(char *arg, char *pattern, RDSModulator* mod, char* output) {
|
|
if (!mod->enc->data[mod->enc->program].eon[atoi(pattern)-1].enabled ||
|
|
!mod->enc->data[mod->enc->program].eon[atoi(pattern)-1].tp) {
|
|
strcpy(output, "-\0");
|
|
return;
|
|
}
|
|
mod->enc->data[mod->enc->program].eon[atoi(pattern)-1].ta = atoi(arg);
|
|
if(mod->enc->data[mod->enc->program].eon[atoi(pattern)-1].ta) mod->enc->data[mod->enc->program].ta = 1;
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static void handle_eontp(char *arg, char *pattern, RDSModulator* mod, char* output) {
|
|
mod->enc->data[mod->enc->program].eon[atoi(pattern)-1].tp = atoi(arg);
|
|
strcpy(output, "+\0");
|
|
}
|
|
|
|
static const command_handler_t commands_eq3[] = {
|
|
{"MS", handle_ms, 2},
|
|
{"PS", handle_ps, 2},
|
|
{"PI", handle_pi, 2},
|
|
{"TP", handle_tp, 2},
|
|
{"TA", handle_ta, 2},
|
|
{"DI", handle_di, 2},
|
|
{"CT", handle_ct, 2},
|
|
{"AF", handle_af, 2}
|
|
};
|
|
|
|
static const command_handler_t commands_eq4[] = {
|
|
{"TPS", handle_tps, 3},
|
|
{"RT1", handle_rt1, 3},
|
|
{"PTY", handle_pty, 3},
|
|
{"ECC", handle_ecc, 3},
|
|
{"LIC", handle_lic, 3},
|
|
{"RTP", handle_rtp, 3},
|
|
{"LPS", handle_lps, 3},
|
|
{"PIN", handle_pin, 3},
|
|
{"DPS", handle_dps1, 3},
|
|
};
|
|
|
|
static const command_handler_t commands_eq5[] = {
|
|
{"TEXT", handle_rt1, 4},
|
|
{"DPS1", handle_dps1, 4},
|
|
{"PTYN", handle_ptyn, 4},
|
|
{"AFCH", handle_afch, 4},
|
|
{"UDG1", handle_udg1, 4},
|
|
{"UDG2", handle_udg2, 4},
|
|
};
|
|
|
|
static const command_handler_t commands_eq2[] = {
|
|
{"G", handle_g, 1}
|
|
};
|
|
|
|
static const command_handler_t commands_eq6[] = {
|
|
{"PINEN", handle_pinen, 5},
|
|
{"RT1EN", handle_rt1en, 5},
|
|
{"ECCEN", handle_eccen, 5},
|
|
{"LEVEL", handle_level, 5},
|
|
{"RESET", handle_reset, 5},
|
|
};
|
|
|
|
static const command_handler_t commands_eq7[] = {
|
|
{"PTYNEN", handle_ptynen, 6},
|
|
{"RTPRUN", handle_rtprun, 6},
|
|
{"GRPSEQ", handle_grpseq, 6},
|
|
{"RDSGEN", handle_rdsgen, 6},
|
|
{"DPS1EN", handle_dps1en, 6},
|
|
{"LABPER", handle_labper, 6},
|
|
{"SPSPER", handle_spsper, 6},
|
|
};
|
|
|
|
static const command_handler_t commands_eq8[] = {
|
|
{"SHORTRT", handle_shortrt, 7},
|
|
{"PROGRAM", handle_program, 7},
|
|
{"DPS1MOD", handle_dps1mod, 7},
|
|
{"SCRLSPD", handle_scrlspd, 7},
|
|
{"DPS1ENQ", handle_dps1enq, 7},
|
|
};
|
|
static const command_handler_t commands_eq10[] = {
|
|
{"PS_SCROLL", handle_dps1enq, 9},
|
|
};
|
|
|
|
static const command_handler_t commands_exact[] = {
|
|
{"INIT", handle_init, 4},
|
|
{"VER", handle_ver, 3},
|
|
// TODO: handle help, status
|
|
};
|
|
|
|
static const pattern_command_handler_t pattern_commands[] = {
|
|
{"EON", "EN", handle_eonen},
|
|
{"EON", "PI", handle_eonpi},
|
|
{"EON", "PIN", handle_eonpin},
|
|
{"EON", "PS", handle_eonps},
|
|
{"EON", "PTY", handle_eonpty},
|
|
{"EON", "TA", handle_eonta},
|
|
{"EON", "TP", handle_eontp},
|
|
};
|
|
|
|
static bool process_command_table(const command_handler_t *table, int table_size,
|
|
char *cmd, char *arg, char *output, RDSModulator* mod) {
|
|
for (int i = 0; i < table_size; i++) {
|
|
if (strcmp(cmd, (char *)table[i].cmd) == 0) {
|
|
table[i].handler(arg, mod, output);
|
|
return true;
|
|
}
|
|
}
|
|
return false;
|
|
}
|
|
|
|
static bool process_pattern_commands(char *cmd, char *arg, char *output, RDSModulator* mod) {
|
|
size_t cmd_len = strlen(cmd);
|
|
char pattern_buffer[16] = {0};
|
|
|
|
for (size_t i = 0; i < sizeof(pattern_commands) / sizeof(pattern_command_handler_t); i++) {
|
|
const pattern_command_handler_t *handler = &pattern_commands[i];
|
|
size_t prefix_len = strlen(handler->prefix);
|
|
size_t suffix_len = strlen(handler->suffix);
|
|
|
|
if (cmd_len > (prefix_len + suffix_len) &&
|
|
strncmp(cmd, handler->prefix, prefix_len) == 0 &&
|
|
strcmp(cmd + cmd_len - suffix_len, handler->suffix) == 0) {
|
|
|
|
size_t pattern_len = cmd_len - prefix_len - suffix_len;
|
|
if (pattern_len < sizeof(pattern_buffer)) {
|
|
strncpy(pattern_buffer, cmd + prefix_len, pattern_len);
|
|
pattern_buffer[pattern_len] = 0;
|
|
|
|
handler->handler(arg, pattern_buffer, mod, output);
|
|
return true;
|
|
}
|
|
}
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
void process_ascii_cmd(RDSModulator* mod, char *str) {
|
|
char *cmd, *arg;
|
|
char output[255];
|
|
memset(output, 0, sizeof(output));
|
|
char upper_str[CTL_BUFFER_SIZE];
|
|
|
|
uint16_t cmd_len = _strnlen((const char*)str, CTL_BUFFER_SIZE);
|
|
|
|
for(uint16_t i = 0; i < cmd_len; i++) {
|
|
if(str[i] == '\t') str[i] = ' ';
|
|
}
|
|
|
|
strncpy(upper_str, str, CTL_BUFFER_SIZE);
|
|
upper_str[CTL_BUFFER_SIZE-1] = '\0';
|
|
|
|
for(uint16_t i = 0; i < cmd_len && upper_str[i] != '='; i++) {
|
|
if(upper_str[i] >= 'a' && upper_str[i] <= 'z') {
|
|
upper_str[i] = upper_str[i] - 'a' + 'A';
|
|
}
|
|
}
|
|
|
|
for (size_t i = 0; i < sizeof(commands_exact) / sizeof(command_handler_t); i++) {
|
|
const command_handler_t *handler = &commands_exact[i];
|
|
if (cmd_len == handler->cmd_length && strcmp(upper_str, (char *)handler->cmd) == 0) {
|
|
handler->handler(NULL, mod, output);
|
|
return;
|
|
}
|
|
}
|
|
|
|
if (upper_str[0] == '*' && !strchr((const char*)upper_str, '=')) {
|
|
const char* option_str = upper_str + 1;
|
|
char option[32] = {0};
|
|
size_t copy_len = strlen(option_str);
|
|
if (copy_len >= sizeof(option))
|
|
copy_len = sizeof(option) - 1;
|
|
memcpy(option, option_str, copy_len);
|
|
option[copy_len] = '\0';
|
|
saveToFile(mod->enc, option);
|
|
Modulator_saveToFile(&mod->params, option);
|
|
return;
|
|
}
|
|
|
|
char *equals_pos = strchr(upper_str, '=');
|
|
if (equals_pos != NULL) {
|
|
cmd = upper_str;
|
|
cmd[equals_pos - upper_str] = 0;
|
|
arg = equals_pos + 1;
|
|
|
|
process_pattern_commands(cmd, arg, output, mod);
|
|
}
|
|
|
|
if (cmd_len > 1 && str[1] == '=') {
|
|
cmd = upper_str;
|
|
cmd[1] = 0;
|
|
arg = str + 2;
|
|
|
|
if (process_command_table(commands_eq2,
|
|
sizeof(commands_eq2) / sizeof(command_handler_t),
|
|
cmd, arg, output, mod)) {
|
|
}
|
|
}
|
|
|
|
if (cmd_len > 2 && str[2] == '=') {
|
|
cmd = upper_str;
|
|
cmd[2] = 0;
|
|
arg = str + 3;
|
|
|
|
if (process_command_table(commands_eq3,
|
|
sizeof(commands_eq3) / sizeof(command_handler_t),
|
|
cmd, arg, output, mod)) {
|
|
}
|
|
}
|
|
|
|
if (cmd_len > 3 && str[3] == '=') {
|
|
cmd = upper_str;
|
|
cmd[3] = 0;
|
|
arg = str + 4;
|
|
|
|
if (process_command_table(commands_eq4,
|
|
sizeof(commands_eq4) / sizeof(command_handler_t),
|
|
cmd, arg, output, mod)) {
|
|
}
|
|
}
|
|
|
|
if (cmd_len > 4 && str[4] == '=') {
|
|
cmd = upper_str;
|
|
cmd[4] = 0;
|
|
arg = str + 5;
|
|
|
|
if (process_command_table(commands_eq5,
|
|
sizeof(commands_eq5) / sizeof(command_handler_t),
|
|
cmd, arg, output, mod)) {
|
|
}
|
|
}
|
|
|
|
if (cmd_len > 5 && str[5] == '=') {
|
|
cmd = upper_str;
|
|
cmd[5] = 0;
|
|
arg = str + 6;
|
|
|
|
if (process_command_table(commands_eq6,
|
|
sizeof(commands_eq6) / sizeof(command_handler_t),
|
|
cmd, arg, output, mod)) {
|
|
}
|
|
}
|
|
|
|
if (cmd_len > 6 && str[6] == '=') {
|
|
cmd = upper_str;
|
|
cmd[6] = 0;
|
|
arg = str + 7;
|
|
|
|
if (process_command_table(commands_eq7,
|
|
sizeof(commands_eq7) / sizeof(command_handler_t),
|
|
cmd, arg, output, mod)) {
|
|
}
|
|
}
|
|
|
|
if (cmd_len > 7 && str[7] == '=') {
|
|
cmd = upper_str;
|
|
cmd[7] = 0;
|
|
arg = str + 8;
|
|
|
|
if (process_command_table(commands_eq8,
|
|
sizeof(commands_eq8) / sizeof(command_handler_t),
|
|
cmd, arg, output, mod)) {
|
|
}
|
|
}
|
|
|
|
if (cmd_len > 9 && str[9] == '=') {
|
|
cmd = upper_str;
|
|
cmd[9] = 0;
|
|
arg = str + 10;
|
|
|
|
if (process_command_table(commands_eq10,
|
|
sizeof(commands_eq10) / sizeof(command_handler_t),
|
|
cmd, arg, output, mod)) {
|
|
}
|
|
}
|
|
} |