mirror of
https://codeberg.org/libreboot/lbmk.git
synced 2026-07-21 19:26:22 +02:00
Leah Rowe
a61ab37b67
This version of spkmodem uses err() to indicate an error, and the value of errno is used as exit status at all times, even when it is zero. When calling err(), it is intended that errno always be non-zero, so modify the code accordingly. Signed-off-by: Leah Rowe <leah@libreboot.org>
140 lines
2.6 KiB
C
140 lines
2.6 KiB
C
/* spkmodem-recv.c - decode spkmodem signals */
|
|
/* SPDX-License-Identifier: GPL-2.0-or-later */
|
|
|
|
#include <err.h>
|
|
#include <errno.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <unistd.h>
|
|
|
|
/* Compilation: gcc -o spkmodem-recv spkmodem-recv */
|
|
/* Usage: parec --channels=1 --rate=48000 --format=s16le | ./spkmodem-recv */
|
|
|
|
#define SAMPLES_PER_FRAME 240
|
|
#define FREQ_SEP_MIN 5
|
|
#define FREQ_SEP_MAX 15
|
|
#define FREQ_DATA_MIN 15
|
|
#define FREQ_DATA_THRESHOLD 25
|
|
#define FREQ_DATA_MAX 60
|
|
#define THRESHOLD 500
|
|
|
|
#define DEBUG 0
|
|
#define FLUSH_TIMEOUT 1
|
|
#define ERR() (errno = errno ? errno : ECANCELED)
|
|
|
|
signed short frame[2 * SAMPLES_PER_FRAME];
|
|
signed short pulse[2 * SAMPLES_PER_FRAME];
|
|
int f1, f2, lp, ascii_bit = 7;
|
|
char ascii = 0;
|
|
|
|
void handle_audio(void);
|
|
void print_char(void);
|
|
void fetch_sample(void);
|
|
void read_frame(int ringpos);
|
|
|
|
int
|
|
main(int argc, char *argv[])
|
|
{
|
|
int c;
|
|
|
|
#ifdef __OpenBSD__
|
|
if (pledge("stdio", NULL) == -1)
|
|
err(ERR(), "pledge");
|
|
#endif
|
|
|
|
while ((c = getopt(argc, argv, "u")) != -1) {
|
|
switch (c) {
|
|
case 'u':
|
|
setvbuf(stdout, NULL, _IONBF, 0);
|
|
break;
|
|
default:
|
|
err(errno = EINVAL, NULL);
|
|
}
|
|
}
|
|
|
|
while (!feof(stdin))
|
|
handle_audio();
|
|
|
|
return errno;
|
|
}
|
|
|
|
void
|
|
handle_audio(void)
|
|
{
|
|
static int llp = 0;
|
|
|
|
if (lp > (3 * SAMPLES_PER_FRAME)) {
|
|
ascii_bit = 7;
|
|
ascii = 0;
|
|
lp = 0;
|
|
llp++;
|
|
}
|
|
if (llp == FLUSH_TIMEOUT)
|
|
if (fflush(stdout) == EOF)
|
|
err(ERR(), NULL);
|
|
|
|
if ((f2 <= FREQ_SEP_MIN) || (f2 >= FREQ_SEP_MAX)
|
|
|| (f1 <= FREQ_DATA_MIN) || (f1 >= FREQ_DATA_MAX)) {
|
|
fetch_sample();
|
|
return;
|
|
}
|
|
|
|
print_char();
|
|
|
|
lp = llp = 0;
|
|
for (int sample = 0; sample < SAMPLES_PER_FRAME; sample++)
|
|
fetch_sample();
|
|
}
|
|
|
|
void
|
|
fetch_sample(void)
|
|
{
|
|
static int ringpos = 0;
|
|
|
|
f1 -= pulse[ringpos];
|
|
f1 += pulse[(ringpos + SAMPLES_PER_FRAME) % (2 * SAMPLES_PER_FRAME)];
|
|
f2 -= pulse[(ringpos + SAMPLES_PER_FRAME) % (2 * SAMPLES_PER_FRAME)];
|
|
read_frame(ringpos);
|
|
|
|
pulse[ringpos] = (abs(frame[ringpos]) > THRESHOLD) ? 1 : 0;
|
|
if (pulse[ringpos++])
|
|
++f2;
|
|
ringpos %= 2 * SAMPLES_PER_FRAME;
|
|
++lp;
|
|
}
|
|
|
|
void
|
|
read_frame(int ringpos)
|
|
{
|
|
if (fread(frame + ringpos, 1, sizeof(frame[0]), stdin)
|
|
!= sizeof(frame[0]))
|
|
err(ERR(), "Could not read from frame.");
|
|
if (ferror(stdin) != 0)
|
|
err(ERR(), "Could not read from frame");
|
|
}
|
|
|
|
void
|
|
print_char(void)
|
|
{
|
|
#if DEBUG
|
|
long stdin_pos = 0;
|
|
if ((stdin_pos = ftell(stdin)) == -1)
|
|
err(ERR(), NULL);
|
|
printf ("%d %d %d @%ld\n", f1, f2, FREQ_DATA_THRESHOLD,
|
|
stdin_pos - sizeof(frame));
|
|
#endif
|
|
if (f1 < FREQ_DATA_THRESHOLD)
|
|
ascii |= (1 << ascii_bit);
|
|
ascii_bit--;
|
|
if (ascii_bit < 0) {
|
|
#if DEBUG
|
|
printf("<%c, %x>", ascii, ascii);
|
|
#else
|
|
printf("%c", ascii);
|
|
#endif
|
|
ascii_bit = 7;
|
|
ascii = 0;
|
|
}
|
|
}
|