AFHDS2 fixes

This commit is contained in:
Raphael Coeffic
2022-03-20 16:22:12 +01:00
parent 7c05f7295e
commit b7523e489b
5 changed files with 30 additions and 10 deletions
+2
View File
@@ -20,6 +20,8 @@
*/
#include "afhds2.h"
#include "flysky.h"
#include "intmodule_serial_driver.h"
etx_serial_init afhds2SerialInitParams = {
.baudrate = INTMODULE_USART_AFHDS2_BAUDRATE,
+2
View File
@@ -27,6 +27,8 @@
#include <map>
#include <list>
#include "hal/serial_driver.h"
#define AFHDS2_PERIOD (2 * 1000) /* us */
struct FlySkySerialPulsesData {
+2 -2
View File
@@ -364,7 +364,7 @@ static void enablePulsesInternalModule(uint8_t protocol)
// serial port setup
resetPulsesAFHDS2();
intmoduleFifo.clear();
IntmoduleSerialDriver.init(&afhds2SerialInitParams)
IntmoduleSerialDriver.init(&afhds2SerialInitParams);
// mixer setup
mixerSchedulerSetPeriod(INTERNAL_MODULE, AFHDS2_PERIOD);
@@ -491,7 +491,7 @@ void intmoduleSendNextFrame()
case PROTOCOL_CHANNELS_AFHDS2A: {
uint8_t* data = (uint8_t*)intmodulePulsesData.flysky.pulses;
uint16_t size = intmodulePulsesData.flysky.ptr - data;
intmoduleSendBuffer(data, size);
IntmoduleSerialDriver.sendBuffer(data, size);
} break;
#endif
}
-8
View File
@@ -122,14 +122,6 @@ void EXTERNAL_MODULE_OFF();
#define IS_UART_MODULE(port) (port == INTERNAL_MODULE)
#define IS_PXX2_INTERNAL_ENABLED() (false)
void init_intmodule_heartbeat();
void check_intmodule_heartbeat();
//void extmoduleSerialStart(uint32_t baudrate, uint32_t period_half_us, bool inverted);
void extmoduleSerialStart();
void extmoduleSendNextFrame();
void extmoduleSendInvertedByte(uint8_t byte);
// Trainer driver
void init_trainer_ppm();
void stop_trainer_ppm();
+24
View File
@@ -0,0 +1,24 @@
/*
* Copyright (C) EdgeTX
*
* Based on code named
* opentx - https://github.com/opentx/opentx
* 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.
*/
#pragma once
#include "targets/horus/extmodule_driver.h"