Add FanBus support

Controllers/FanBusController/FanBusInterface.cpp

@@ -0,0 +1,113 @@
+/*---------------------------------------------------------*\
+|  FanBus Interface                                         |
+|                                                           |
+|  Adam Honse (calcprogrammer1@gmail.com), 1/12/2021        |
+\*---------------------------------------------------------*/
+
+#include "FanBusInterface.h"
+
+FanBusInterface::FanBusInterface(const char* portname)
+{
+    port_name  = portname;
+    serialport = new serial_port(portname, 38400);
+
+    /*-----------------------------------------------------*\
+    | Flush any data in the receive queue                   |
+    \*-----------------------------------------------------*/
+    char read_buf[6];
+
+    while(serialport->serial_read(read_buf, 6) > 0)
+    {
+
+    }
+
+    read_buf[0] = 0xFF;
+
+    serialport->serial_write(read_buf, 1);
+    int test = serialport->serial_read(read_buf, 1);
+
+    if(test > 0)
+    {
+        half_duplex = true;
+    }
+    else
+    {
+        half_duplex = false;
+    }
+}
+
+FanBusInterface::~FanBusInterface()
+{
+    serialport->serial_close();
+    delete serialport;
+}
+
+std::string FanBusInterface::GetPort()
+{
+    return(port_name);
+}
+
+int FanBusInterface::read
+    (
+        unsigned char dev_addr,
+        unsigned char int_addr
+    )
+{
+    unsigned char fanbus_msg[] = { 0x01, int_addr, dev_addr, 0x00, 0xFF };
+
+    serialport->serial_write((char *)fanbus_msg, 5);
+
+    usleep(1000);
+
+    char read_buf[6];
+
+    if(half_duplex)
+    {
+        if(serialport->serial_read(read_buf, 6) == 6)
+        {
+            return(read_buf[5]);
+        }
+        else
+        {
+            return(-1);
+        }
+    }
+    else
+    {
+        if(serialport->serial_read(read_buf, 1) == 1)
+        {
+            return(read_buf[0]);
+        }
+        else
+        {
+            return(-1);
+        }
+    }
+}
+
+int FanBusInterface::write
+    (
+        unsigned char dev_addr,
+        unsigned char int_addr,
+        unsigned char val
+    )
+{
+    unsigned char fanbus_msg[] = { 0x00, int_addr, dev_addr, val, 0xFF };
+
+    return(serialport->serial_write((char *)fanbus_msg, 5));
+}
+
+std::vector<unsigned char> FanBusInterface::DetectControllers()
+{
+    std::vector<unsigned char> detected_controllers;
+
+    for(unsigned int dev_addr = 0x03; dev_addr < 0xFF; dev_addr++)
+    {
+        if(read(dev_addr, 0x00) >= 0)
+        {
+            detected_controllers.push_back(dev_addr);
+        }
+    }
+
+    return(detected_controllers);
+}