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

display control

Browse Source
This commit is contained in:
damage
2025-05-17 13:08:17 +02:00
parent 0e87650257
commit 226f2a3e3f
4 changed files with 219 additions and 61 deletions
Download Patch File Download Diff File Expand all files Collapse all files

9
master/global.h Normal file
View File

@ -0,0 +1,9 @@
#define DATA_STOP_BYTE 0x00
#define DATA_INIT_BYTE_1 0x01
#define DATA_INIT_BYTE_2 0x02
#define DATA_RESET_BYTE 0xFF
#define TRIGGER_BIT_1 1
#define HIGH_BIT_1 2
#define TRIGGER_BIT_2 4
#define HIGH_BIT_2 8
#define I2C_ADDRESS_START 0x08

82
master/master.ino
View File

@ -1,38 +1,39 @@
#include <Wire.h>
#include <ArduinoMqttClient.h>
#include <Ethernet.h>
#include "config.h"
#include "global.h"
#define READ_BYTES_FROM_WIRE 1
// needs global define
#define DATA_STOP_BYTE 0x00
#define DATA_RESET_BYTE 0xFF
#define HEADING_TRIGGER_BIT 1
#define HEADING_HIGH_BIT 2
#define ALTITUDE_TRIGGER_BIT 4
#define ALTITUDE_HIGH_BIT 8
#define HEADING_SIM_UP "sim/autopilot/heading_up"
#define HEADING_SIM_DOWN "sim/autopilot/heading_down"
#define ALTITUDE_SIM_UP "sim/autopilot/altitude_up"
#define ALTITUDE_SIM_DOWN "sim/autopilot/altitude_down"
#define AIRPSEED_SIM_UP "sim/autopilot/airspeed_up"
#define AIRSPEED_SIM_UP "sim/autopilot/airspeed_up"
#define AIRSPEED_SIM_DOWN "sim/autopilot/airspeed_down"
#define MQTT_SIM_COMMAND_TOPIC "/xplane/meta/cmnd"
#define MQTT_SIM_DEVICE_TOPIC "/xplane/meta/device"
#define MQTT_SIM_LOG_TOPIC "/xplane/meta/log"
#define MQTT_SIM_VALUE_TOPIC "/xplane/rref/#"
#define MQTT_KEEPALIVE_INTERVAL_MS 15000
struct device {
byte address;
String name;
byte address; // I2C address of device
char *name; // name of this device
char name1[3]; // first name to send on init of device
char *highCommand1; // command to use if TRIGGER_BIT_1 is set and HIGH_BIT_1 is set
char *lowCommand1; // command to use if TRIGGER_BIT_1 is set and HIGH_BIT_1 is not set
char name2[3]; // second name to send on init of device
char *highCommand2; // command to use if TRIGGER_BIT_2 is set and HIGH_BIT_2 is set
char *lowCommand2; // command to use if TRIGGER_BIT_2 is set and HIGH_BIT_2 is not set
};
struct device devices[] = {
{0x00, "althead"}
{ 0x08, "Heading Speed", {'H', 'D', 'G'}, HEADING_SIM_UP, HEADING_SIM_DOWN, {'S', 'P', 'D'}, AIRSPEED_SIM_UP, AIRSPEED_SIM_DOWN }
};
int numDevices = -1;
@ -65,12 +66,28 @@ void onMqttMessage(int messageSize) {
// Serial.println();
}
void sendMqttMessage(char *topic, char *message) {
void sendMqttMessage(char *topic, int n, ...) {
mqttClient.beginMessage(topic);
mqttClient.print(message);
va_list args;
va_start(args, n);
for (int i = 0; i < n; i++) {
mqttClient.print(va_arg(args, char*));
}
va_end(args);
mqttClient.endMessage();
}
void sendI2CInit(struct device d) {
sendMqttMessage(MQTT_SIM_LOG_TOPIC, 2, "Sending init to ", d.name);
Wire.beginTransmission(d.address);
Wire.write(DATA_RESET_BYTE);
Wire.write(DATA_INIT_BYTE_1);
Wire.write(d.name1, 3);
Wire.write(DATA_INIT_BYTE_2);
Wire.write(d.name2, 3);
Wire.endTransmission(d.address);
}
void setup() {
// count devices for loop
numDevices = sizeof(devices) / sizeof(device);
@ -96,7 +113,7 @@ void setup() {
while (1);
} else {
Serial.println("MQTT connected");
sendMqttMessage(MQTT_SIM_DEVICE_TOPIC, "Master online");
sendMqttMessage(MQTT_SIM_DEVICE_TOPIC, 1, "Master online");
}
// subscribe to MQTT topic
@ -115,9 +132,7 @@ void setup() {
// initialize devices
for (int i = 0; i < numDevices; i++) {
Wire.beginTransmission(devices[i].address);
Wire.write(DATA_RESET_BYTE);
Wire.endTransmission(devices[i].address);
sendI2CInit(devices[i]);
}
}
@ -129,31 +144,40 @@ void loop() {
// device has data, ask as long for data as it sends
// if it never stops sending, we are fucked :)
byte data = Wire.read();
if (data != DATA_STOP_BYTE) {
if (data & ALTITUDE_TRIGGER_BIT) {
if (data & ALTITUDE_HIGH_BIT) {
sendMqttMessage(MQTT_SIM_COMMAND_TOPIC, ALTITUDE_SIM_UP);
if (data == DATA_STOP_BYTE) {
// do not request further data
continue;
} else if (data == DATA_RESET_BYTE) {
// device needs initialization
sendMqttMessage(MQTT_SIM_LOG_TOPIC, 2, "got reset byte from ", devices[i].name);
sendI2CInit(devices[i]);
} else {
// handle as payload
if (data & TRIGGER_BIT_1) {
if (data & HIGH_BIT_1) {
sendMqttMessage(MQTT_SIM_COMMAND_TOPIC, 1, devices[i].highCommand1);
} else {
sendMqttMessage(MQTT_SIM_COMMAND_TOPIC, ALTITUDE_SIM_DOWN);
sendMqttMessage(MQTT_SIM_COMMAND_TOPIC, 1, devices[i].lowCommand1);
}
} else if (data & HEADING_TRIGGER_BIT) {
if (data & HEADING_HIGH_BIT) {
sendMqttMessage(MQTT_SIM_COMMAND_TOPIC, HEADING_SIM_UP);
} else if (data & TRIGGER_BIT_2) {
if (data & HIGH_BIT_2) {
sendMqttMessage(MQTT_SIM_COMMAND_TOPIC, 1, devices[i].highCommand2);
} else {
sendMqttMessage(MQTT_SIM_COMMAND_TOPIC, HEADING_SIM_DOWN);
sendMqttMessage(MQTT_SIM_COMMAND_TOPIC, 1, devices[i].lowCommand2);
}
} else {
// who are you?
}
Wire.requestFrom(devices[i].address, READ_BYTES_FROM_WIRE);
}
Wire.requestFrom(devices[i].address, READ_BYTES_FROM_WIRE);
}
}
// transmit MQTT keepalive message if MQTT_KEEPALIVE_INTERVAL_MS is reached
// or millis() is wrapping to 0
if (mqttLastKeepAlive + MQTT_KEEPALIVE_INTERVAL_MS < millis() || mqttLastKeepAlive > millis()) {
sendMqttMessage(MQTT_SIM_DEVICE_TOPIC, localIP);
sendMqttMessage(MQTT_SIM_DEVICE_TOPIC, 1, localIP);
mqttLastKeepAlive = millis();
}
}