mirror of
https://github.com/radio95-rnt/rds95.git
synced 2026-02-27 04:43:52 +01:00
50 lines
1.3 KiB
C
50 lines
1.3 KiB
C
#include "common.h"
|
|
#include "ascii_cmd.h"
|
|
#include "control_pipe.h"
|
|
#include "rds.h"
|
|
#include "modulator.h"
|
|
|
|
static int fd;
|
|
static struct pollfd poller;
|
|
|
|
int open_control_pipe(char *filename) {
|
|
fd = open(filename, O_RDONLY | O_NONBLOCK);
|
|
if (fd == -1) return -1;
|
|
|
|
poller.fd = fd;
|
|
poller.events = POLLIN;
|
|
return 0;
|
|
}
|
|
|
|
void poll_control_pipe(RDSModulator* mod) {
|
|
static char pipe_buf[CTL_BUFFER_SIZE];
|
|
static char cmd_buf[CMD_BUFFER_SIZE];
|
|
int bytes_read;
|
|
char *token;
|
|
|
|
if (poll(&poller, 1, READ_TIMEOUT_MS) <= 0) return;
|
|
if (!(poller.revents & POLLIN)) return;
|
|
|
|
memset(pipe_buf, 0, CTL_BUFFER_SIZE);
|
|
bytes_read = read(fd, pipe_buf, CTL_BUFFER_SIZE - 1);
|
|
|
|
if (bytes_read <= 0) return;
|
|
|
|
token = strtok((char *)pipe_buf, "\r\n");
|
|
if(token == NULL) token = strtok((char *)pipe_buf, "\x1A");
|
|
while (token != NULL) {
|
|
size_t cmd_len = strlen(token);
|
|
if (cmd_len > 0 && cmd_len < CMD_BUFFER_SIZE) {
|
|
memset(cmd_buf, 0, CMD_BUFFER_SIZE);
|
|
strncpy((char *)cmd_buf, token, CMD_BUFFER_SIZE - 1);
|
|
process_ascii_cmd(mod, cmd_buf);
|
|
}
|
|
token = strtok(NULL, "\r\n");
|
|
if(token == NULL) token = strtok(NULL, "\x1A");
|
|
}
|
|
}
|
|
|
|
void close_control_pipe() {
|
|
if (fd > 0) close(fd);
|
|
fd = -1;
|
|
} |