Initial commit

Daemons/domedaemon/term.c

@@ -0,0 +1,203 @@
+/*                                                                                                  geany_encoding=koi8-r
+ * client.c - terminal parser
+ *
+ * Copyright 2018 Edward V. Emelianoff <eddy@sao.ru>
+ *
+ * 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 2 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, write to the Free Software
+ * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston,
+ * MA 02110-1301, USA.
+ */
+#include "usefull_macros.h"
+#include "term.h"
+#include <strings.h> // strncasecmp
+#include <time.h>    // time(NULL)
+#include <limits.h>  // INT_MAX, INT_MIN
+
+#define BUFLEN 1024
+
+static char buf[BUFLEN];
+
+/**
+ * read strings from terminal (ending with '\n') with timeout
+ * @return NULL if nothing was read or pointer to static buffer
+ */
+static char *read_string(){
+    //FNAME();
+    size_t r = 0, l;
+    int LL = BUFLEN - 1;
+    char *ptr = NULL;
+    static char *optr = NULL;
+    if(optr && *optr){
+        ptr = optr;
+        optr = strchr(optr, '\n');
+        if(optr) ++optr;
+        //DBG("got data, roll to next; ptr=%s\noptr=%s",ptr,optr);
+        return ptr;
+    }
+    ptr = buf;
+    double d0 = dtime();
+    do{
+        if((l = read_tty(ptr, LL))){
+            r += l; LL -= l; ptr += l;
+            //DBG("got: %s", buf);
+            if(ptr[-1] == '\n') break;
+            d0 = dtime();
+        }
+    }while(dtime() - d0 < WAIT_TMOUT && LL);
+    if(r){
+        buf[r] = 0;
+        //DBG("r=%zd, got string: %s", r, buf);
+        optr = strchr(buf, '\n');
+        if(optr) ++optr;
+        return buf;
+    }
+    return NULL;
+}
+
+/**
+ * Try to connect to `device` at BAUD_RATE speed
+ * @return connection speed if success or 0
+ */
+void try_connect(char *device){
+    if(!device) return;
+    char tmpbuf[4096];
+    fflush(stdout);
+    tty_init(device);
+    read_tty(tmpbuf, 4096); // clear rbuf
+    putlog("Connected to %s", device);
+    DBG("connected");
+}
+
+static void con_sig(int rb){
+    static char buf[256];
+    static int L = 0;
+    if(rb < 1) return;
+    if(rb != '\n'){
+        if(rb == 127 && L > 0){
+            printf("\b \b");
+            fflush(stdout);
+            --L;
+        }else{
+            if(1 != write(1, &rb, 1))
+                printf("%c", (char)rb);
+            buf[L++] = (char)rb;
+            if(L >= 250){
+                printf("\nbuffer overrun!\n");
+                L = 0;
+            }
+        }
+    }else{
+        //buf[L++] = '\r';
+        //buf[L++] = '\n';
+        buf[L] = 0;
+        printf("\n\t\tSend %s\n", buf);
+        write_tty(buf, L);
+        L = 0;
+    }
+}
+
+/**
+ * run terminal emulation: send user's commands and show answers
+ */
+void run_terminal(){
+    green(_("Work in terminal mode without echo\n"));
+    int rb;
+    char buf[BUFLEN];
+    size_t l;
+    setup_con();
+    while(1){
+        if((l = read_tty(buf, BUFLEN - 1))){
+            buf[l] = 0;
+            printf("%s", buf);
+        }
+        if((rb = read_console())){
+            con_sig(rb);
+        }
+    }
+}
+
+/**
+ * write command
+ * @return answer or NULL if error occured (or no answer)
+ */
+char *write_cmd(const char *cmd){
+    DBG("Write %s", cmd);
+    if(write_tty(cmd, strlen(cmd))) return NULL;
+    double t0 = dtime();
+    static char *ans;
+    while(dtime() - t0 < T_POLLING_TMOUT){ // read answer
+        if((ans = read_string())){ // parse new data
+            DBG("got answer: %s", ans);
+            return ans;
+        }
+    }
+    return NULL;
+}
+
+/**
+ * Poll serial port for new dataportion
+ * @return: NULL if no data received, pointer to string if valid data received
+ */
+char *poll_device(char *wea){
+    char *ans;
+    static char pollbuf[32];
+    const char *cmdstat = "d#get_dom";
+    const char *cmdweat = "d#ask_wea";
+    const char *getweat = "d#wea";
+    const char *cmdget  = "d#pos";
+    #define CMDGETLEN  (5)
+    #define CMDWEALEN  (5)
+    while(read_string()); // clear receiving buffer
+    if(!(ans = write_cmd(cmdstat))) return NULL; // error writing command
+    if(strstr(ans, cmdget) == NULL){
+        DBG("no %s found in %s", cmdstat, ans);
+        return NULL; // ?
+    }
+    ans += CMDGETLEN;
+    if(strstr(ans, "1111")){
+        sprintf(pollbuf, "opened\n");
+        DBG("dome opened");
+    }else if(strstr(ans, "2222")){
+        sprintf(pollbuf, "closed\n");
+        DBG("dome closed");
+    }else sprintf(pollbuf, "intermediate\n");
+    if(!wea || !(ans = write_cmd(cmdweat))) return pollbuf;
+    DBG("poll weather answer");
+    if(strstr(ans, getweat) == NULL){
+        DBG("no %s found in %s", getweat, ans);
+        return pollbuf; // ?
+    }
+    ans += CMDWEALEN;
+    if(*ans == '0'){
+        sprintf(wea, "good weather\n");
+        DBG("good weather");
+    }else if(*ans == '1'){
+        sprintf(wea, "rain or clouds\n");
+        DBG("bad weather");
+    }else sprintf(wea, "unknown\n");
+    return pollbuf;
+}
+
+/**
+ * ping device
+ * @return 0 if all OK
+ */
+int ping(){
+    FNAME();
+    while(read_string()); // clear receiving buffer
+    char *ans = write_cmd("d#get_dom");
+    if(!ans) return 1;
+    if(strstr(ans, "d#pos")) return 0;
+    return 1;
+}