Add thread to anytone.c to do the keep alive it needs

https://github.com/Hamlib/Hamlib/issues/1303
pull/1330/head
Mike Black W9MDB 2023-05-27 12:51:24 -05:00
rodzic c4a56a4cf0
commit 34f20cc970
3 zmienionych plików z 74 dodań i 12 usunięć

Wyświetl plik

@ -29,6 +29,7 @@
#include <string.h>
#include <unistd.h>
#include <ctype.h>
#include <errno.h>
// ---------------------------------------------------------------------------
// HAMLIB INCLUDES
@ -117,6 +118,30 @@ DECLARE_PROBERIG_BACKEND(anytone)
return retval;
}
// AnyTone needs a keep-alive to emulate the MIC
// Apparently to keep the rig from getting stuck in PTT if mic disconnects
void *anytone_thread(void *vrig)
{
RIG *rig = (RIG *)vrig;
anytone_priv_data_t *p = rig->state.priv;
rig_debug(RIG_DEBUG_TRACE, "%s: anytone_thread started\n", __func__);
p->runflag = 1;
while (p->runflag)
{
char c = 0x06;
MUTEX_LOCK(p->priv.mutex);
write_block(&rig->state.rigport, (unsigned char *)&c, 1);
hl_usleep(100 * 1000);
rig_flush(&rig->state.rigport);
MUTEX_UNLOCK(p->priv.mutex);
hl_usleep(1000 * 1000); // 1-second loop
}
return NULL;
}
// ---------------------------------------------------------------------------
// anytone_send
// ---------------------------------------------------------------------------
@ -174,6 +199,7 @@ int anytone_transaction(RIG *rig, char *cmd, int cmd_len)
}
else
{
MUTEX_LOCK(p->priv.mutex);
retval = anytone_send(rig, cmd, cmd_len);
if (retval == RIG_OK)
@ -181,6 +207,8 @@ int anytone_transaction(RIG *rig, char *cmd, int cmd_len)
char buf[16];
anytone_receive(rig, buf, sizeof(buf), 1);
}
MUTEX_LOCK(p->priv.mutex);
}
RETURNFUNC(retval);
@ -212,6 +240,9 @@ int anytone_init(RIG *rig)
rig->state.priv = pPriv;
anytone_priv_data_t *p = rig->state.priv;
p->vfo_curr = RIG_VFO_NONE;
#ifdef HAVE_PTHREAD
pthread_mutex_init(&p->mutex, NULL);
#endif
}
RETURNFUNC(retval);
@ -265,6 +296,17 @@ int anytone_open(RIG *rig)
// can we ask for any information? Maybe just toggle A/B?
}
pthread_t id;
int err = pthread_create(&id, NULL, anytone_thread, (void *)rig);
if (err)
{
rig_debug(RIG_DEBUG_ERR, "%s: pthread_create error: %s\n", __func__,
strerror(errno));
RETURNFUNC(-RIG_EINTERNAL);
}
RETURNFUNC(retval);
}
@ -333,18 +375,19 @@ int anytone_set_vfo(RIG *rig, vfo_t vfo)
}
else
{
// can we use status reponse to deteremin which VFO is active?
if (vfo == RIG_VFO_A)
{
char buf1[8] = { 0x41, 0x00, 0x01, 0x00, 0x1a, 0x00, 0x00, 0x06 };
char buf2[8] = { 0x41, 0x00, 0x00, 0x00, 0x1a, 0x00, 0x00, 0x06 };
char buf1[8] = { 0x41, 0x00, 0x01, 0x00, 0x0d, 0x00, 0x00, 0x06 };
char buf2[8] = { 0x41, 0x00, 0x00, 0x00, 0x0d, 0x00, 0x00, 0x06 };
anytone_transaction(rig, buf1, 8);
hl_usleep(100 * 1000);
anytone_transaction(rig, buf2, 8);
}
else
{
char buf1[8] = { 0x41, 0x00, 0x01, 0x00, 0x1b, 0x00, 0x00, 0x06 };
char buf2[8] = { 0x41, 0x00, 0x00, 0x00, 0x1b, 0x00, 0x00, 0x06 };
char buf1[8] = { 0x41, 0x00, 0x01, 0x00, 0x0d, 0x00, 0x00, 0x06 };
char buf2[8] = { 0x41, 0x00, 0x00, 0x00, 0x0d, 0x00, 0x00, 0x06 };
anytone_transaction(rig, buf1, 8);
hl_usleep(100 * 1000);
anytone_transaction(rig, buf2, 8);

Wyświetl plik

@ -9,10 +9,23 @@
extern const struct rig_caps anytone_d578_caps;
#ifdef PTHREAD
#include <pthread.h>
#define MUTEX(var) static pthread_mutex_t var = PTHREAD_MUTEX_INITIALIZER
#define MUTEX_LOCK(var) pthread_mutex_lock(var)
#define MUTEX_UNLOCK(var) pthread_mutex_unlock(var)
#else
#define MUTEX(var)
#define MUTEX_LOCK(var)
#define MUTEX_UNLOCK(var)
#endif
typedef struct _anytone_priv_data
{
int ptt;
vfo_t vfo_curr;
int runflag; // thread control
pthread_mutex_t mutex;
} anytone_priv_data_t,
* anytone_priv_data_ptr;

Wyświetl plik

@ -38,13 +38,14 @@ getmyline(int fd, unsigned char *buf)
// seemd the anytone only gives 8-byte commands and 1-byte responses
while (i < 8 && read(fd, &c, 1) > 0)
{
if (i==0 && buf[i]==0x06)
if (i == 0 && c == 0x06)
{
write(fd, buf, 1);
write(fd, &c, 1);
}
else {
buf[i++] = c;
n++;
else
{
buf[i++] = c;
n++;
}
}
@ -96,10 +97,8 @@ int openPort(char *comport) // doesn't matter for using pts devices
int main(int argc, char *argv[])
{
unsigned char buf[256];
unsigned char *pbuf;
int n;
again:
int fd = openPort(argv[1]);
@ -136,8 +135,15 @@ again:
n = write(fd, buf, 1);
break;
default: printf("Unknown cmd=%02x\n", buf[0]);
case 0x06:
buf[0] = 0x06;
n = write(fd, buf, 1);
break;
default: printf("Unknown cmd=%02x\n", buf[0]); continue;
}
printf("%d bytes returned\n", n);
}
return 0;