Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-24 00:35:39 +03:00
Code Issues Wiki Activity

SIRINFPV target initial code

Browse source
This commit is contained in:
Evgeny Sychov 2016-03-11 20:55:27 -08:00
parent be038743b2
commit 8a93041ea1
25 changed files with 2016 additions and 9 deletions
Download patch file Download diff file Expand all files Collapse all files

29
src/main/io/serial_msp.c
View file

@ -44,6 +44,8 @@
#include "drivers/gyro_sync.h"
#include "drivers/sdcard.h"
#include "drivers/buf_writer.h"
#include "drivers/max7456.h"
#include "drivers/rtc6705.h"
#include "rx/rx.h"
#include "rx/msp.h"
@ -1279,7 +1281,9 @@ static bool processInCommand(void)
uint8_t wp_no;
int32_t lat = 0, lon = 0, alt = 0;
#endif
#ifdef OSD
uint8_t addr, font_data[64];
#endif
switch (currentPort->cmdMSP) {
case MSP_SELECT_SETTING:
if (!ARMING_FLAG(ARMED)) {
@ -1559,6 +1563,29 @@ static bool processInCommand(void)
transponderUpdateData(masterConfig.transponderData);
break;
#endif
#ifdef OSD
case MSP_SET_OSD_CONFIG:
break;
case MSP_OSD_CHAR_WRITE:
addr = read8();
for (i = 0; i < 54; i++) {
font_data[i] = read8();
}
max7456_write_nvm(addr, font_data);
break;
#endif
#ifdef USE_RTC6705
case MSP_SET_VTX_CONFIG:
tmp = read16();
if (tmp < 40)
masterConfig.vtx_channel = tmp;
if (current_vtx_channel != masterConfig.vtx_channel) {
current_vtx_channel = masterConfig.vtx_channel;
rtc6705_set_channel(vtx_freq[current_vtx_channel]);
}
break;
#endif
#ifdef USE_FLASHFS
case MSP_DATAFLASH_ERASE: