kopia lustrzana https://github.com/sq8vps/vp-digi
141 wiersze
3.6 KiB
C
141 wiersze
3.6 KiB
C
/*
|
|
This file is part of VP-Digi.
|
|
|
|
VP-Digi is free software: you can redistribute it and/or modify
|
|
it under the terms of the GNU General Public License as published by
|
|
the Free Software Foundation; either version 3 of the License, or
|
|
(at your option) any later version.
|
|
|
|
VP-Digi is distributed in the hope that it will be useful,
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
GNU General Public License for more details.
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
along with VP-Digi. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include "beacon.h"
|
|
#include "digipeater.h"
|
|
#include "common.h"
|
|
#include <string.h>
|
|
#include "ax25.h"
|
|
#include "terminal.h"
|
|
#include "drivers/systick.h"
|
|
|
|
uint32_t beaconDelay[8] = {0};
|
|
|
|
|
|
|
|
/**
|
|
* @brief Send specified beacon
|
|
* @param[in] no Beacon number (0-7)
|
|
*/
|
|
void Beacon_send(uint8_t no)
|
|
{
|
|
if(beacon[no].enable == 0)
|
|
return; //beacon disabled
|
|
|
|
uint8_t buf[150] = {0}; //frame buffer
|
|
uint16_t idx = 0;
|
|
|
|
for(uint8_t i = 0; i < 7; i++) //add destination address
|
|
buf[idx++] = dest[i];
|
|
|
|
for(uint8_t i = 0; i < 6; i++) //add source address
|
|
buf[idx++] = call[i];
|
|
|
|
buf[idx++] = ((callSsid << 1) + 0b01100000); //add source ssid
|
|
|
|
if(beacon[no].path[0] > 0) //this beacon has some path set
|
|
{
|
|
for(uint8_t i = 0; i < 14; i++) //loop through path
|
|
{
|
|
if((beacon[no].path[i] > 0) || (i == 6) || (i == 13)) //normal data, not a NULL symbol
|
|
{
|
|
buf[idx] = (beacon[no].path[i] << 1); //copy path
|
|
if((i == 6) || (i == 13)) //it was and ssid
|
|
{
|
|
buf[idx] += 0b01100000; //add appripriate bits for ssid
|
|
}
|
|
idx++;
|
|
}
|
|
else //NULL in path
|
|
break; //end here
|
|
}
|
|
}
|
|
buf[idx - 1] |= 1; //add c-bit on the last element
|
|
buf[idx++] = 0x03; //control
|
|
buf[idx++] = 0xF0; //pid
|
|
for(uint8_t i = 0; i < strlen((char*)beacon[no].data); i++)
|
|
{
|
|
buf[idx++] = beacon[no].data[i]; //copy beacon comment
|
|
}
|
|
|
|
if((FRAMEBUFLEN - ax25.xmitIdx) > (idx + 2)) //check for free space in TX buffer
|
|
{
|
|
uint16_t frameStart = ax25.xmitIdx; //store index
|
|
|
|
for(uint8_t i = 0; i < idx; i++)
|
|
{
|
|
ax25.frameXmit[ax25.xmitIdx++] = buf[i]; //copy frame to main TX buffer
|
|
}
|
|
|
|
if(kissMonitor) //monitoring mode, send own frames to KISS ports
|
|
{
|
|
SendKiss(ax25.frameXmit, ax25.xmitIdx);
|
|
}
|
|
|
|
ax25.frameXmit[ax25.xmitIdx++] = 0xFF; //frame separator
|
|
Digi_storeDeDupeFromXmitBuf(frameStart); //store frame hash in duplicate protection buffer (to prevent from digipeating own packets)
|
|
|
|
uint8_t bufto[200];
|
|
common_toTNC2((uint8_t *)&ax25.frameXmit[frameStart], ax25.xmitIdx - frameStart - 1, bufto);
|
|
|
|
term_sendMonitor((uint8_t*)"(AX.25) Transmitting beacon ", 0);
|
|
|
|
term_sendMonitorNumber(no);
|
|
term_sendMonitor((uint8_t*)": ", 0);
|
|
term_sendMonitor(bufto, 0);
|
|
term_sendMonitor((uint8_t*)"\r\n", 0);
|
|
}
|
|
|
|
|
|
|
|
}
|
|
|
|
/**
|
|
* @brief Check if any beacon should be transmitted and transmit if neccessary
|
|
*/
|
|
void Beacon_check(void)
|
|
{
|
|
for(uint8_t i = 0; i < 8; i++)
|
|
{
|
|
if(beacon[i].enable == 0)
|
|
return;
|
|
|
|
if((beacon[i].interval > 0) && ((ticks >= beacon[i].next) || (beacon[i].next == 0)))
|
|
{
|
|
if(beaconDelay[i] > ticks) //check for beacon delay (only for the very first transmission)
|
|
return;
|
|
beacon[i].next = ticks + beacon[i].interval; //save next beacon timestamp
|
|
beaconDelay[i] = 0;
|
|
Beacon_send(i);
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
* @brief Initialize beacon module
|
|
*/
|
|
void Beacon_init(void)
|
|
{
|
|
for(uint8_t i = 0; i < 8; i++)
|
|
{
|
|
beaconDelay[i] = (beacon[i].delay * 100) + ticks + 3000; //set delay for beacons and add constant 30 seconds of delay
|
|
beacon[i].next = 0;
|
|
}
|
|
}
|
|
|