mirror of
https://github.com/paparazzi/paparazzi.git
synced 2026-05-23 04:45:37 +08:00
[stm32] spektrum: always decode up to 12 channels
but only copy RADIO_CONTROL_NB_CHANNEL to radio_control.values
This commit is contained in:
@@ -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
|
||||
|
||||
Reference in New Issue
Block a user