XPlane/HardwareAdapter
1
0
Fork 0
Code Issues 1 Pull Requests Packages Projects Releases Wiki Activity

counter not needed, just the events

Browse Source
This commit is contained in:
damage
2025-01-03 09:51:49 +01:00
parent 780ba0ba0a
commit 311c9ecdbb
1 changed files with 18 additions and 36 deletions
Download Patch File Download Diff File Expand all files Collapse all files

54
rotator/rotator.ino
View File

@ -1,4 +1,3 @@
#define PIN_HEADING_CLK D7 #define PIN_HEADING_CLK D7
#define PIN_HEADING_DT D5 #define PIN_HEADING_DT D5
#define PIN_HEADING_SW D6 #define PIN_HEADING_SW D6
@ -13,24 +12,19 @@
#define HEADING_DT_TRIGGER 1 #define HEADING_DT_TRIGGER 1
#define HEADING_DT_HIGH 2 #define HEADING_DT_HIGH 2
#define HEADING_SW_TRIGGER 4 #define HEADING_SW_TRIGGER 2
#define ALTITUDE_DT_TRIGGER 8 #define ALTITUDE_DT_TRIGGER 4
#define ALTITUDE_DT_HIGH 16 #define ALTITUDE_DT_HIGH 8
#define ALTITUDE_SW_TRIGGER 32 #define ALTITUDE_SW_TRIGGER 8
#define MIN_DT_INPUT_DELAY 1000 // 1ms #define MIN_DT_INPUT_DELAY 1000 // 1ms
#define MIN_SW_INPUT_DELAY 500000 // 500ms #define MIN_SW_INPUT_DELAY 500000 // 500ms
#define MIN_ALTITUDE 1 const char PREFIX_HEADING[5] = "head";
#define MAX_ALTITUDE 60000 const char PREFIX_ALTITUDE[5] = "altd";
#define MIN_HEADING 1
#define MAX_HEADING 360
uint8_t lastClk = HIGH; uint8_t lastClk = HIGH;
uint16_t heading = 360;
uint16_t altitude = 0;
// ringbuffer of trigger and direction values // ringbuffer of trigger and direction values
uint8_t valueBuffer[VALUE_BUFFER] = { 0 }; uint8_t valueBuffer[VALUE_BUFFER] = { 0 };
@ -99,27 +93,17 @@ void altitudeSwFalling() {
swFalling(ALTITUDE_SW_TRIGGER); swFalling(ALTITUDE_SW_TRIGGER);
} }
void dtTriggered(uint16_t &cnt, uint8_t high, uint8_t fast, uint16_t miV, uint16_t miVR, uint16_t maV, uint16_t mavR) { void dtTriggered(uint8_t high, uint8_t fast, const char prefix[5]) {
Serial.print(prefix);
if (high) { if (high) {
cnt++; Serial.println(1);
} else { } else {
cnt--; Serial.println(-1);
}
if (cnt > maV) {
cnt = mavR;
}
if (cnt < miV) {
cnt = miVR;
} }
} }
void setup() { void setup() {
Serial.begin(115200); Serial.begin(115200);
while (!Serial) {
; // wait for serial port to connect. Needed for native USB port only
}
pinMode(PIN_HEADING_SW, INPUT_PULLUP); pinMode(PIN_HEADING_SW, INPUT_PULLUP);
pinMode(PIN_HEADING_DT, INPUT_PULLUP); pinMode(PIN_HEADING_DT, INPUT_PULLUP);
@ -134,25 +118,23 @@ void setup() {
void loop() { void loop() {
while (writerPos != readerPos) { while (writerPos != readerPos) {
uint8_t value = valueBuffer[readerPos++]; uint8_t value = valueBuffer[readerPos++];
if (readerPos >= VALUE_BUFFER) { if (readerPos >= VALUE_BUFFER) {
readerPos = 0; readerPos = 0;
} }
if (value & HEADING_DT_TRIGGER) { if (value & HEADING_DT_TRIGGER) {
uint8_t dtHigh = value & HEADING_DT_HIGH; uint8_t dtHigh = value & HEADING_DT_HIGH;
dtTriggered(heading, dtHigh, 5, MIN_HEADING, MAX_HEADING, MAX_HEADING, MIN_HEADING); dtTriggered(dtHigh, 5, PREFIX_HEADING);
Serial.print("Heading: ");
Serial.println(heading);
} else if (value & HEADING_SW_TRIGGER) { } else if (value & HEADING_SW_TRIGGER) {
Serial.println("Heading: pushed"); Serial.print(PREFIX_HEADING);
Serial.println("push");
} else if (value & ALTITUDE_DT_TRIGGER) { } else if (value & ALTITUDE_DT_TRIGGER) {
uint8_t dtHigh = value & ALTITUDE_DT_HIGH; uint8_t dtHigh = value & ALTITUDE_DT_HIGH;
dtTriggered(altitude, dtHigh, 5, MIN_ALTITUDE, MIN_ALTITUDE, MAX_ALTITUDE, MAX_ALTITUDE); dtTriggered(dtHigh, 5, PREFIX_ALTITUDE);
Serial.print("Altitude: ");
Serial.println(altitude);
} else if (value & ALTITUDE_SW_TRIGGER) { } else if (value & ALTITUDE_SW_TRIGGER) {
Serial.println("Altitude: pushed"); Serial.print(PREFIX_ALTITUDE);
Serial.println("push");
} else { } else {
// never happen error... // never happen error...
} }