mirror of
https://github.com/betaflight/betaflight.git
synced 2025-07-24 16:55:36 +03:00
6d32aa5d7b
Implementation is DMA buffer based, just like the WS2811 LED Strip code, so that there is minimal impact on flight performance. Currently the code is mutually exclusive with the LED_STRIP code and there is no means to set the transponder code.
107 lines
2.5 KiB
C
107 lines
2.5 KiB
C
/*
|
|
* This file is part of Cleanflight.
|
|
*
|
|
* Cleanflight 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.
|
|
*
|
|
* Cleanflight 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 Cleanflight. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include <stdbool.h>
|
|
#include <stdlib.h>
|
|
#include <stdint.h>
|
|
#include <string.h>
|
|
#include <stdarg.h>
|
|
|
|
#include <platform.h>
|
|
|
|
#include <build_config.h>
|
|
|
|
#include "drivers/transponder_ir.h"
|
|
#include "drivers/system.h"
|
|
|
|
#include "io/transponder_ir.h"
|
|
#include "config/config.h"
|
|
|
|
static bool transponderInitialised = false;
|
|
static bool transponderRepeat = false;
|
|
|
|
// timers
|
|
static uint32_t nextUpdateAt = 0;
|
|
|
|
#define JITTER_DURATION_COUNT (sizeof(jitterDurations) / sizeof(uint8_t))
|
|
static uint8_t jitterDurations[] = {0,9,4,8,3,9,6,7,1,6,9,7,8,2,6};
|
|
|
|
void updateTransponder(void)
|
|
{
|
|
static uint32_t jitterIndex = 0;
|
|
|
|
if (!(transponderInitialised && transponderRepeat && isTransponderIrReady())) {
|
|
return;
|
|
}
|
|
|
|
uint32_t now = micros();
|
|
|
|
bool updateNow = (int32_t)(now - nextUpdateAt) >= 0L;
|
|
if (!updateNow) {
|
|
return;
|
|
}
|
|
|
|
// TODO use a random number genenerator for random jitter? The idea here is to avoid multiple transmitters transmitting at the same time.
|
|
uint32_t jitter = (1000 * jitterDurations[jitterIndex++]);
|
|
if (jitterIndex >= JITTER_DURATION_COUNT) {
|
|
jitterIndex = 0;
|
|
}
|
|
|
|
nextUpdateAt = now + 4500 + jitter;
|
|
|
|
transponderIrTransmit();
|
|
}
|
|
|
|
void transponderInit(uint8_t* transponderData)
|
|
{
|
|
transponderInitialised = false;
|
|
transponderIrInit();
|
|
transponderIrUpdateData(transponderData);
|
|
}
|
|
|
|
void transponderEnable(void)
|
|
{
|
|
transponderInitialised = true;
|
|
}
|
|
|
|
void transponderDisable(void)
|
|
{
|
|
transponderInitialised = false;
|
|
}
|
|
|
|
void transponderStopRepeating(void)
|
|
{
|
|
transponderRepeat = false;
|
|
}
|
|
|
|
void transponderStartRepeating(void)
|
|
{
|
|
transponderRepeat = true;
|
|
}
|
|
|
|
void transponderUpdateData(uint8_t* transponderData)
|
|
{
|
|
transponderIrUpdateData(transponderData);
|
|
}
|
|
|
|
void transponderTransmitOnce(void) {
|
|
|
|
if (!transponderInitialised) {
|
|
return;
|
|
}
|
|
transponderIrTransmit();
|
|
}
|