-
Notifications
You must be signed in to change notification settings - Fork 10
Expand file tree
/
Copy pathmain.cpp
More file actions
34 lines (28 loc) · 732 Bytes
/
main.cpp
File metadata and controls
34 lines (28 loc) · 732 Bytes
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
//#include "WProgram.h"
#include "Arduino.h"
#include "FrSkyProcessor.h"
#include "MavlinkProcessor.h"
void __cxa_pure_virtual() {
while(1) {
digitalWrite(13, LOW);
delay(500);
digitalWrite(13, HIGH);
delay(2500);
}
}
int main() {
uint8_t led_pin = 13;
//init();
FrSkyProcessor frsky_processor(FrSkyProcessor::SOFT_SERIAL_PIN_2, led_pin);
MavlinkProcessor mavlink_processor{};
Serial.begin(57600);
pinMode(led_pin, OUTPUT);
analogReference(DEFAULT);
while(1) {
// Check MavLink communication
mavlink_processor.receiveTelemetry();
// Check FrSky S.Port communication
frsky_processor.process(mavlink_processor.getGatheredTelemetry(), mavlink_processor.isConnected());
}
return 0; //unreachable
}