155 lines
4.1 KiB
C++
155 lines
4.1 KiB
C++
#include <MCP23017.h>
|
|
#include <ArduinoMqttClient.h>
|
|
#include <Ethernet.h>
|
|
#include "config.h"
|
|
|
|
#define ROT_PORT_A A
|
|
#define ROT_ADDR_1 0x20
|
|
|
|
#define HEADING_CLK 0b00000001
|
|
#define HEADING_DT 0b00000010
|
|
#define HEADING_SW 0b00000100
|
|
#define SPEED_CLK 0b00100000
|
|
#define SPEED_DT 0b01000000
|
|
#define SPEED_SW 0b10000000
|
|
|
|
|
|
// https://github.com/olikraus/u8g2/wiki/fntgrpfreeuniversal
|
|
|
|
byte mac[] = { 0xDE, 0xAD, 0xBE, 0xEF, 0xFE, 0xED };
|
|
|
|
const char broker[] = "openhab.sugarland.lan";
|
|
int port = 1883;
|
|
const char topic[] = "/xplane/rref/#";
|
|
|
|
EthernetClient client;
|
|
MqttClient mqttClient(client);
|
|
|
|
byte lastRotInput_1A;
|
|
|
|
MCP23017 mcp1 = MCP23017(ROT_ADDR_1, 100);
|
|
|
|
void setup() {
|
|
// put your setup code here, to run once:
|
|
Serial.begin(9600);
|
|
while (!Serial) {
|
|
; // wait for serial port to connect. Needed for native USB port only
|
|
}
|
|
|
|
// start the Ethernet connection:
|
|
if (Ethernet.begin(mac) == 0) {
|
|
Serial.println("Failed to configure Ethernet using DHCP");
|
|
// no point in carrying on, so do nothing forevermore:
|
|
for(;;)
|
|
;
|
|
}
|
|
// print your local IP address:
|
|
Serial.println(Ethernet.localIP());
|
|
|
|
mqttClient.setUsernamePassword(MQTT_USER2, MQTT_PASS);
|
|
|
|
if (!mqttClient.connect(broker, port)) {
|
|
Serial.print("MQTT connection failed! Error code = ");
|
|
Serial.println(mqttClient.connectError());
|
|
|
|
while (1);
|
|
} else {
|
|
Serial.println("MQTT connected");
|
|
}
|
|
|
|
mqttClient.onMessage(onMqttMessage);
|
|
mqttClient.subscribe(topic);
|
|
|
|
Wire.begin();
|
|
if(!mcp1.Init()){
|
|
Serial.println("MCP not connected");
|
|
while(1){}
|
|
} else {
|
|
Serial.println("MCP connected");
|
|
}
|
|
|
|
mcp1.setPortMode(0b00000000, ROT_PORT_A);
|
|
mcp1.setPortPullUp(0b00000000, ROT_PORT_A);
|
|
|
|
lastRotInput_1A = mcp1.getPort(ROT_PORT_A);
|
|
}
|
|
|
|
bool isBitDown(byte input, byte reference) {
|
|
return !(input & reference);
|
|
}
|
|
|
|
int getRotation(bool newClk, bool lastClk, bool newDt, bool lastDt) {
|
|
if (lastClk && !newClk) {
|
|
if (newDt) {
|
|
// CW
|
|
return 1;
|
|
} else {
|
|
// CCW
|
|
return -1;
|
|
}
|
|
} else {
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
void sendMqttByRotation(int rotation, char *topic, char *cw, char *ccw) {
|
|
if (rotation != 0) {
|
|
mqttClient.beginMessage(topic);
|
|
if (rotation == 1) {
|
|
mqttClient.print(cw);
|
|
} else {
|
|
mqttClient.print(ccw);
|
|
}
|
|
mqttClient.endMessage();
|
|
}
|
|
}
|
|
|
|
void loop() {
|
|
// call poll() regularly to allow the library to receive MQTT messages and
|
|
// send MQTT keep alives which avoids being disconnected by the broker
|
|
mqttClient.poll();
|
|
|
|
byte newRotInput_1A = mcp1.getPort(ROT_PORT_A);
|
|
|
|
if (isBitDown(newRotInput_1A, HEADING_SW) && !isBitDown(lastRotInput_1A, HEADING_SW)) {
|
|
mqttClient.beginMessage("/xplane/meta/cmnd");
|
|
mqttClient.print("sim/autopilot/heading_push");
|
|
mqttClient.endMessage();
|
|
}
|
|
|
|
int rotation = 0;
|
|
|
|
bool newHeadingClk = isBitDown(newRotInput_1A, HEADING_CLK);
|
|
bool lastHeadingClk = isBitDown(lastRotInput_1A, HEADING_CLK);
|
|
bool newHeadingDt = isBitDown(newRotInput_1A, HEADING_DT);
|
|
bool lastHeadingDt = isBitDown(lastRotInput_1A, HEADING_DT);
|
|
rotation = getRotation(newHeadingClk, lastHeadingClk, newHeadingDt, lastHeadingDt);
|
|
sendMqttByRotation(rotation, "/xplane/meta/cmnd", "sim/autopilot/heading_up", "sim/autopilot/heading_down");
|
|
|
|
bool newSpeedClk = isBitDown(newRotInput_1A, SPEED_CLK);
|
|
bool lastSpeedClk = isBitDown(lastRotInput_1A, SPEED_CLK);
|
|
bool newSpeedDt = isBitDown(newRotInput_1A, SPEED_DT);
|
|
bool lastSpeedDt = isBitDown(lastRotInput_1A, SPEED_DT);
|
|
rotation = getRotation(newSpeedClk, lastSpeedClk, newSpeedDt, lastSpeedDt);
|
|
sendMqttByRotation(rotation, "/xplane/meta/cmnd", "sim/autopilot/airspeed_up", "sim/autopilot/airspeed_down");
|
|
|
|
lastRotInput_1A = newRotInput_1A;
|
|
}
|
|
|
|
void onMqttMessage(int messageSize) {
|
|
// // we received a message, print out the topic and contents
|
|
// Serial.println("Received a message with topic '");
|
|
// Serial.print(mqttClient.messageTopic());
|
|
// Serial.print("', length ");
|
|
// Serial.print(messageSize);
|
|
// Serial.println(" bytes:");
|
|
//
|
|
// // use the Stream interface to print the contents
|
|
// while (mqttClient.available()) {
|
|
// Serial.print((char)mqttClient.read());
|
|
// }
|
|
// Serial.println();
|
|
//
|
|
// Serial.println();
|
|
}
|