hamlib/simulators/simft710.c

// can run this using rigctl/rigctld and socat pty devices
#define _XOPEN_SOURCE 700
// since we are POSIX here we need this
#include <stdio.h>
#include <string.h>
#include <unistd.h>

#if 0
#include "hamlib/rig.h"
#include "misc.h"
#else
int hl_usleep(unsigned long usec);
#endif

float freqA = 14074000;
float freqB = 14074500;
char tx_vfo = '0';
char rx_vfo = '0';
char modeA = '1';
char modeB = '1';
int ks = 20;
int bandselect = 5;
int  width = 21;
int narrow = 0;
int vd = 0;
int sm0 = 0;
int sm1 = 0;
int vs = 0;
int vx = 0;
int pa = 0;
int ra = 0;
int ag = 0;
int pc = 100;
int is = 0;
int bp_on = 0;
int bp_pos = 0;
int rl = 0;
int nb = 0;
int nr = 0;
int tx = 0;
int mg = 0;
int rg = 100;
int vg = 0;
int kr = 0;
int bi = 0;
int gt = 0;
int ex016 = 0;
int ex020 = 0;
int st = 0;


#include "sim.h"


int main(int argc, char *argv[])
{
    char buf[BUFSIZE];
    char *pbuf;
    int n;
    int fd = openPort(argv[1]);

    while (1)
    {
        if (getmyline(fd, buf))
        {
//            printf("Cmd:%s\n", buf);
        }
        else { continue; }

        if (strcmp(buf, ";") == 0)
        {
            pbuf = "?;";
            n = write(fd, pbuf, strlen(pbuf));
        }
        else if (strcmp(buf, "RM4;") == 0)
        {
            hl_usleep(50 * 1000);
            pbuf = "RM4100;";
            n = write(fd, pbuf, strlen(pbuf));

            if (n <= 0) { perror("RM4"); }
        }
        else if (strcmp(buf, "RM5;") == 0)
        {
            static int power = 0;
            power += 5;

            if (power > 255) { power = 0; }

            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "RM5%03d000;", power);
            n = write(fd, buf, strlen(buf));

            if (n <= 0) { perror("RM5"); }
        }
        else if (strcmp(buf, "RM6;") == 0)
        {
            hl_usleep(50 * 1000);
            pbuf = "AN030;";
            n = write(fd, pbuf, strlen(pbuf));

            if (n <= 0) { perror("AN"); }
        }
        else if (strcmp(buf, "IF;") == 0)
        {
            hl_usleep(50 * 1000);
            pbuf = "IF059014200000+000000700000;";
            n = write(fd, pbuf, strlen(pbuf));

            if (n <= 0) { perror("IF"); }
        }
        else if (strcmp(buf, "FA;") == 0)
        {
            snprintf(buf, sizeof(buf), "FA%08.0f;", freqA);
            n = write(fd, buf, strlen(buf));
        }
        else if (strncmp(buf, "FA", 2) == 0)
        {
            sscanf(buf, "FA%f", &freqA);
        }
        else if (strcmp(buf, "FB;") == 0)
        {
            snprintf(buf, sizeof(buf), "FB%08.0f;", freqB);
            n = write(fd, buf, strlen(buf));
        }
        else if (strncmp(buf, "FB", 2) == 0)
        {
            sscanf(buf, "FB%f", &freqB);
        }
        else if (strcmp(buf, "ID;") == 0)
        {
            hl_usleep(50 * 1000);
            int id = NC_RIGID_FT710;
            snprintf(buf, sizeof(buf), "ID%03d;", id);
            n = write(fd, buf, strlen(buf));

            if (n <= 0) { perror("ID"); }
        }
        else if (strcmp(buf, "PS;") == 0)
        {
            snprintf(buf, sizeof(buf), "PS1;");
            n = write(fd, buf, strlen(buf));
        }
        else if (strcmp(buf, "AI;") == 0)
        {
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "AI0;");
            n = write(fd, buf, strlen(buf));

            if (n <= 0) { perror("ID"); }
        }
        else if (strcmp(buf, "AI0;") == 0)
        {
            hl_usleep(50 * 1000);
        }
        else if (strcmp(buf, "FT;") == 0)
        {
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "FT%c;", tx_vfo);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("FT"); }
        }
        else if (strncmp(buf, "FT", 2) == 0)
        {
            tx_vfo = buf[2];
        }
        else if (strcmp(buf, "MD0;") == 0)
        {
            printf("MD=%s\n", buf);
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "MD0%c;", modeA);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("MD0;"); }
        }
        else if (strncmp(buf, "MD0", 3) == 0)
        {
            modeA = buf[3];
        }
        else if (strcmp(buf, "MD1;") == 0)
        {
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "MD1%c;", modeB);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("MD0;"); }
        }
        else if (strncmp(buf, "MD1", 3) == 0)
        {
            modeB = buf[3];
        }



