add Hydreon monitoring

Auxiliary_utils/Hydreon/hydreon.c

@@ -0,0 +1,158 @@
+/*
+ * This file is part of the Hydreon_RG11 project.
+ * Copyright 2022 Edward V. Emelianov <edward.emelianoff@gmail.com>.
+ *
+ * This program is free software: you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation, either version 3 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program.  If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#include <string.h>
+
+#include "hydreon.h"
+
+static TTY_descr *dev = NULL;
+
+// regular registers names
+static const char* rregnames[RREGNUM] = {
+    "PeakRS",
+    "SPeakRS",
+    "RainAD8",
+    "LRA",
+    "TransRat",
+    "AmbLNoise"
+};
+
+// rgbit names
+static const char* rgbitnames[RGBITNUM] = {
+    "PkOverThr",
+    "Raining",
+    "Out1On",
+    "HtrOn",
+    "IsDark",
+    "Cndnstn",
+    "Freeze",
+    "Storm"
+};
+
+static const char *slowregnames[SREGNUM] = {
+    "RevLevel",
+    "EmLevel",
+    "RecEmStr",
+    "ABLevel",
+    "TmprtrF",
+    "PUGain",
+    "ClearTR",
+    "AmbLight",
+    "Bucket",
+    "Barrel",
+    "RGConfig",
+    "DwellT",
+    "SinceRn",
+    "MonoStb",
+    "LightAD",
+    "RainThr",
+};
+
+const char *regname(int N){
+    if(N < 0 || N > RREGNUM) return NULL;
+    return rregnames[N];
+}
+const char *rgbitname(int N){
+    if(N < 0 || N > RGBITNUM) return NULL;
+    return rgbitnames[N];
+}
+const char *slowname(int N){
+    if(N < 0 || N > SREGNUM) return NULL;
+    return slowregnames[N];
+}
+
+static int getv(char s, uint8_t *v){
+    if(s >= '0' && s <= '9'){
+        *v = s - '0';
+        return 1;
+    }else if(s >= 'a' && s <= 'f'){
+        *v = 10 + s - 'a';
+        return 1;
+    }
+    return 0;
+}
+
+static int encodepacket(const char *buf, int len, rg11 *Rregs, slowregs *Sregs){
+    uint8_t databuf[REGLEN/2] = {0};
+    static slowregs slow = {0};
+    if(len != REGMINLEN && len != REGLEN) return FALSE;
+    for(int i = 0; i < len; ++i){
+        int l = i&1; // low part
+        int idx = i/2; // data index
+        uint8_t v;
+        if(!getv(buf[i], &v)) return 0;
+        if(l) databuf[idx] |= v;
+        else databuf[idx] |= v << 4;
+    }
+    if(Rregs) memcpy(Rregs, databuf, sizeof(rg11));
+    rg11 r = *((rg11*)databuf);
+    uint8_t *s = (uint8_t*) &slow;
+    if(len == REGLEN){
+        if(r.SlowRegIngex < 16){
+            s[r.SlowRegIngex] = r.SlowRegValue;
+        }
+    }
+    if(Sregs) memcpy(Sregs, &slow, sizeof(slowregs));
+    return TRUE;
+}
+
+/**
+ * @brief getpacket - try to read next data in packet
+ * @param Rregs (o) - regular registers (if return TRUE)
+ * @param Sregs (o) - slow registers (if return TRUE)
+ * @return FALSE if it is still no data @ input
+ */
+int hydreon_getpacket(rg11 *Rregs, slowregs *Sregs){
+    if(!dev) return 0;
+    static int buflen = 0;
+    static char strbuf[BUFLEN];
+    int l = read_tty(dev);
+    if(l < 1) return FALSE;
+    char s = dev->buf[0];
+    if(s == 's'){ // start of new packet -> encode old
+        if(buflen){
+            l = encodepacket(strbuf, buflen, Rregs, Sregs);
+            buflen = 0;
+            return l;
+        }
+    }else{
+        strbuf[buflen++] = s;
+        if(buflen >= BUFLEN){
+            WARNX("Buffer overfull");
+            buflen = 0;
+        }
+    }
+    return FALSE;
+}
+
+/**
+ * @brief open_hydreon - open serial device
+ * @param devname (i) - device path
+ * @return TRUE or FALSE if failed
+ */
+int hydreon_open(const char *devname){
+    dev = new_tty((char*)devname, 1200, 1);
+    if(!dev) return FALSE;
+    dev = tty_open(dev, 1);
+    if(!dev) return FALSE;
+    return TRUE;
+}
+
+void hydreon_close(){
+    if(dev) close_tty(&dev);
+}