[stm32] spektrum: always decode up to 12 channels

but only copy RADIO_CONTROL_NB_CHANNEL to radio_control.values
This commit is contained in:
Felix Ruess
2014-11-28 14:59:04 +01:00
parent f38c5db2db
commit 7ae4ab3a6f
2 changed files with 3 additions and 2 deletions
@@ -446,7 +446,7 @@ void RadioControlEventImp(void (*frame_handler)(void)) {
case(0) : /* 10 bit */
ChannelNum = (ChannelData >> 10) & 0x0f;
/* don't bother decoding unused channels */
if (ChannelNum < RADIO_CONTROL_NB_CHANNEL) {
if (ChannelNum < SPEKTRUM_NB_CHANNEL) {
SpektrumBuf[ChannelNum] = ChannelData & 0x3ff;
SpektrumBuf[ChannelNum] -= 0x200;
SpektrumBuf[ChannelNum] *= MAX_PPRZ/0x156;
@@ -457,7 +457,7 @@ void RadioControlEventImp(void (*frame_handler)(void)) {
case(1) : /* 11 bit */
ChannelNum = (ChannelData >> 11) & 0x0f;
/* don't bother decoding unused channels */
if (ChannelNum < RADIO_CONTROL_NB_CHANNEL) {
if (ChannelNum < SPEKTRUM_NB_CHANNEL) {
SpektrumBuf[ChannelNum] = ChannelData & 0x7ff;
SpektrumBuf[ChannelNum] -= 0x400;
SpektrumBuf[ChannelNum] *= MAX_PPRZ/0x2AC;
@@ -29,6 +29,7 @@
* have the same channel assignments.
*/
#define SPEKTRUM_NB_CHANNEL 12
#ifndef RADIO_CONTROL_NB_CHANNEL
#define RADIO_CONTROL_NB_CHANNEL 12