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
}