60 lines
1.0 KiB
C
60 lines
1.0 KiB
C
|
|
#include <cpu/irq.h>
|
|
#include <cfg/debug.h>
|
|
|
|
#include "afsk.h" // Header for AFSK modem
|
|
#include "protocol/mp1.h" // Header for MP.1 protocol
|
|
|
|
#include <drv/ser.h>
|
|
#include <drv/timer.h>
|
|
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
|
|
static Afsk afsk;
|
|
static Serial ser;
|
|
|
|
static MP1 mp1;
|
|
|
|
#define ADC_CH 0
|
|
|
|
#define TEST_PACKET "Test MP1 AFSK Packet!"
|
|
|
|
static void mp1Callback(struct MP1Packet *packet) {
|
|
kfile_printf(&ser.fd, "\nMP1 Packet Received:\n");
|
|
kfile_printf(&ser.fd, "%.*s\r\n", packet->dataLength, packet->data);
|
|
}
|
|
|
|
static void init(void)
|
|
{
|
|
IRQ_ENABLE;
|
|
kdbg_init();
|
|
timer_init();
|
|
|
|
afsk_init(&afsk, ADC_CH, 0);
|
|
mp1Init(&mp1, &afsk.fd, mp1Callback);
|
|
|
|
|
|
ser_init(&ser, SER_UART0);
|
|
ser_setbaudrate(&ser, 115200);
|
|
}
|
|
|
|
int main(void)
|
|
{
|
|
init();
|
|
ticks_t start = timer_clock();
|
|
|
|
while (1)
|
|
{
|
|
mp1Poll(&mp1);
|
|
|
|
// Periodically send test data
|
|
if (timer_clock() - start > ms_to_ticks(4000L))
|
|
{
|
|
kputs("Test TX\n");
|
|
start = timer_clock();
|
|
mp1Send(&mp1, TEST_PACKET, sizeof(TEST_PACKET));
|
|
}
|
|
}
|
|
return 0;
|
|
} |