VladislavOstapov/sdrpi-fpv-control
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases 2 Wiki Activity

рабочий sbus в воздухе

Browse Source
This commit is contained in:
Vladislav Ostapov
2025-11-24 19:31:25 +03:00
parent 76fa76f5b8
commit 8aab304e5f
2 changed files with 19 additions and 9 deletions
Download Patch File Download Diff File Expand all files Collapse all files

24
air/main.cpp
View File

@@ -85,6 +85,8 @@ struct SbusData {
bool failsafe = false;
bool ch17 = false, ch18 = false;
static constexpr size_t NUM_CH = 16;
static constexpr int16_t SBUS_CH_MIN = 173;
static constexpr int16_t SBUS_CH_MAX = 1812;
int16_t ch[NUM_CH];
/* Message len */
@@ -253,16 +255,24 @@ int main(int argc, char* argv[]) {
packet_count++;
for (int i = 0; i < data.size() && i < SbusData::NUM_CH; ++i) {
auto item = static_cast<int16_t>(data[i]);
sb.ch[i] = static_cast<int16_t>((item - 1000.0) * 2);
if (sb.ch[i] < 50) {
sb.ch[i] = 50; // минимальное число
} else if (sb.ch[i] > 1900) {
sb.ch[i] = 1900; // максимальное число
auto item = static_cast<double>(data[i]);
item -= 1000.0;
item = std::min(item, 1000.0);
item = std::max(item, 0.0);
item *= (SbusData::SBUS_CH_MAX - SbusData::SBUS_CH_MIN) / 1000.0;
item += SbusData::SBUS_CH_MIN;
sb.ch[i] = static_cast<int16_t>(item);
if (sb.ch[i] < SbusData::SBUS_CH_MIN) {
sb.ch[i] = SbusData::SBUS_CH_MIN; // минимальное число
} else if (sb.ch[i] > SbusData::SBUS_CH_MAX) {
sb.ch[i] = SbusData::SBUS_CH_MAX; // максимальное число
}
}
sb.fillDataBuf();
serial.write(sb.buf_);
if (!serial.write(sb.buf_)) {
break;
}
// Выводим статистику каждые 100 пакетов
if (packet_count % 100 == 0) {