2 * This file is part of Cleanflight.
4 * Cleanflight is free software: you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation, either version 3 of the License, or
7 * (at your option) any later version.
9 * Cleanflight is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
14 * You should have received a copy of the GNU General Public License
15 * along with Cleanflight. If not, see <http://www.gnu.org/licenses/>.
23 #include "build_config.h"
25 #include "drivers/system.h"
27 #include "drivers/serial.h"
28 #include "drivers/serial_uart.h"
29 #include "io/serial.h"
34 static uint16_t mspFrame
[MAX_SUPPORTED_RC_CHANNEL_COUNT
];
35 static bool rxMspFrameDone
= false;
37 static uint16_t rxMspReadRawRC(rxRuntimeConfig_t
*rxRuntimeConfigPtr
, uint8_t chan
)
39 UNUSED(rxRuntimeConfigPtr
);
40 return mspFrame
[chan
];
43 void rxMspFrameReceive(uint16_t *frame
, int channelCount
)
45 for (int i
= 0; i
< channelCount
; i
++) {
46 mspFrame
[i
] = frame
[i
];
49 // Any channels not provided will be reset to zero
50 for (int i
= channelCount
; i
< MAX_SUPPORTED_RC_CHANNEL_COUNT
; i
++) {
54 rxMspFrameDone
= true;
57 bool rxMspFrameComplete(void)
59 if (!rxMspFrameDone
) {
63 rxMspFrameDone
= false;
67 void rxMspInit(rxConfig_t
*rxConfig
, rxRuntimeConfig_t
*rxRuntimeConfig
, rcReadRawDataPtr
*callback
)
70 rxRuntimeConfig
->channelCount
= MAX_SUPPORTED_RC_CHANNEL_COUNT
;
72 *callback
= rxMspReadRawRC
;