#include <cfg/module.h>
+#define LOG_LEVEL AFSK_LOG_LEVEL
+#define LOG_FORMAT AFSK_LOG_FORMAT
+#include <cfg/log.h>
+
#include <cpu/power.h>
+#include <cpu/pgm.h>
#include <struct/fifobuf.h>
#include <string.h> /* memset */
* The rest of the wave is computed from this first quarter.
* This table is used to generate the modulated data.
*/
-static const uint8_t sin_table[] =
+static const uint8_t PROGMEM sin_table[] =
{
- //TODO put in flash!
128, 129, 131, 132, 134, 135, 137, 138, 140, 142, 143, 145, 146, 148, 149, 151,
152, 154, 155, 157, 158, 160, 162, 163, 165, 166, 167, 169, 170, 172, 173, 175,
176, 178, 179, 181, 182, 183, 185, 186, 188, 189, 190, 192, 193, 194, 196, 197,
ASSERT(idx < SIN_LEN);
uint16_t new_idx = idx % (SIN_LEN / 2);
new_idx = (new_idx >= (SIN_LEN / 4)) ? (SIN_LEN / 2 - new_idx - 1) : new_idx;
- return (idx >= (SIN_LEN / 2)) ? (255 - sin_table[new_idx]) : sin_table[new_idx];
+
+ #if CPU_HARVARD
+ uint8_t data = pgm_read_char(&sin_table[new_idx]);
+ #else
+ uint8_t data = sin_table[new_idx];
+ #endif
+
+ return (idx >= (SIN_LEN / 2)) ? (255 - data) : data;
}
#define BIT_DIFFER(bitline1, bitline2) (((bitline1) ^ (bitline2)) & 0x01)
#define EDGE_FOUND(bitline) BIT_DIFFER((bitline), (bitline) >> 1)
-
-static void hdlc_parse(Hdlc *hdlc, bool bit, FIFOBuffer *fifo)
+/**
+ * High-Level Data Link Control parsing function.
+ * Parse bitstream in order to find characters.
+ *
+ * \param hdlc HDLC context.
+ * \param bit current bit to be parsed.
+ * \param fifo FIFO buffer used to push characters.
+ *
+ * \return true if all is ok, false if the fifo is full.
+ */
+static bool hdlc_parse(Hdlc *hdlc, bool bit, FIFOBuffer *fifo)
{
+ bool ret = true;
+
hdlc->demod_bits <<= 1;
hdlc->demod_bits |= bit ? 1 : 0;
hdlc->rxstart = true;
}
else
+ {
+ ret = false;
hdlc->rxstart = false;
+ }
hdlc->currchar = 0;
hdlc->bit_idx = 0;
- return;
+ return ret;
}
/* Reset */
if ((hdlc->demod_bits & HDLC_RESET) == HDLC_RESET)
{
hdlc->rxstart = false;
- return;
+ return ret;
}
if (!hdlc->rxstart)
- return;
+ return ret;
/* Stuffed bit */
if ((hdlc->demod_bits & 0x3f) == 0x3e)
- return;
+ return ret;
if (hdlc->demod_bits & 0x01)
hdlc->currchar |= 0x80;
if (!fifo_isfull(fifo))
fifo_push(fifo, AX25_ESC);
else
+ {
hdlc->rxstart = false;
+ ret = false;
+ }
}
if (!fifo_isfull(fifo))
fifo_push(fifo, hdlc->currchar);
else
+ {
hdlc->rxstart = false;
+ ret = false;
+ }
hdlc->currchar = 0;
hdlc->bit_idx = 0;
- return;
}
+ else
+ hdlc->currchar >>= 1;
- hdlc->currchar >>= 1;
+ return ret;
}
* ADC ISR callback.
* This function has to be called by the ADC ISR when a sample of the configured
* channel is available.
- * \param af Afsk context to operate one (\see Afsk).
+ * \param af Afsk context to operate on.
* \param curr_sample current sample from the ADC.
*/
void afsk_adc_isr(Afsk *af, int8_t curr_sample)
* NRZI coding: if 2 consecutive bits have the same value
* a 1 is received, otherwise it's a 0.
*/
- hdlc_parse(&af->hdlc, !EDGE_FOUND(af->found_bits), &af->rx_fifo);
+ if (!hdlc_parse(&af->hdlc, !EDGE_FOUND(af->found_bits), &af->rx_fifo))
+ af->status |= AFSK_RXFIFO_OVERRUN;
}
* This function has to be called by the DAC ISR when a sample of the configured
* channel has been converted out.
*
- * \param af Afsk context to operate one (\see Afsk).
+ * \param af Afsk context to operate on.
*
- * \note The next DAC output sample is supplied by the Afsk driver through calling
- * the AFSK_DAC_SET() callback.
+ * \return The next DAC output sample.
*/
-void afsk_dac_isr(Afsk *af)
+uint8_t afsk_dac_isr(Afsk *af)
{
+ AFSK_STROBE_ON();
+
/* Check if we are at a start of a sample cycle */
if (af->sample_count == 0)
{
{
AFSK_DAC_IRQ_STOP(af->dac_ch);
af->sending = false;
- return;
+ AFSK_STROBE_OFF();
+ return 0;
}
else
{
/*
- * If we have just finished af->sending an unstuffed byte,
+ * If we have just finished sending an unstuffed byte,
* reset bitstuff counter.
*/
if (!af->bit_stuff)
{
AFSK_DAC_IRQ_STOP(af->dac_ch);
af->sending = false;
- return;
+ AFSK_STROBE_OFF();
+ return 0;
}
else
af->curr_out = fifo_pop(&af->tx_fifo);
/*
* Transmit a 1:
* - Stay on the previous tone
- * - Increace bit stuff count
+ * - Increase bit stuff counter
*/
af->stuff_cnt++;
}
{
/*
* Transmit a 0:
- * - Reset bit stuff count
+ * - Reset bit stuff counter
* - Switch tone
*/
af->stuff_cnt = 0;
af->phase_acc += af->phase_inc;
af->phase_acc %= SIN_LEN;
- AFSK_DAC_SET(af->dac_ch, sin_sample(af->phase_acc));
af->sample_count--;
+ AFSK_STROBE_OFF();
+ return sin_sample(af->phase_acc);
}
return 0;
}
+static int afsk_error(KFile *fd)
+{
+ Afsk *af = AFSK_CAST(fd);
+ int err;
+
+ ATOMIC(err = af->status);
+ return err;
+}
+
+static void afsk_clearerr(KFile *fd)
+{
+ Afsk *af = AFSK_CAST(fd);
+ ATOMIC(af->status = 0);
+}
+
/**
* Initialize an AFSK1200 modem.
- * \param af Afsk context to operate one (\see Afsk).
+ * \param af Afsk context to operate on.
* \param adc_ch ADC channel used by the demodulator.
* \param dac_ch DAC channel used by the modulator.
*/
AFSK_ADC_INIT(adc_ch, af);
AFSK_DAC_INIT(dac_ch, af);
AFSK_STROBE_INIT();
- kprintf("MARK_INC %d, SPACE_INC %d\n", MARK_INC, SPACE_INC);
+ LOG_INFO("MARK_INC %d, SPACE_INC %d\n", MARK_INC, SPACE_INC);
DB(af->fd._type = KFT_AFSK);
af->fd.write = afsk_write;
af->fd.read = afsk_read;
af->fd.flush = afsk_flush;
+ af->fd.error = afsk_error;
+ af->fd.clearerr = afsk_clearerr;
af->phase_inc = MARK_INC;
}
projects / bertos.git / blobdiff