small_tel/Daemons/teldaemon/term.c

/*                                                                                                  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
    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");
            --L;
        }else{
            printf("%c", (char)rb);
            buf[L++] = (char)rb;
            if(L >= 255){
                printf("\nbuffer overrun!\n");
                L = 0;
            }
        }
    }else{
        buf[L++] = 0x0d;
        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 with trailing "\r\n"
 * @return 0 if all OK
 */
int write_cmd(const char *cmd){
    char buf[BUFLEN];
    if(snprintf(buf, BUFLEN, "%s\r", cmd) < 0) return 1;
    DBG("Write %s", buf);
    if(write_tty(buf, strlen(buf))) return 1;
    double t0 = dtime();
    char *ans;
    while(dtime() - t0 < T_POLLING_TMOUT){ // read answer
        if((ans = read_string())){ // parse new data
            DBG("got %s", ans);
            if(strstr(ans, "OK")){
                DBG("Succesfull");
                return 0;
            }
        }
    }
    return 1;
}

/**
 * Poll serial port for new dataportion
 * @return: NULL if no data received, pointer to string if valid data received
 */
char *poll_device(){
    char *ans;
    static char pollbuf[32];
    double t0 = dtime();
    const char *cmdstat = "SHUTTERSTATUS?";
    const char *cmdget  = "SHUTTERS?";
    #define CMDGETLEN  (9)
    while(read_string()); // clear receiving buffer
    if(write_cmd(cmdstat)) return NULL; // error writing command
    DBG("poll answer");
    while(dtime() - t0 < T_POLLING_TMOUT){ // read answer
        if((ans = read_string())){ // parse new data
            DBG("got %s", ans);
            if(strstr(ans, cmdget) == NULL){
                DBG("no %s found in %s", cmdstat, ans);
                return NULL; // ?
            }
            ans += CMDGETLEN;
            if(strstr(ans, "1,1,1,1,1")){
                sprintf(pollbuf, "opened\n");
                DBG("shutters opened");
            }else if(strstr(ans, "0,0,0,0,0")){
                sprintf(pollbuf, "closed\n");
                DBG("shutters closed");
            }else sprintf(pollbuf, "intermediate\n");
            return pollbuf;
        }
    }
    return NULL;
}

/**
 * ping device
 * @return 0 if all OK
 */
int ping(){
    FNAME();
    if(write_cmd("PING?")) return 1;
    return 0;
}