-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathFrSkySportDecoder.h
executable file
·48 lines (42 loc) · 2.19 KB
/
FrSkySportDecoder.h
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
/*
FrSky telemetry decoder class for Teensy 3.x/LC and 328P based boards (e.g. Pro Mini, Nano, Uno)
(c) Pawelsky 20160919
Not for commercial use
*/
#ifndef _FRSKY_SPORT_DECODER_H_
#define _FRSKY_SPORT_DECODER_H_
#include "Arduino.h"
#include "FrSkySportPolling.h"
#include "FrSkySportSensor.h"
#include "FrSkySportSingleWireSerial.h"
#define FRSKY_DECODER_MAX_SENSORS 28
class FrSkySportDecoder
{
public:
FrSkySportDecoder(bool polling = false);
void begin(FrSkySportSingleWireSerial::SerialId id,
FrSkySportSensor* sensor1, FrSkySportSensor* sensor2 = NULL, FrSkySportSensor* sensor3 = NULL,
FrSkySportSensor* sensor4 = NULL, FrSkySportSensor* sensor5 = NULL, FrSkySportSensor* sensor6 = NULL,
FrSkySportSensor* sensor7 = NULL, FrSkySportSensor* sensor8 = NULL, FrSkySportSensor* sensor9 = NULL,
FrSkySportSensor* sensor10 = NULL, FrSkySportSensor* sensor11 = NULL, FrSkySportSensor* sensor12 = NULL,
FrSkySportSensor* sensor13 = NULL, FrSkySportSensor* sensor14 = NULL, FrSkySportSensor* sensor15 = NULL,
FrSkySportSensor* sensor16 = NULL, FrSkySportSensor* sensor17 = NULL, FrSkySportSensor* sensor18 = NULL,
FrSkySportSensor* sensor19 = NULL, FrSkySportSensor* sensor20 = NULL, FrSkySportSensor* sensor21 = NULL,
FrSkySportSensor* sensor22 = NULL, FrSkySportSensor* sensor23 = NULL, FrSkySportSensor* sensor24 = NULL,
FrSkySportSensor* sensor25 = NULL, FrSkySportSensor* sensor26 = NULL, FrSkySportSensor* sensor27 = NULL,
FrSkySportSensor* sensor28 = NULL);
uint16_t decode();
private:
enum State { START_FRAME = 0, SENSOR_ID = 1, DATA_FRAME = 2, APP_ID_BYTE_1 = 3, APP_ID_BYTE_2 = 4, DATA_BYTE_1 = 5, DATA_BYTE_2 = 6, DATA_BYTE_3 = 7, DATA_BYTE_4 = 8, CRC = 9 };
FrSkySportSensor* sensors[FRSKY_DECODER_MAX_SENSORS];
FrSkySportSingleWireSerial serial;
uint8_t sensorCount;
State state;
boolean hasStuffing;
uint8_t id;
uint16_t appId;
uint32_t data;
uint16_t crc;
FrSkySportPolling *pollingClass;
};
#endif // _FRSKY_SPORT_DECODER_H_