dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

Removed commented out code

This commit is contained in:
Eric Katzfey 2024-03-06 16:53:11 -08:00
parent bf5bce8718
commit 65a73496e7
1 changed files with 1 additions and 20 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

21
src/drivers/rc/crsf_rc/CrsfParser.cpp
View File

@ -43,7 +43,7 @@
#include <stdint.h> #include <stdint.h>
#include <stdbool.h> #include <stdbool.h>
#include <string.h> #include <string.h>
// #include <px4_log.h> #include <px4_log.h>
#include "QueueBuffer.hpp" #include "QueueBuffer.hpp"
#include "CrsfParser.hpp" #include "CrsfParser.hpp"
#include "Crc8.hpp" #include "Crc8.hpp"
@ -189,30 +189,11 @@ static bool ProcessChannelData(const uint8_t *data, const uint32_t size, CrsfPac
raw_channels[14] = CONSTRAIN_CHAN((data[19] >> 2 | data[20] << 6) & 0x07FF); raw_channels[14] = CONSTRAIN_CHAN((data[19] >> 2 | data[20] << 6) & 0x07FF);
raw_channels[15] = CONSTRAIN_CHAN((data[20] >> 5 | data[21] << 3) & 0x07FF); raw_channels[15] = CONSTRAIN_CHAN((data[20] >> 5 | data[21] << 3) & 0x07FF);
// for (i = 0; i < CRSF_CHANNEL_COUNT; i++) {
// raw_channels[i] = ConstrainF(raw_channels[i], CRSF_CHANNEL_VALUE_MIN, CRSF_CHANNEL_VALUE_MAX);
// new_packet->channel_data.channels[i] = MapF((float)raw_channels[i], CRSF_CHANNEL_VALUE_MIN, CRSF_CHANNEL_VALUE_MAX,
// 1000.0f, 2000.0f);
// }
// static uint32_t debug_counter = 0;
// for (i = 0; i < CRSF_CHANNEL_COUNT; i++) {
// raw_channels[i] = ConstrainF(raw_channels[i], CRSF_CHANNEL_VALUE_MIN, CRSF_CHANNEL_VALUE_MAX);
// }
// if ((debug_counter % 2000000) == 0) {
// // debug_counter = 0;
// PX4_INFO("Constrained RC channels %f %f %f %f", (double) raw_channels[0], (double) raw_channels[1], (double) raw_channels[2], (double) raw_channels[3]);
// }
for (i = 0; i < CRSF_CHANNEL_COUNT; i++) { for (i = 0; i < CRSF_CHANNEL_COUNT; i++) {
new_packet->channel_data.channels[i] = MapF((float)raw_channels[i], CRSF_CHANNEL_VALUE_MIN, CRSF_CHANNEL_VALUE_MAX, new_packet->channel_data.channels[i] = MapF((float)raw_channels[i], CRSF_CHANNEL_VALUE_MIN, CRSF_CHANNEL_VALUE_MAX,
1000.0f, 2000.0f); 1000.0f, 2000.0f);
} }
// debug_counter++;
return true; return true;
} }