#if 0
        else if (strncmp(buf, "AI", 2) == 0)
        {
            if (strcmp(buf, "AI;"))
            {
                hl_usleep(50 * 1000);
                n = fprintf(fp, "%s", "AI0;");

                if (n <= 0) { perror("AI"); }
            }
        }

#endif
        else if (strcmp(buf, "VS;") == 0)
        {
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "VS%d;", vs);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("VS"); }
        }
        else if (strncmp(buf, "VS", 2) == 0)
        {
            sscanf(buf, "VS%d", &vs);
        }
        else if (strcmp(buf, "KR;") == 0)
        {
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "KR%d;", kr);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("KR"); }
        }
        else if (strncmp(buf, "KR", 2) == 0)
        {
            sscanf(buf, "KR%d", &kr);
        }
        else if (strcmp(buf, "BI;") == 0)
        {
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "BI%d;", bi);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("BI"); }
        }
        else if (strncmp(buf, "BI", 2) == 0)
        {
            sscanf(buf, "BI%d", &bi);
        }
        else if (strcmp(buf, "VX;") == 0)
        {
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "VX%d;", vx);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("VX"); }
        }
        else if (strncmp(buf, "VX", 2) == 0)
        {
            sscanf(buf, "VX%d", &vx);
        }

        else if (strcmp(buf, "PA;") == 0)
        {
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "PA%d;", pa);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("PA"); }
        }
        else if (strncmp(buf, "PA", 2) == 0)
        {
            sscanf(buf, "PA%d", &vs);
        }
        else if (strcmp(buf, "RA;") == 0)
        {
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "RA%d;", ra);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("RA"); }
        }
        else if (strncmp(buf, "RA", 2) == 0)
        {
            sscanf(buf, "RA%d", &ra);
        }
        else if (strcmp(buf, "AG;") == 0)
        {
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "AG%d;", ag);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("AG"); }
        }
        else if (strncmp(buf, "AG", 2) == 0)
        {
            sscanf(buf, "AG%d", &ag);
        }
        else if (strcmp(buf, "PC;") == 0)
        {
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "PC%03d;", pc);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("PC"); }
        }
        else if (strncmp(buf, "PC", 2) == 0)
        {
            sscanf(buf, "PC%d", &pc);
        }
        else if (strcmp(buf, "VG;") == 0)
        {
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "VG%03d;", vg);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("VG"); }
        }
        else if (strncmp(buf, "VG", 2) == 0)
        {
            sscanf(buf, "VG%d", &vg);
        }
        else if (strcmp(buf, "RG0;") == 0)
        {
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "RG0%03d;", rg);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("RG"); }
        }
        else if (strncmp(buf, "RG", 2) == 0)
        {
            sscanf(buf, "RG0%d", &rg);
        }
        else if (strcmp(buf, "GT0;") == 0)
        {
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "GT0%0d;", gt);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("GT"); }
        }
        else if (strncmp(buf, "GT", 2) == 0)
        {
            sscanf(buf, "GT0%d", &gt);
        }
        else if (strcmp(buf, "TX;") == 0)
        {
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "TX+%04d;", tx);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("TX"); }
        }
        else if (strncmp(buf, "TX", 2) == 0)
        {
            sscanf(buf, "TX%d", &tx);
        }
        else if (strcmp(buf, "IS;") == 0)
        {
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "IS+%04d;", is);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("IS"); }
        }
        else if (strncmp(buf, "IS", 2) == 0)
        {
            sscanf(buf, "IS%d", &is);
        }
        else if (strcmp(buf, "RL0;") == 0)
        {
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "RL0%d;", rl);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("RL"); }
        }
        else if (strncmp(buf, "RL", 2) == 0)
        {
            sscanf(buf, "RL0%02d", &rl);
        }
        else if (strcmp(buf, "BP00;") == 0)
        {
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "BP0%d;", bp_on);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("BP"); }
        }
        else if (strncmp(buf, "BP00", 4) == 0)
        {
            sscanf(buf, "BP00%d", &bp_on);
        }
        else if (strcmp(buf, "BP01;") == 0)
        {
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "BP0%d;", bp_pos);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("BP"); }
        }
        else if (strncmp(buf, "BP01", 4) == 0)
        {
            sscanf(buf, "BP01%d", &bp_pos);
        }
        else if (strcmp(buf, "NB0;") == 0)
        {
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "NB0%d;", nb);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("NB"); }
        }
        else if (strncmp(buf, "NB0", 3) == 0)
        {
            sscanf(buf, "NB0%d", &nb);
        }
        else if (strcmp(buf, "NR0;") == 0)
        {
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "NR0%d;", nr);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("NR"); }
        }
        else if (strncmp(buf, "NR0", 3) == 0)
        {
            sscanf(buf, "NR0%d", &nr);
        }


        else if (strcmp(buf, "EX032;") == 0)
        {
            static int ant = 0;
            ant = (ant + 1) % 3;
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "EX032%1d;", ant);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("EX032"); }
        }
        else if (strcmp(buf, "EX016;") == 0)
        {
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "EX016%04d;", ex016);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("EX016"); }
        }
        else if (strcmp(buf, "EX020;") == 0)
        {
            hl_usleep(50 * 1000);
            snprintf(buf, sizeof(buf), "EX020%04d;", ex020);
            n = write(fd, buf, strlen(buf));

            if (n < 0) { perror("EX016"); }
        }
        else if (strncmp(buf, "EX020", 5) == 0)
        {
            sscanf(buf, "EX020%d\n", &ex020);
        }
        else if (strncmp(buf, "KS;", 3) == 0)
        {
            sprintf(buf, "KS%d;", ks);
            n = write(fd, buf, strlen(buf));
        }
        else if (strncmp(buf, "KS", 2) == 0)
        {
            sscanf(buf, "KS%03d", &ks);
        }
        else if (strncmp(buf, "MG;", 3) == 0)
        {
            sprintf(buf, "MG%03d;", mg);
            n = write(fd, buf, strlen(buf));
        }
        else if (strncmp(buf, "MG", 2) == 0)
        {
            sscanf(buf, "MG%03d", &mg);
        }
        else if (strncmp(buf, "BS;", 3) == 0) // cannot query BS
        {
            sprintf(buf, "BS%02d;", bandselect);
            n = write(fd, buf, strlen(buf));
        }
        else if (strncmp(buf, "SH0;", 4) == 0)
        {
            sprintf(buf, "SH00%02d;", width);
            n = write(fd, buf, strlen(buf));
        }
        else if (strncmp(buf, "SH0", 3) == 0)
        {
            sscanf(buf, "SH00%02d", &width);
        }
        else if (strncmp(buf, "NA0;", 4) == 0)
        {
            sprintf(buf, "NA0%d;", narrow);
            n = write(fd, buf, strlen(buf));
        }
        else if (strncmp(buf, "NA0", 3) == 0)
        {
            sscanf(buf, "NA0%d", &narrow);
        }
        else if (strncmp(buf, "VD;", 3) == 0)
        {
            sprintf(buf, "VD%d;", vd);
            n = write(fd, buf, strlen(buf));
        }
        else if (strncmp(buf, "VD", 2) == 0)
        {
            sscanf(buf, "VD%d", &vd);
        }
        else if (strncmp(buf, "SM0;", 4) == 0)
        {
            sprintf(buf, "SM0%d;", sm0);
            n = write(fd, buf, strlen(buf));
        }
        else if (strncmp(buf, "SM0", 3) == 0)
        {
            sscanf(buf, "SM0%3d", &sm0);
        }
        else if (strncmp(buf, "SM1;", 4) == 0)
        {
            sprintf(buf, "SM1%d;", sm1);
            n = write(fd, buf, strlen(buf));
        }
        else if (strncmp(buf, "SM1", 3) == 0)
        {
            sscanf(buf, "SM1%3d", &sm1);
        }
        else if (strncmp(buf, "ST1", 3) == 0)
        {
            sscanf(buf, "ST1%3d", &st);
        }
        else if (strncmp(buf, "ST;", 3) == 0)
        {
            sprintf(buf, "ST%d;", st);
            n = write(fd, buf, strlen(buf));
        }
	else if (strncmp(buf, "RF", 2) == 0)  // Not defined for FT-710
        {
            n = write(fd, "?;", 2);
        }
        else if (strlen(buf) > 0)
        {
            fprintf(stderr, "Unknown command: %s\n", buf);
        }

    }

    return 0;
}