mirror of
https://github.com/markqvist/OpenModem.git
synced 2024-10-01 03:15:46 -04:00
Improved data carrier detection
This commit is contained in:
parent
01c629a6fd
commit
b7ffba0e92
@ -61,6 +61,8 @@ void AFSK_init(Afsk *afsk) {
|
|||||||
AFSK_modem = afsk;
|
AFSK_modem = afsk;
|
||||||
// Set phase increment
|
// Set phase increment
|
||||||
afsk->phaseInc = MARK_INC;
|
afsk->phaseInc = MARK_INC;
|
||||||
|
afsk->silentSamples = 0;
|
||||||
|
|
||||||
// Initialise FIFO buffers
|
// Initialise FIFO buffers
|
||||||
fifo_init(&afsk->delayFifo, (uint8_t *)afsk->delayBuf, sizeof(afsk->delayBuf));
|
fifo_init(&afsk->delayFifo, (uint8_t *)afsk->delayBuf, sizeof(afsk->delayBuf));
|
||||||
fifo_init(&afsk->rxFifo, afsk->rxBuf, sizeof(afsk->rxBuf));
|
fifo_init(&afsk->rxFifo, afsk->rxBuf, sizeof(afsk->rxBuf));
|
||||||
@ -263,8 +265,12 @@ static bool hdlcParse(Hdlc *hdlc, bool bit, FIFOBuffer *fifo) {
|
|||||||
// If we have not yet seen a HDLC_FLAG indicating that
|
// If we have not yet seen a HDLC_FLAG indicating that
|
||||||
// a transmission is actually taking place, don't bother
|
// a transmission is actually taking place, don't bother
|
||||||
// with anything.
|
// with anything.
|
||||||
if (!hdlc->receiving)
|
if (!hdlc->receiving) {
|
||||||
|
hdlc->dcd = false;
|
||||||
|
hdlc->dcd_count = 0;
|
||||||
|
|
||||||
return ret;
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
// First check if what we are seeing is a stuffed bit.
|
// First check if what we are seeing is a stuffed bit.
|
||||||
// Since the different HDLC control characters like
|
// Since the different HDLC control characters like
|
||||||
@ -312,6 +318,8 @@ static bool hdlcParse(Hdlc *hdlc, bool bit, FIFOBuffer *fifo) {
|
|||||||
} else {
|
} else {
|
||||||
// If it is, abort and return false
|
// If it is, abort and return false
|
||||||
hdlc->receiving = false;
|
hdlc->receiving = false;
|
||||||
|
hdlc->dcd = false;
|
||||||
|
hdlc->dcd_count = 0;
|
||||||
LED_RX_OFF();
|
LED_RX_OFF();
|
||||||
ret = false;
|
ret = false;
|
||||||
}
|
}
|
||||||
@ -324,6 +332,8 @@ static bool hdlcParse(Hdlc *hdlc, bool bit, FIFOBuffer *fifo) {
|
|||||||
} else {
|
} else {
|
||||||
// If it is, well, you know by now!
|
// If it is, well, you know by now!
|
||||||
hdlc->receiving = false;
|
hdlc->receiving = false;
|
||||||
|
hdlc->dcd = false;
|
||||||
|
hdlc->dcd_count = 0;
|
||||||
LED_RX_OFF();
|
LED_RX_OFF();
|
||||||
ret = false;
|
ret = false;
|
||||||
}
|
}
|
||||||
@ -338,7 +348,6 @@ static bool hdlcParse(Hdlc *hdlc, bool bit, FIFOBuffer *fifo) {
|
|||||||
hdlc->currentByte >>= 1;
|
hdlc->currentByte >>= 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
//digitalWrite(13, LOW);
|
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -444,6 +453,9 @@ void AFSK_adc_isr(Afsk *afsk, int8_t currentSample) {
|
|||||||
} else {
|
} else {
|
||||||
afsk->currentPhase -= PHASE_INC;
|
afsk->currentPhase -= PHASE_INC;
|
||||||
}
|
}
|
||||||
|
afsk->silentSamples = 0;
|
||||||
|
} else {
|
||||||
|
afsk->silentSamples++;
|
||||||
}
|
}
|
||||||
|
|
||||||
// We increment our phase counter
|
// We increment our phase counter
|
||||||
@ -513,6 +525,12 @@ void AFSK_adc_isr(Afsk *afsk, int8_t currentSample) {
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
if (afsk->silentSamples > DCD_TIMEOUT_SAMPLES) {
|
||||||
|
afsk->silentSamples = 0;
|
||||||
|
afsk->hdlc.dcd = false;
|
||||||
|
LED_RX_OFF();
|
||||||
|
}
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
@ -53,6 +53,7 @@ inline static uint8_t sinSample(uint16_t i) {
|
|||||||
#define PHASE_INC 1 // Nudge by an eigth of a sample each adjustment
|
#define PHASE_INC 1 // Nudge by an eigth of a sample each adjustment
|
||||||
|
|
||||||
#define DCD_MIN_COUNT 6
|
#define DCD_MIN_COUNT 6
|
||||||
|
#define DCD_TIMEOUT_SAMPLES 96
|
||||||
|
|
||||||
#if BITRATE == 960
|
#if BITRATE == 960
|
||||||
#define FILTER_CUTOFF 600
|
#define FILTER_CUTOFF 600
|
||||||
@ -107,6 +108,8 @@ typedef struct Afsk
|
|||||||
uint16_t phaseAcc; // Phase accumulator
|
uint16_t phaseAcc; // Phase accumulator
|
||||||
uint16_t phaseInc; // Phase increment per sample
|
uint16_t phaseInc; // Phase increment per sample
|
||||||
|
|
||||||
|
uint8_t silentSamples; // How many samples were completely silent
|
||||||
|
|
||||||
FIFOBuffer txFifo; // FIFO for transmit data
|
FIFOBuffer txFifo; // FIFO for transmit data
|
||||||
uint8_t txBuf[CONFIG_AFSK_TX_BUFLEN]; // Actual data storage for said FIFO
|
uint8_t txBuf[CONFIG_AFSK_TX_BUFLEN]; // Actual data storage for said FIFO
|
||||||
|
|
||||||
|
2
main.c
2
main.c
@ -41,7 +41,7 @@ void init(void) {
|
|||||||
sei();
|
sei();
|
||||||
|
|
||||||
AFSK_init(&modem);
|
AFSK_init(&modem);
|
||||||
ax25_init(&AX25, &modem.fd, ax25_callback);
|
ax25_init(&AX25, &modem, &modem.fd, ax25_callback);
|
||||||
|
|
||||||
serial_init(&serial);
|
serial_init(&serial);
|
||||||
stdout = &serial.uart0;
|
stdout = &serial.uart0;
|
||||||
|
@ -12,11 +12,13 @@
|
|||||||
#define DECODE_CALL(buf, addr) for (unsigned i = 0; i < sizeof((addr)); i++) { char c = (*(buf)++ >> 1); (addr)[i] = (c == ' ') ? '\x0' : c; }
|
#define DECODE_CALL(buf, addr) for (unsigned i = 0; i < sizeof((addr)); i++) { char c = (*(buf)++ >> 1); (addr)[i] = (c == ' ') ? '\x0' : c; }
|
||||||
#define AX25_SET_REPEATED(msg, idx, val) do { if (val) { (msg)->rpt_flags |= _BV(idx); } else { (msg)->rpt_flags &= ~_BV(idx) ; } } while(0)
|
#define AX25_SET_REPEATED(msg, idx, val) do { if (val) { (msg)->rpt_flags |= _BV(idx); } else { (msg)->rpt_flags &= ~_BV(idx) ; } } while(0)
|
||||||
|
|
||||||
void ax25_init(AX25Ctx *ctx, FILE *channel, ax25_callback_t hook) {
|
void ax25_init(AX25Ctx *ctx, Afsk *modem, FILE *channel, ax25_callback_t hook) {
|
||||||
memset(ctx, 0, sizeof(*ctx));
|
memset(ctx, 0, sizeof(*ctx));
|
||||||
ctx->ch = channel;
|
ctx->ch = channel;
|
||||||
|
ctx->modem = modem;
|
||||||
ctx->hook = hook;
|
ctx->hook = hook;
|
||||||
ctx->crc_in = ctx->crc_out = CRC_CCIT_INIT_VAL;
|
ctx->crc_in = ctx->crc_out = CRC_CCIT_INIT_VAL;
|
||||||
|
ctx->ready_for_data = true;
|
||||||
}
|
}
|
||||||
|
|
||||||
static void ax25_decode(AX25Ctx *ctx) {
|
static void ax25_decode(AX25Ctx *ctx) {
|
||||||
@ -93,6 +95,7 @@ void ax25_poll(AX25Ctx *ctx) {
|
|||||||
}
|
}
|
||||||
ctx->escape = false;
|
ctx->escape = false;
|
||||||
}
|
}
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static void ax25_putchar(AX25Ctx *ctx, uint8_t c)
|
static void ax25_putchar(AX25Ctx *ctx, uint8_t c)
|
||||||
@ -103,6 +106,7 @@ static void ax25_putchar(AX25Ctx *ctx, uint8_t c)
|
|||||||
}
|
}
|
||||||
|
|
||||||
void ax25_sendRaw(AX25Ctx *ctx, void *_buf, size_t len) {
|
void ax25_sendRaw(AX25Ctx *ctx, void *_buf, size_t len) {
|
||||||
|
ctx->ready_for_data = false;
|
||||||
ctx->crc_out = CRC_CCIT_INIT_VAL;
|
ctx->crc_out = CRC_CCIT_INIT_VAL;
|
||||||
fputc(HDLC_FLAG, ctx->ch);
|
fputc(HDLC_FLAG, ctx->ch);
|
||||||
const uint8_t *buf = (const uint8_t *)_buf;
|
const uint8_t *buf = (const uint8_t *)_buf;
|
||||||
@ -115,6 +119,7 @@ void ax25_sendRaw(AX25Ctx *ctx, void *_buf, size_t len) {
|
|||||||
|
|
||||||
fputc(HDLC_FLAG, ctx->ch);
|
fputc(HDLC_FLAG, ctx->ch);
|
||||||
|
|
||||||
|
ctx->ready_for_data = true;
|
||||||
}
|
}
|
||||||
|
|
||||||
#if SERIAL_PROTOCOL == PROTOCOL_SIMPLE_SERIAL
|
#if SERIAL_PROTOCOL == PROTOCOL_SIMPLE_SERIAL
|
||||||
|
@ -4,6 +4,7 @@
|
|||||||
#include <stdio.h>
|
#include <stdio.h>
|
||||||
#include <stdbool.h>
|
#include <stdbool.h>
|
||||||
#include "device.h"
|
#include "device.h"
|
||||||
|
#include "hardware/AFSK.h"
|
||||||
|
|
||||||
#define AX25_MIN_FRAME_LEN 18
|
#define AX25_MIN_FRAME_LEN 18
|
||||||
#ifndef CUSTOM_FRAME_SIZE
|
#ifndef CUSTOM_FRAME_SIZE
|
||||||
@ -30,6 +31,7 @@ struct AX25Msg;
|
|||||||
|
|
||||||
typedef struct AX25Ctx {
|
typedef struct AX25Ctx {
|
||||||
uint8_t buf[AX25_MAX_FRAME_LEN];
|
uint8_t buf[AX25_MAX_FRAME_LEN];
|
||||||
|
Afsk *modem;
|
||||||
FILE *ch;
|
FILE *ch;
|
||||||
size_t frame_len;
|
size_t frame_len;
|
||||||
uint16_t crc_in;
|
uint16_t crc_in;
|
||||||
@ -37,6 +39,7 @@ typedef struct AX25Ctx {
|
|||||||
ax25_callback_t hook;
|
ax25_callback_t hook;
|
||||||
bool sync;
|
bool sync;
|
||||||
bool escape;
|
bool escape;
|
||||||
|
bool ready_for_data;
|
||||||
} AX25Ctx;
|
} AX25Ctx;
|
||||||
|
|
||||||
#if SERIAL_PROTOCOL == PROTOCOL_SIMPLE_SERIAL
|
#if SERIAL_PROTOCOL == PROTOCOL_SIMPLE_SERIAL
|
||||||
@ -68,6 +71,6 @@ typedef struct AX25Ctx {
|
|||||||
|
|
||||||
void ax25_poll(AX25Ctx *ctx);
|
void ax25_poll(AX25Ctx *ctx);
|
||||||
void ax25_sendRaw(AX25Ctx *ctx, void *_buf, size_t len);
|
void ax25_sendRaw(AX25Ctx *ctx, void *_buf, size_t len);
|
||||||
void ax25_init(AX25Ctx *ctx, FILE *channel, ax25_callback_t hook);
|
void ax25_init(AX25Ctx *ctx, Afsk *modem, FILE *channel, ax25_callback_t hook);
|
||||||
|
|
||||||
#endif
|
#endif
|
@ -80,8 +80,7 @@ void kiss_csma(AX25Ctx *ctx, uint8_t *buf, size_t len) {
|
|||||||
}
|
}
|
||||||
|
|
||||||
if (FLOWCONTROL) {
|
if (FLOWCONTROL) {
|
||||||
while (channel->sending_data) { /* Wait */ }
|
while (!ctx->ready_for_data) { /* Wait */ }
|
||||||
|
|
||||||
fputc(FEND, &serial->uart0);
|
fputc(FEND, &serial->uart0);
|
||||||
fputc(CMD_READY, &serial->uart0);
|
fputc(CMD_READY, &serial->uart0);
|
||||||
fputc(0x01, &serial->uart0);
|
fputc(0x01, &serial->uart0);
|
||||||
|
Loading…
Reference in New Issue
Block a user