Dateien hochladen nach „Software/Rx6ChInput“

This commit is contained in:
Hendrik Schutter 2018-10-07 21:11:36 +02:00
parent d9cab73937
commit a266846e18
1 changed files with 80 additions and 0 deletions

View File

@ -0,0 +1,80 @@
#include <MicroPlaneSystem.h>
MicroPlaneSystem rx;
MicroPlaneSystem servo1;
MicroPlaneSystem servo2;
MicroPlaneSystem servo3;
MicroPlaneSystem servo4;
MicroPlaneSystem servo5;
int rud;
int ele;
int thro;
int ail;
int aux1;
int aux2;
bool debugging = true;
void setup() {
Serial.begin(115200);
Serial.println("Hello World");
/*
servo1.attach(7);
servo2.attach(8);
servo3.attach(9);
servo4.attach(10);
servo5.attach(11);
*/
}
void loop() {
updateChannels();
/*
servo1.write(rud);
servo2.write(ele);
servo3.write(thro);
servo4.write(ail);
servo5.write(aux1);
*/
//Do fancy stuff
}
void channelMapping() {
rud = rx.getRxChannel(0);
ele = rx.getRxChannel(1);
thro = rx.getRxChannel(2);
ail = rx.getRxChannel(3);
aux1 = rx.getRxChannel(4);
aux2 = rx.getRxChannel(5);
}
void updateChannels() {
if (Serial.available()|| true) {
if (rx.update()) {
channelMapping();
if (debugging) {
for (int i = 0; i < 6; i++) {
Serial.print(" Ch0");
Serial.print(i);
Serial.print(": ");
Serial.print(rx.getRxChannel(i));
}
Serial.println();
}
}
} else {
//No connection or Failsafe
}
}