/* * Copyright (C) OpenTX * * Based on code named * th9x - http://code.google.com/p/th9x * er9x - http://code.google.com/p/er9x * gruvin9x - http://code.google.com/p/gruvin9x * * License GPLv2: http://www.gnu.org/licenses/gpl-2.0.html * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * * This program 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. */ #ifndef _PULSES_ARM_H_ #define _PULSES_ARM_H_ #include "pulses/pxx2.h" #include "pulses/pxx1.h" #if NUM_MODULES == 2 #define MODULES_INIT(...) __VA_ARGS__, __VA_ARGS__ #else #define MODULES_INIT(...) __VA_ARGS__ #endif extern uint8_t s_current_protocol[NUM_MODULES]; extern uint8_t s_pulses_paused; extern uint16_t failsafeCounter[NUM_MODULES]; template struct PpmPulsesData { T pulses[20]; T * ptr; }; #if defined(PPM_PIN_SERIAL) PACK(struct Dsm2SerialPulsesData { uint8_t pulses[64]; uint8_t * ptr; uint8_t serialByte ; uint8_t serialBitCount; uint16_t _alignment; }); #else #define MAX_PULSES_TRANSITIONS 300 PACK(struct Dsm2TimerPulsesData { pulse_duration_t pulses[MAX_PULSES_TRANSITIONS]; pulse_duration_t * ptr; uint16_t rest; uint8_t index; }); #endif #define PPM_PERIOD_HALF_US(module) ((g_model.moduleData[module].ppm.frameLength * 5 + 225) * 200) /*half us*/ #define PPM_PERIOD(module) (PPM_PERIOD_HALF_US(module) / 2000) /*ms*/ #define DSM2_BAUDRATE 125000 #define DSM2_PERIOD 22 /*ms*/ #define SBUS_BAUDRATE 100000 #define SBUS_PERIOD_HALF_US ((g_model.moduleData[EXTERNAL_MODULE].sbus.refreshRate * 5 + 225) * 200) /*half us*/ #define SBUS_PERIOD (SBUS_PERIOD_HALF_US / 2000) /*ms*/ #define MULTIMODULE_BAUDRATE 100000 #define MULTIMODULE_PERIOD 7 /*ms*/ #define CROSSFIRE_FRAME_MAXLEN 64 PACK(struct CrossfirePulsesData { uint8_t pulses[CROSSFIRE_FRAME_MAXLEN]; }); union ModulePulsesData { #if defined(INTMODULE_USART) || defined(EXTMODULE_USART) UartPxxPulses pxx_uart; #endif #if defined(PPM_PIN_SERIAL) SerialPxxPulses pxx; #elif !defined(INTMODULE_USART) || !defined(EXTMODULE_USART) PwmPxxPulses pxx; #endif #if defined(PXX2) Pxx2Pulses pxx2; #endif #if defined(PPM_PIN_SERIAL) Dsm2SerialPulsesData dsm2; #else Dsm2TimerPulsesData dsm2; #endif PpmPulsesData ppm; CrossfirePulsesData crossfire; } __ALIGNED(4); /* The __ALIGNED keyword is required to align the struct inside the modulePulsesData below, * which is also defined to be __DMA (which includes __ALIGNED) aligned. * Arrays in C/C++ are always defined to be *contiguously*. The first byte of the second element is therefore always * sizeof(ModulePulsesData). __ALIGNED is required for sizeof(ModulePulsesData) to be a multiple of the alignment. */ /* TODO: internal pulsedata only needs 200 bytes vs 300 bytes for external, both use 300 byte since we have a common struct */ extern ModulePulsesData modulePulsesData[NUM_MODULES]; union TrainerPulsesData { PpmPulsesData ppm; }; extern TrainerPulsesData trainerPulsesData; extern const uint16_t CRCTable[]; void setupPulses(uint8_t port); void setupPulsesDSM2(uint8_t port); void setupPulsesMultimodule(uint8_t port); void setupPulsesSbus(uint8_t port); void setupPulsesPXX(uint8_t port); void setupPulsesPPMModule(uint8_t port); void setupPulsesPPMTrainer(); void sendByteDsm2(uint8_t b); void putDsm2Flush(); void putDsm2SerialBit(uint8_t bit); void sendByteSbus(uint8_t byte); #if defined(HUBSAN) void Hubsan_Init(); #endif inline void startPulses() { s_pulses_paused = false; #if defined(PCBTARANIS) || defined(PCBHORUS) setupPulses(INTERNAL_MODULE); setupPulses(EXTERNAL_MODULE); #else setupPulses(EXTERNAL_MODULE); #endif #if defined(HUBSAN) Hubsan_Init(); #endif } inline bool pulsesStarted() { return s_current_protocol[0] != 255; } inline void pausePulses() { s_pulses_paused = true; } inline void resumePulses() { s_pulses_paused = false; } #define SEND_FAILSAFE_NOW(idx) failsafeCounter[idx] = 1 inline void SEND_FAILSAFE_1S() { for (int i=0; i