mirror of
https://github.com/betaflight/betaflight.git
synced 2025-07-13 11:29:58 +03:00
ed6a4a4769
* trailing space removal Co-authored-by: Petr Ledvina <ledvinap@gmail.com> * deduplicate empty lines --------- Co-authored-by: Petr Ledvina <ledvinap@gmail.com> Co-authored-by: Mark Haslinghuis <mark@numloq.nl>
74 lines
2.7 KiB
C
74 lines
2.7 KiB
C
/*
|
|
* This file is part of Cleanflight and Betaflight.
|
|
*
|
|
* Cleanflight and Betaflight are free software. You can redistribute
|
|
* this software and/or modify this software 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 and Betaflight are distributed in the hope that they
|
|
* 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 this software.
|
|
*
|
|
* If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include <stdbool.h>
|
|
#include <stdint.h>
|
|
#include <string.h>
|
|
|
|
#include "platform.h"
|
|
|
|
#ifdef USE_TRANSPONDER
|
|
|
|
#include "drivers/transponder_ir.h"
|
|
#include "drivers/transponder_ir_arcitimer.h"
|
|
|
|
#if defined(STM32F4) || defined(STM32F7) || defined(STM32H7) || defined(STM32G4) || defined(APM32F4) || defined(UNIT_TEST)
|
|
|
|
extern const struct transponderVTable arcitimerTansponderVTable;
|
|
static uint16_t dmaBufferOffset;
|
|
|
|
void transponderIrInitArcitimer(transponder_t *transponder)
|
|
{
|
|
// from drivers/transponder_ir.h
|
|
transponder->gap_toggles = TRANSPONDER_GAP_TOGGLES_ARCITIMER;
|
|
transponder->dma_buffer_size = TRANSPONDER_DMA_BUFFER_SIZE_ARCITIMER;
|
|
transponder->vTable = &arcitimerTansponderVTable;
|
|
transponder->timer_hz = TRANSPONDER_TIMER_MHZ_ARCITIMER;
|
|
transponder->timer_carrier_hz = TRANSPONDER_CARRIER_HZ_ARCITIMER;
|
|
memset(&(transponder->transponderIrDMABuffer.arcitimer), 0, sizeof(transponder->transponderIrDMABuffer.arcitimer));
|
|
}
|
|
|
|
void updateTransponderDMABufferArcitimer(transponder_t *transponder, const uint8_t* transponderData)
|
|
{
|
|
uint8_t byteIndex;
|
|
uint8_t bitIndex;
|
|
uint8_t hightStateIndex;
|
|
for (byteIndex = 0; byteIndex < TRANSPONDER_DATA_LENGTH_ARCITIMER; byteIndex++) {
|
|
uint8_t byteToSend = *transponderData;
|
|
transponderData++;
|
|
for (bitIndex = 0; bitIndex < TRANSPONDER_BITS_PER_BYTE_ARCITIMER; bitIndex++)
|
|
{
|
|
bool isHightState = byteToSend & (1 << (bitIndex));
|
|
for (hightStateIndex = 0; hightStateIndex < TRANSPONDER_TOGGLES_PER_BIT_ARCITIMER; hightStateIndex++)
|
|
{
|
|
transponder->transponderIrDMABuffer.arcitimer[dmaBufferOffset] = isHightState ? transponder->bitToggleOne : 0;
|
|
dmaBufferOffset++;
|
|
}
|
|
}
|
|
}
|
|
dmaBufferOffset = 0;
|
|
}
|
|
|
|
const struct transponderVTable arcitimerTansponderVTable = {
|
|
updateTransponderDMABufferArcitimer,
|
|
};
|
|
|
|
#endif
|
|
#endif
|