yemai/bizhang_-obav
1
0
Fork 0
mirror of https://gitee.com/xiaohuolufeihua/bizhang_-obav.git synced 2026-05-22 09:28:58 +00:00
Code Issues Packages Projects Releases Wiki Activity

Allow the setup flags to control the S.BUS / RSSI port instead of doing some wild, likely incorrect, guesses.

Browse Source
This commit is contained in:
Lorenz Meier
2014-01-26 14:13:57 +01:00
parent a737a2a406
commit 16eb68f2e9
2 changed files with 49 additions and 16 deletions
Download Patch File Download Diff File Expand all files Collapse all files

21
src/modules/px4iofirmware/controls.c
View File

@@ -98,13 +98,15 @@ controls_tick() {
uint16_t rssi = 0;
#ifdef ADC_RSSI
unsigned counts = adc_measure(ADC_RSSI);
if (counts != 0xffff) {
/* use 1:1 scaling on 3.3V ADC input */
unsigned mV = counts * 3300 / 4096;
if (r_setup_features & PX4IO_P_SETUP_FEATURES_ADC_RSSI) {
unsigned counts = adc_measure(ADC_RSSI);
if (counts != 0xffff) {
/* use 1:1 scaling on 3.3V ADC input */
unsigned mV = counts * 3300 / 4096;
/* scale to 0..253 */
rssi = mV / 13;
/* scale to 0..253 */
rssi = mV / 13;
}
}
#endif
@@ -150,13 +152,6 @@ controls_tick() {
}
/* switch S.Bus output pin as needed */
if (sbus_status != (r_status_flags & PX4IO_P_STATUS_FLAGS_RC_SBUS)) {
#ifdef ENABLE_SBUS_OUT
ENABLE_SBUS_OUT((r_status_flags & PX4IO_P_STATUS_FLAGS_RC_SBUS));
#endif
}
perf_end(c_gather_sbus);
/*