phschoen
/
diy-copter-remote
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity
Browse Source

use dead range only on first channels

master
Schoenberger, Philipp 6 years ago
parent
20d3a7d0ca
commit
7a38d21979
1 changed files with 13 additions and 9 deletions
Whitespace
Show all changes Ignore whitespace when comparing lines Ignore changes in amount of whitespace Ignore changes in whitespace at EOL
Split View
Diff Options
Show Stats Download Patch File Download Diff File
  1. 22
      remote/src/input.cpp

22
remote/src/input.cpp
View File

@ -244,23 +244,27 @@ void Input::update(void) {
for (uint8_t ch = 0; ch < CH_COUNT; ++ch) {
this->channel_data[ch] = map(this->curr->ch_data[ch], this->ch_config[ch].min, this->ch_config[ch].max, CHANNEL_MIN_100+3, CHANNEL_MAX_100);
this->channel_data[ch] = map(this->curr->ch_data[ch], this->ch_config[ch].min, this->ch_config[ch].max, CHANNEL_MIN_100, CHANNEL_MAX_100);
}
#define CHANNEL_DEAD 70
uint8_t mid = (CHANNEL_MAX_100 - CHANNEL_MIN_100)/2 + CHANNEL_MIN_100;
uint8_t min_dead = mid - CHANNEL_DEAD;
uint8_t max_dead = mid + CHANNEL_DEAD;
for (uint8_t ch = 0; ch < CH_COUNT; ++ch) {
if (this->channel_data[ch] > mid) {
this->channel_data[ch] -= CHANNEL_DEAD;
} else {
this->channel_data[ch] -= CHANNEL_DEAD;
}
if (min_dead <= this->channel_data[ch] &&
this->channel_data[ch] <= max_dead) {
for (uint8_t ch = 0; ch < 4; ++ch) {
if (min_dead < this->channel_data[ch] &&
this->channel_data[ch] < max_dead) {
// dead range
this->channel_data[ch] = mid;
}
/* else { */
/* if (this->channel_data[ch] > mid) { */
/* this->channel_data[ch] -= CHANNEL_DEAD; */
/* } else { */
/* this->channel_data[ch] += CHANNEL_DEAD; */
/* } */
/* this->channel_data[ch] = map(this->curr->ch_data[ch], CHANNEL_MIN_100+CHANNEL_DEAD, CHANNEL_MAX_100-CHANNEL_DEAD, CHANNEL_MIN_100, CHANNEL_MAX_100); */
/* } */
}
/*debug_input("t%d y%d r%d p%d a1_%d a2_%d a3_%d a4_%d a5_%d m%d",

Write Preview
Loading…
Cancel
Save