mirror
/
Hamlib
kopia lustrzana https://github.com/Hamlib/Hamlib
1
0
Forkuj 0
Kod Zgłoszenia Projekty Wydania Wiki Aktywność

Reformatted src directory

pull/1/head
Nate Bargmann 2017-08-05 09:09:12 -05:00
rodzic 01bef2d158
commit f76b354588
31 zmienionych plików z 9584 dodań i 7142 usunięć
Pokaż statystyki Ściągnij plik aktualizacji Ściągnij plik porównania Expand all files Collapse all files

60
src/cal.c
Wyświetl plik

@ -39,6 +39,7 @@
/* add rig_set_cal(cal_table), rig_get_calstat(rawmin,rawmax,cal_table), */
/**
* \brief Convert raw S-meter data to calibated value, according to table
* \param rawval input value
@ -52,48 +53,55 @@
* If a value is greater or equal to cal_table_t.table[cal_table_t.size-1].raw,
* rig_raw2val() will return cal_table_t.table[cal_table_t.size-1].val
*/
float HAMLIB_API rig_raw2val(int rawval, const cal_table_t *cal)
{
#ifdef WANT_CHEAP_WNO_FP
int interpolation;
int interpolation;
#else
float interpolation;
float interpolation;
#endif
int i;
int i;
/* ASSERT(cal != NULL) */
/* ASSERT(cal->size <= MAX_CAL_LENGTH) */
/* ASSERT(cal != NULL) */
/* ASSERT(cal->size <= MAX_CAL_LENGTH) */
if (cal->size == 0)
return rawval;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
for (i=0; i<cal->size; i++)
if (rawval < cal->table[i].raw)
break;
if (cal->size == 0) {
return rawval;
}
if (i==0)
return cal->table[0].val;
for (i = 0; i < cal->size; i++)
if (rawval < cal->table[i].raw) {
break;
}
if (i>=cal->size)
return cal->table[i-1].val;
if (i == 0) {
return cal->table[0].val;
}
if (cal->table[i].raw == cal->table[i-1].raw) /* catch divide by 0 error */
return cal->table[i].val;
if (i >= cal->size) {
return cal->table[i - 1].val;
}
/* catch divide by 0 error */
if (cal->table[i].raw == cal->table[i - 1].raw) {
return cal->table[i].val;
}
#ifdef WANT_CHEAP_WNO_FP
/* cheap, less accurate, but no fp needed */
interpolation = ((cal->table[i].raw - rawval) *
(cal->table[i].val - cal->table[i-1].val)) /
(cal->table[i].raw - cal->table[i-1].raw);
/* cheap, less accurate, but no fp needed */
interpolation = ((cal->table[i].raw - rawval)
* (cal->table[i].val - cal->table[i - 1].val))
/ (cal->table[i].raw - cal->table[i - 1].raw);
return cal->table[i].val - interpolation;
return cal->table[i].val - interpolation;
#else
interpolation = ((cal->table[i].raw - rawval) *
(float)(cal->table[i].val - cal->table[i-1].val)) /
(float)(cal->table[i].raw - cal->table[i-1].raw);
interpolation = ((cal->table[i].raw - rawval)
* (float)(cal->table[i].val - cal->table[i - 1].val))
/ (float)(cal->table[i].raw - cal->table[i - 1].raw);
#endif
return cal->table[i].val - interpolation;
return cal->table[i].val - interpolation;
}
/** @} */

259
src/cm108.c
Wyświetl plik

@ -65,7 +65,7 @@
#include <linux/hidraw.h>
#endif
#include "hamlib/rig.h"
#include <hamlib/rig.h>
#include "cm108.h"
@ -74,73 +74,78 @@
* \param port
* \return file descriptor
*/
int cm108_open(hamlib_port_t *port)
{
int fd;
int fd;
rig_debug(RIG_DEBUG_VERBOSE,"cm108:cm108_open called \n");
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
if (!port->pathname[0]) {
return -RIG_EINVAL;
}
if (!port->pathname[0])
return -RIG_EINVAL;
fd = open(port->pathname, O_RDWR);
fd = open(port->pathname, O_RDWR);
if (fd < 0) {
rig_debug(RIG_DEBUG_ERR, "cm108:Opening device \"%s\": %s\n", port->pathname, strerror(errno));
return -RIG_EIO;
}
if (fd < 0) {
rig_debug(RIG_DEBUG_ERR,
"%s: opening device \"%s\": %s\n",
__func__,
port->pathname,
strerror(errno));
return -RIG_EIO;
}
#ifdef HAVE_LINUX_HIDRAW_H
// CM108 detection copied from Thomas Sailer's soundmodem code
// CM108 detection copied from Thomas Sailer's soundmodem code
rig_debug(RIG_DEBUG_VERBOSE,"cm108:Checking for cm108 (or compatible) device \n");
rig_debug(RIG_DEBUG_VERBOSE,
"%s: checking for cm108 (or compatible) device\n",
__func__);
struct hidraw_devinfo hiddevinfo;
struct hidraw_devinfo hiddevinfo;
if (!ioctl(fd, HIDIOCGRAWINFO, &hiddevinfo)
&& ((hiddevinfo.vendor == 0x0d8c
// CM108/109/119/119A
&& ((hiddevinfo.product >= 0x0008
&& hiddevinfo.product <= 0x000f)
|| hiddevinfo.product == 0x013a))
// SSS1621/23
|| (hiddevinfo.vendor == 0x0c76
&& (hiddevinfo.product == 0x1605
|| hiddevinfo.product == 0x1607
|| hiddevinfo.product == 0x160b))))
{
rig_debug(RIG_DEBUG_VERBOSE,
"%s: cm108 compatible device detected\n",
__func__);
} else {
close(fd);
rig_debug(RIG_DEBUG_VERBOSE,
"%s: no cm108 (or compatible) device detected\n",
__func__);
return -RIG_EINVAL;
}
if (!ioctl(fd, HIDIOCGRAWINFO, &hiddevinfo)
&&
(
(hiddevinfo.vendor == 0x0d8c && // CM108/109/119/119A
((hiddevinfo.product >= 0x0008 &&
hiddevinfo.product <= 0x000f) ||
hiddevinfo.product == 0x013a)
)
||
(hiddevinfo.vendor == 0x0c76 && // SSS1621/23
(hiddevinfo.product == 0x1605 ||
hiddevinfo.product == 0x1607 ||
hiddevinfo.product == 0x160b)
)
)
)
{
rig_debug(RIG_DEBUG_VERBOSE,"cm108:cm108 compatible device detected \n");
}
else
{
close(fd);
rig_debug(RIG_DEBUG_VERBOSE,"cm108:No cm108 (or compatible) device detected \n");
return -RIG_EINVAL;
}
#endif
port->fd = fd;
return fd;
port->fd = fd;
return fd;
}
/**
* \brief Close CM108 HID port
* \param port
*/
int cm108_close(hamlib_port_t *port)
{
rig_debug(RIG_DEBUG_VERBOSE,"cm108:cm108_close called \n");
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
return close(port->fd);
return close(port->fd);
}
/**
* \brief Set or unset Push to talk bit on CM108 GPIO
* \param p
@ -149,62 +154,70 @@ int cm108_close(hamlib_port_t *port)
*/
int cm108_ptt_set(hamlib_port_t *p, ptt_t pttx)
{
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
rig_debug(RIG_DEBUG_VERBOSE,"cm108:cm108_ptt_set called \n");
// For a CM108 USB audio device PTT is wired up to one of the GPIO
// pins. Usually this is GPIO3 (bit 2 of the GPIO register) because it
// is on the corner of the chip package (pin 13) so it's easily accessible.
// Some CM108 chips are epoxy-blobbed onto the PCB, so no GPIO
// pins are accessible. The SSS1623 chips have a different pinout, so
// we make the GPIO bit number configurable.
// For a CM108 USB audio device PTT is wired up to one of the GPIO
// pins. Usually this is GPIO3 (bit 2 of the GPIO register) because it
// is on the corner of the chip package (pin 13) so it's easily accessible.
// Some CM108 chips are epoxy-blobbed onto the PCB, so no GPIO
// pins are accessible. The SSS1623 chips have a different pinout, so
// we make the GPIO bit number configurable.
switch (p->type.ptt) {
case RIG_PTT_CM108: {
switch(p->type.ptt) {
case RIG_PTT_CM108:
{
// Build a packet for CM108 HID to turn GPIO bit on or off.
// Packet is 4 bytes, preceded by a 'report number' byte
// 0x00 report number
// Write data packet (from CM108 documentation)
// byte 0: 00xx xxxx Write GPIO
// byte 1: xxxx dcba GPIO3-0 output values (1=high)
// byte 2: xxxx dcba GPIO3-0 data-direction register (1=output)
// byte 3: xxxx xxxx SPDIF
// Build a packet for CM108 HID to turn GPIO bit on or off.
// Packet is 4 bytes, preceded by a 'report number' byte
// 0x00 report number
// Write data packet (from CM108 documentation)
// byte 0: 00xx xxxx Write GPIO
// byte 1: xxxx dcba GPIO3-0 output values (1=high)
// byte 2: xxxx dcba GPIO3-0 data-direction register (1=output)
// byte 3: xxxx xxxx SPDIF
rig_debug(RIG_DEBUG_VERBOSE,
"%s: bit number %d to state %d\n",
__func__,
p->parm.cm108.ptt_bitnum,
(pttx == RIG_PTT_ON) ? 1 : 0);
rig_debug(RIG_DEBUG_VERBOSE,"cm108:cm108_ptt_set bit number %d to state %d\n",
p->parm.cm108.ptt_bitnum, (pttx == RIG_PTT_ON) ? 1 : 0);
char out_rep[] = {
0x00, // report number
// HID output report
0x00,
(pttx == RIG_PTT_ON) ? (1 << p->parm.cm108.ptt_bitnum) : 0, // set GPIO
1 << p->parm.cm108.ptt_bitnum, // Data direction register (1=output)
0x00
};
char out_rep[] = {
0x00, // report number
// HID output report
0x00,
(pttx == RIG_PTT_ON) ? (1 << p->parm.cm108.ptt_bitnum) : 0, // set GPIO
1 << p->parm.cm108.ptt_bitnum, // Data direction register (1=output)
0x00
};
ssize_t nw;
ssize_t nw;
if (p->fd == -1) {
return -RIG_EINVAL;
}
if (p->fd == -1)
return -RIG_EINVAL;
// Send the HID packet
nw = write(p->fd, out_rep, sizeof(out_rep));
// Send the HID packet
nw = write(p->fd, out_rep, sizeof(out_rep));
if (nw < 0) {
return -RIG_EIO;
}
if (nw < 0) {
return -RIG_EIO;
}
return RIG_OK;
}
default:
rig_debug(RIG_DEBUG_ERR,"Unsupported PTT type %d\n",
p->type.ptt);
return -RIG_EINVAL;
}
return RIG_OK;
return RIG_OK;
}
default:
rig_debug(RIG_DEBUG_ERR,
"%s: unsupported PTT type %d\n",
__func__,
p->type.ptt);
return -RIG_EINVAL;
}
return RIG_OK;
}
/**
* \brief Get state of Push to Talk from CM108 GPIO
* \param p
@ -213,21 +226,24 @@ int cm108_ptt_set(hamlib_port_t *p, ptt_t pttx)
*/
int cm108_ptt_get(hamlib_port_t *p, ptt_t *pttx)
{
rig_debug(RIG_DEBUG_VERBOSE,"cm108:cm108_ptt_get called \n");
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
switch(p->type.ptt) {
case RIG_PTT_CM108:
{
int status;
return -RIG_ENIMPL;
return status;
}
default:
rig_debug(RIG_DEBUG_ERR,"Unsupported PTT type %d\n",
p->type.ptt);
return -RIG_ENAVAIL;
}
return RIG_OK;
switch (p->type.ptt) {
case RIG_PTT_CM108: {
int status;
return -RIG_ENIMPL;
return status;
}
default:
rig_debug(RIG_DEBUG_ERR,
"%s: unsupported PTT type %d\n",
__func__,
p->type.ptt);
return -RIG_ENAVAIL;
}
return RIG_OK;
}
/**
@ -238,26 +254,29 @@ int cm108_ptt_get(hamlib_port_t *p, ptt_t *pttx)
*/
int cm108_dcd_get(hamlib_port_t *p, dcd_t *dcdx)
{
rig_debug(RIG_DEBUG_VERBOSE,"cm108:cm108_dcd_get called \n");
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
// On the CM108 and compatible chips the squelch line on the radio is
// wired to Volume Down input pin. The state of this pin is reported
// in HID messages from the CM108 device, but I am not sure how
// to query this state on demand.
// On the CM108 and compatible chips the squelch line on the radio is
// wired to Volume Down input pin. The state of this pin is reported
// in HID messages from the CM108 device, but I am not sure how
// to query this state on demand.
switch(p->type.dcd) {
case RIG_DCD_CM108:
{
int status;
return -RIG_ENIMPL;
return status;
}
default:
rig_debug(RIG_DEBUG_ERR,"Unsupported DCD type %d\n",
p->type.dcd);
return -RIG_ENAVAIL;
}
return RIG_OK;
switch (p->type.dcd) {
case RIG_DCD_CM108: {
int status;
return -RIG_ENIMPL;
return status;
}
default:
rig_debug(RIG_DEBUG_ERR,
"%s: unsupported DCD type %d\n",
__func__,
p->type.dcd);
return -RIG_ENAVAIL;
}
return RIG_OK;
}
/** @} */

21
src/cm108.h
Wyświetl plik

@ -36,12 +36,23 @@ int cm108_ptt_set(hamlib_port_t *p, ptt_t pttx);
int cm108_ptt_get(hamlib_port_t *p, ptt_t *pttx);
int cm108_dcd_get(hamlib_port_t *p, dcd_t *dcdx);
extern HAMLIB_EXPORT(int) cm108_write_data(hamlib_port_t *p, unsigned char data);
extern HAMLIB_EXPORT(int) cm108_write_control(hamlib_port_t *p, unsigned char control);
extern HAMLIB_EXPORT(int) cm108_read_data(hamlib_port_t *p, unsigned char *data);
extern HAMLIB_EXPORT(int) cm108_read_control(hamlib_port_t *p, unsigned char *control);
extern HAMLIB_EXPORT(int) cm108_read_status(hamlib_port_t *p, unsigned char *status);
extern HAMLIB_EXPORT(int) cm108_write_data(hamlib_port_t *p,
unsigned char data);
extern HAMLIB_EXPORT(int) cm108_write_control(hamlib_port_t *p,
unsigned char control);
extern HAMLIB_EXPORT(int) cm108_read_data(hamlib_port_t *p,
unsigned char *data);
extern HAMLIB_EXPORT(int) cm108_read_control(hamlib_port_t *p,
unsigned char *control);
extern HAMLIB_EXPORT(int) cm108_read_status(hamlib_port_t *p,
unsigned char *status);
extern HAMLIB_EXPORT(int) cm108_lock(hamlib_port_t *p);
extern HAMLIB_EXPORT(int) cm108_unlock(hamlib_port_t *p);
__END_DECLS

1160
src/conf.c
Wyświetl plik

Plik diff jest za duży Load Diff

198
src/debug.c
Wyświetl plik

@ -35,11 +35,11 @@
#include <stdlib.h>
#include <stdarg.h>
#include <stdio.h> /* Standard input/output definitions */
#include <string.h> /* String function definitions */
#include <unistd.h> /* UNIX standard function definitions */
#include <fcntl.h> /* File control definitions */
#include <errno.h> /* Error number definitions */
#include <stdio.h> /* Standard input/output definitions */
#include <string.h> /* String function definitions */
#include <unistd.h> /* UNIX standard function definitions */
#include <fcntl.h> /* File control definitions */
#include <errno.h> /* Error number definitions */
#include <sys/types.h>
#include <unistd.h>
@ -48,16 +48,17 @@
#endif
#include <hamlib/rig.h>
#include "misc.h"
#define DUMP_HEX_WIDTH 16
static int rig_debug_level = RIG_DEBUG_TRACE;
static FILE *rig_debug_stream;
static vprintf_cb_t rig_vprintf_cb;
static rig_ptr_t rig_vprintf_arg;
#define DUMP_HEX_WIDTH 16
/**
* \param ptr Pointer to memory area
* \param size Number of chars to words to dump
@ -65,39 +66,42 @@ static rig_ptr_t rig_vprintf_arg;
*/
void dump_hex(const unsigned char ptr[], size_t size)
{
/* example
* 0000 4b 30 30 31 34 35 30 30 30 30 30 30 30 35 30 32 K001450000000502
* 0010 30 30 0d 0a 00..
*/
char line[4 + 4 + 3 * DUMP_HEX_WIDTH + 4 + DUMP_HEX_WIDTH + 1];
unsigned char c;
int i;
/* example
* 0000 4b 30 30 31 34 35 30 30 30 30 30 30 30 35 30 32 K001450000000502
* 0010 30 30 0d 0a 00..
*/
char line[4 + 4 + 3 * DUMP_HEX_WIDTH + 4 + DUMP_HEX_WIDTH + 1];
unsigned char c;
int i;
if (!rig_need_debug(RIG_DEBUG_TRACE))
return;
if (!rig_need_debug(RIG_DEBUG_TRACE)) {
return;
}
line[sizeof(line) - 1] = '\0';
line[sizeof(line) - 1] = '\0';
for (i = 0; i < size; ++i) {
if (i % DUMP_HEX_WIDTH == 0) {
/* new line */
sprintf(line + 0, "%04x", i);
memset(line + 4, ' ', sizeof(line) - 4 - 1);
}
for (i = 0; i < size; ++i) {
if (i % DUMP_HEX_WIDTH == 0) {
/* new line */
sprintf(line + 0, "%04x", i);
memset(line + 4, ' ', sizeof(line) - 4 - 1);
}
c = ptr[i];
c = ptr[i];
/* hex print */
sprintf(line + 8 + 3 * (i % DUMP_HEX_WIDTH), "%02x", c);
line[8 + 3 * (i % DUMP_HEX_WIDTH) + 2] = ' '; /* no \0 */
/* hex print */
sprintf(line + 8 + 3 * (i % DUMP_HEX_WIDTH), "%02x", c);
line[8 + 3 * (i % DUMP_HEX_WIDTH) + 2] = ' '; /* no \0 */
/* ascii print */
line[8 + 3 * DUMP_HEX_WIDTH + 4 + (i % DUMP_HEX_WIDTH)] = (c >= ' ' && c < 0x7f) ? c : '.';
/* ascii print */
line[8 + 3 * DUMP_HEX_WIDTH + 4 + (i % DUMP_HEX_WIDTH)] = (c >= ' '
&& c < 0x7f) ? c : '.';
/* actually print the line */
if (i + 1 == size || (i && i % DUMP_HEX_WIDTH == DUMP_HEX_WIDTH - 1))
rig_debug(RIG_DEBUG_TRACE, "%s\n", line);
}
/* actually print the line */
if (i + 1 == size || (i && i % DUMP_HEX_WIDTH == DUMP_HEX_WIDTH - 1)) {
rig_debug(RIG_DEBUG_TRACE, "%s\n", line);
}
}
}
@ -107,97 +111,114 @@ void dump_hex(const unsigned char ptr[], size_t size)
*/
void HAMLIB_API rig_set_debug(enum rig_debug_level_e debug_level)
{
rig_debug_level = debug_level;
rig_debug_level = debug_level;
}
/**
* \param debug_level
* \brief Useful for dump_hex, etc.
*/
int HAMLIB_API rig_need_debug(enum rig_debug_level_e debug_level)
{
return (debug_level <= rig_debug_level);
return (debug_level <= rig_debug_level);
}
/**
* \param debug_level
* \param fmt
* \brief Default is debugging messages are done through stderr
*/
void HAMLIB_API rig_debug(enum rig_debug_level_e debug_level, const char *fmt, ...)
void HAMLIB_API rig_debug(enum rig_debug_level_e debug_level,
const char *fmt, ...)
{
va_list ap;
va_list ap;
if (!rig_need_debug(debug_level))
return;
if (!rig_need_debug(debug_level)) {
return;
}
va_start(ap, fmt);
va_start(ap, fmt);
if (rig_vprintf_cb) {
if (rig_vprintf_cb) {
rig_vprintf_cb(debug_level, rig_vprintf_arg, fmt, ap);
} else {
if (!rig_debug_stream) {
rig_debug_stream = stderr;
}
rig_vprintf_cb(debug_level, rig_vprintf_arg, fmt, ap);
vfprintf(rig_debug_stream, fmt, ap);
fflush(rig_debug_stream);
}
} else {
if (!rig_debug_stream)
rig_debug_stream = stderr;
vfprintf (rig_debug_stream, fmt, ap);
fflush(rig_debug_stream);
}
va_end(ap);
va_end(ap);
#ifdef ANDROID
int a;
va_start(ap, fmt);
switch (debug_level){
switch (debug_level) {
// case RIG_DEBUG_NONE:
case RIG_DEBUG_BUG:
a = ANDROID_LOG_FATAL; break;
case RIG_DEBUG_ERR:
a = ANDROID_LOG_ERROR; break;
case RIG_DEBUG_WARN:
a = ANDROID_LOG_WARN; break;
case RIG_DEBUG_VERBOSE:
a = ANDROID_LOG_VERBOSE; break;
case RIG_DEBUG_TRACE:
a = ANDROID_LOG_VERBOSE; break;
default:
a = ANDROID_LOG_DEBUG; break;
case RIG_DEBUG_BUG:
a = ANDROID_LOG_FATAL;
break;
case RIG_DEBUG_ERR:
a = ANDROID_LOG_ERROR;
break;
case RIG_DEBUG_WARN:
a = ANDROID_LOG_WARN;
break;
case RIG_DEBUG_VERBOSE:
a = ANDROID_LOG_VERBOSE;
break;
case RIG_DEBUG_TRACE:
a = ANDROID_LOG_VERBOSE;
break;
default:
a = ANDROID_LOG_DEBUG;
break;
}
__android_log_vprint(a, PACKAGE_NAME, fmt, ap);
va_end(ap);
va_end(ap);
#endif
}
/**
* \brief set callback to handle debug messages
* \param cb The callback to install
* \param arg A Pointer to some private data to pass later on to the callback
* \param cb The callback to install
* \param arg A Pointer to some private data to pass later on to the callback
*
* Install a callback for \a rig_debug messages.
\code
int
rig_message_cb (enum rig_debug_level_e debug_level,
rig_ptr_t user_data,
const char *fmt,
va_list ap)
rig_message_cb(enum rig_debug_level_e debug_level,
rig_ptr_t user_data,
const char *fmt,
va_list ap)
{
char buf[1024];
char buf[1024];
sprintf (buf, "Message(%s) ", (char*)user_data);
syslog (LOG_USER, buf);
vsprintf (buf, fmt, ap);
syslog (LOG_USER, buf);
sprintf (buf, "Message(%s) ", (char*)user_data);
syslog (LOG_USER, buf);
vsprintf (buf, fmt, ap);
syslog (LOG_USER, buf);
return RIG_OK;
return RIG_OK;
}
. . .
. . .
char *cookie = "Foo";
rig_set_debug_callback (rig_message_cb, (rig_ptr_t)cookie);
char *cookie = "Foo";
rig_set_debug_callback (rig_message_cb, (rig_ptr_t)cookie);
\endcode
*
* \return RIG_OK if the operation has been sucessful, otherwise
@ -208,25 +229,26 @@ rig_message_cb (enum rig_debug_level_e debug_level,
*/
vprintf_cb_t HAMLIB_API rig_set_debug_callback(vprintf_cb_t cb, rig_ptr_t arg)
{
vprintf_cb_t prev_cb = rig_vprintf_cb;
vprintf_cb_t prev_cb = rig_vprintf_cb;
rig_vprintf_cb = cb;
rig_vprintf_arg = arg;
rig_vprintf_cb = cb;
rig_vprintf_arg = arg;
return prev_cb;
return prev_cb;
}
/**
* \brief change stderr to some different output
* \param stream The stream to set output to
*/
FILE* HAMLIB_API rig_set_debug_file(FILE *stream)
FILE * HAMLIB_API rig_set_debug_file(FILE *stream)
{
FILE *prev_stream = rig_debug_stream;
FILE *prev_stream = rig_debug_stream;
rig_debug_stream = stream;
rig_debug_stream = stream;
return prev_stream;
return prev_stream;
}
/** @} */

699
src/event.c
Wyświetl plik

@ -53,7 +53,6 @@
#include <hamlib/rig.h>
#include "event.h"
#if defined(WIN32) && !defined(HAVE_TERMIOS_H)
@ -78,8 +77,10 @@ static void sa_sigalrmhandler(int signum);
#endif
#endif
/* This one should be in an include file */
extern int foreach_opened_rig(int (*cfunc)(RIG *, rig_ptr_t),rig_ptr_t data);
extern int foreach_opened_rig(int (*cfunc)(RIG *, rig_ptr_t), rig_ptr_t data);
/*
* add_trn_rig
@ -89,61 +90,80 @@ extern int foreach_opened_rig(int (*cfunc)(RIG *, rig_ptr_t),rig_ptr_t data);
int add_trn_rig(RIG *rig)
{
#ifdef HAVE_SIGACTION
struct sigaction act;
int status;
struct sigaction act;
int status;
/*
* FIXME: multiple open will register several time SIGIO hndlr
*/
memset(&act, 0, sizeof(act));
/*
* FIXME: multiple open will register several time SIGIO hndlr
*/
memset(&act, 0, sizeof(act));
#ifdef HAVE_SIGINFO_T
act.sa_sigaction = sa_sigioaction;
act.sa_sigaction = sa_sigioaction;
#else
act.sa_handler = sa_sigiohandler;
act.sa_handler = sa_sigiohandler;
#endif
sigemptyset(&act.sa_mask);
sigemptyset(&act.sa_mask);
#if defined(HAVE_SIGINFO_T) && defined(SA_SIGINFO)
act.sa_flags = SA_SIGINFO|SA_RESTART;
act.sa_flags = SA_SIGINFO | SA_RESTART;
#else
act.sa_flags = SA_RESTART;
act.sa_flags = SA_RESTART;
#endif
status = sigaction(SIGIO, &act, &hamlib_trn_oldact);
if (status < 0)
rig_debug(RIG_DEBUG_ERR,"%s: sigaction failed: %s\n",
__func__, strerror(errno));
status = sigaction(SIGIO, &act, &hamlib_trn_oldact);
status = fcntl(rig->state.rigport.fd, F_SETOWN, getpid());
if (status < 0)
rig_debug(RIG_DEBUG_ERR,"%s: fcntl SETOWN failed: %s\n",
__func__, strerror(errno));
if (status < 0) {
rig_debug(RIG_DEBUG_ERR,
"%s: sigaction failed: %s\n",
__func__,
strerror(errno));
}
status = fcntl(rig->state.rigport.fd, F_SETOWN, getpid());
if (status < 0) {
rig_debug(RIG_DEBUG_ERR,
"%s: fcntl SETOWN failed: %s\n",
__func__,
strerror(errno));
}
#if defined(HAVE_SIGINFO_T) && defined(O_ASYNC)
#ifdef F_SETSIG
status = fcntl(rig->state.rigport.fd, F_SETSIG, SIGIO);
if (status < 0)
rig_debug(RIG_DEBUG_ERR,"%s: fcntl SETSIG failed: %s\n",
__func__, strerror(errno));
status = fcntl(rig->state.rigport.fd, F_SETSIG, SIGIO);
if (status < 0) {
rig_debug(RIG_DEBUG_ERR,
"%s: fcntl SETSIG failed: %s\n",
__func__,
strerror(errno));
}
#endif
status = fcntl(rig->state.rigport.fd, F_SETFL, O_ASYNC);
if (status < 0)
rig_debug(RIG_DEBUG_ERR,"%s: fcntl SETASYNC failed: %s\n",
__func__, strerror(errno));
status = fcntl(rig->state.rigport.fd, F_SETFL, O_ASYNC);
if (status < 0) {
rig_debug(RIG_DEBUG_ERR,
"%s: fcntl SETASYNC failed: %s\n",
__func__,
strerror(errno));
}
#else
return -RIG_ENIMPL;
return -RIG_ENIMPL;
#endif
return RIG_OK;
return RIG_OK;
#else
return -RIG_ENIMPL;
#endif /* !HAVE_SIGACTION */
return -RIG_ENIMPL;
#endif /* !HAVE_SIGACTION */
}
/*
* remove_trn_rig
* not exported in Hamlib API.
@ -152,31 +172,41 @@ int add_trn_rig(RIG *rig)
int remove_trn_rig(RIG *rig)
{
#ifdef HAVE_SIGACTION
int status;
int status;
/* assert(rig->caps->transceive == RIG_TRN_RIG); */
#if defined(HAVE_SIGINFO_T) && defined(O_ASYNC)
status = fcntl(rig->state.rigport.fd, F_SETFL, 0);
if (status < 0)
rig_debug(RIG_DEBUG_ERR,"%s: fcntl SETASYNC failed: %s\n",
__func__, strerror(errno));
status = fcntl(rig->state.rigport.fd, F_SETFL, 0);
if (status < 0) {
rig_debug(RIG_DEBUG_ERR,
"%s: fcntl SETASYNC failed: %s\n",
__func__,
strerror(errno));
}
#endif
status = sigaction(SIGIO, &hamlib_trn_oldact, NULL);
if (status < 0)
rig_debug(RIG_DEBUG_ERR,"%s: sigaction failed: %s\n",
__func__, strerror(errno));
status = sigaction(SIGIO, &hamlib_trn_oldact, NULL);
return RIG_OK;
if (status < 0) {
rig_debug(RIG_DEBUG_ERR,
"%s: sigaction failed: %s\n",
__func__,
strerror(errno));
}
return RIG_OK;
#else
return -RIG_ENIMPL;
#endif /* !HAVE_SIGACTION */
return -RIG_ENIMPL;
#endif /* !HAVE_SIGACTION */
}
#ifdef HAVE_SIGACTION
/*
* add_trn_poll_rig
* not exported in Hamlib API.
@ -184,36 +214,40 @@ int remove_trn_rig(RIG *rig)
static int add_trn_poll_rig(RIG *rig)
{
#ifdef HAVE_SIGACTION
struct sigaction act;
int status;
struct sigaction act;
int status;
/*
* FIXME: multiple open will register several time SIGALRM hndlr
*/
memset(&act, 0, sizeof(act));
/*
* FIXME: multiple open will register several time SIGALRM hndlr
*/
memset(&act, 0, sizeof(act));
#ifdef HAVE_SIGINFO_T
act.sa_sigaction = sa_sigalrmaction;
act.sa_sigaction = sa_sigalrmaction;
#else
act.sa_handler = sa_sigalrmhandler;
act.sa_handler = sa_sigalrmhandler;
#endif
act.sa_flags = SA_RESTART;
act.sa_flags = SA_RESTART;
sigemptyset(&act.sa_mask);
sigemptyset(&act.sa_mask);
status = sigaction(SIGALRM, &act, &hamlib_trn_poll_oldact);
if (status < 0)
rig_debug(RIG_DEBUG_ERR,"%s sigaction failed: %s\n",
__func__,
strerror(errno));
status = sigaction(SIGALRM, &act, &hamlib_trn_poll_oldact);
return RIG_OK;
if (status < 0) {
rig_debug(RIG_DEBUG_ERR,
"%s sigaction failed: %s\n",
__func__,
strerror(errno));
}
return RIG_OK;
#else
return -RIG_ENIMPL;
#endif /* !HAVE_SIGINFO */
return -RIG_ENIMPL;
#endif /* !HAVE_SIGINFO */
}
/*
* remove_trn_poll_rig
* not exported in Hamlib API.
@ -221,19 +255,22 @@ static int add_trn_poll_rig(RIG *rig)
static int remove_trn_poll_rig(RIG *rig)
{
#ifdef HAVE_SIGINFO
int status;
int status;
status = sigaction(SIGALRM, &hamlib_trn_poll_oldact, NULL);
if (status < 0)
rig_debug(RIG_DEBUG_ERR,"%s sigaction failed: %s\n",
__func__,
strerror(errno));
status = sigaction(SIGALRM, &hamlib_trn_poll_oldact, NULL);
return RIG_OK;
if (status < 0) {
rig_debug(RIG_DEBUG_ERR,
"%s sigaction failed: %s\n",
__func__,
strerror(errno));
}
return RIG_OK;
#else
return -RIG_ENIMPL;
#endif /* !HAVE_SIGINFO */
return -RIG_ENIMPL;
#endif /* !HAVE_SIGINFO */
}
@ -246,54 +283,64 @@ static int remove_trn_poll_rig(RIG *rig)
*/
static int search_rig_and_decode(RIG *rig, rig_ptr_t data)
{
fd_set rfds;
struct timeval tv;
int retval;
fd_set rfds;
struct timeval tv;
int retval;
/*
* so far, only file oriented ports have event reporting support
*/
if (rig->state.rigport.type.rig != RIG_PORT_SERIAL ||
rig->state.rigport.fd == -1)
return -1;
/*
* so far, only file oriented ports have event reporting support
*/
if (rig->state.rigport.type.rig != RIG_PORT_SERIAL
|| rig->state.rigport.fd == -1) {
return -1;
}
/* FIXME: siginfo is not portable, however use it where available */
/* FIXME: siginfo is not portable, however use it where available */
#if 0&&defined(HAVE_SIGINFO_T)
siginfo_t *si = (siginfo_t*)data;
siginfo_t *si = (siginfo_t *)data;
if (rig->state.rigport.fd != si->si_fd) {
return -1;
}
if (rig->state.rigport.fd != si->si_fd)
return -1;
#else
FD_ZERO(&rfds);
FD_SET(rig->state.rigport.fd, &rfds);
/* Read status immediately. */
tv.tv_sec = 0;
tv.tv_usec = 0;
FD_ZERO(&rfds);
FD_SET(rig->state.rigport.fd, &rfds);
/* Read status immediately. */
tv.tv_sec = 0;
tv.tv_usec = 0;
/* don't use FIONREAD to detect activity
* since it is less portable than select
* REM: EINTR possible with 0sec timeout? retval==0?
*/
retval = select(rig->state.rigport.fd + 1, &rfds, NULL, NULL, &tv);
if (retval < 0) {
rig_debug(RIG_DEBUG_ERR,
"%s: select: %s\n",
__func__,
strerror(errno));
return -1;
}
/* don't use FIONREAD to detect activity
* since it is less portable than select
* REM: EINTR possible with 0sec timeout? retval==0?
*/
retval = select(rig->state.rigport.fd+1, &rfds, NULL, NULL, &tv);
if (retval < 0) {
rig_debug(RIG_DEBUG_ERR, "search_rig_and_decode: select: %s\n",
strerror(errno));
return -1;
}
#endif
/*
* Do not disturb, the backend is currently receiving data
*/
if (rig->state.hold_decode)
return -1;
/*
* Do not disturb, the backend is currently receiving data
*/
if (rig->state.hold_decode) {
return -1;
}
if (rig->caps->decode_event)
rig->caps->decode_event(rig);
if (rig->caps->decode_event) {
rig->caps->decode_event(rig);
}
return 1; /* process each opened rig */
return 1; /* process each opened rig */
}
/*
* This is used by sa_sigio, the SIGALRM handler
* to poll each RIG in RIG_TRN_POLL mode.
@ -302,60 +349,71 @@ static int search_rig_and_decode(RIG *rig, rig_ptr_t data)
*/
static int search_rig_and_poll(RIG *rig, rig_ptr_t data)
{
struct rig_state *rs = &rig->state;
int retval;
struct rig_state *rs = &rig->state;
int retval;
if (rig->state.transceive != RIG_TRN_POLL)
return -1;
/*
* Do not disturb, the backend is currently receiving data
*/
if (rig->state.hold_decode)
return -1;
if (rig->state.transceive != RIG_TRN_POLL) {
return -1;
}
rig->state.hold_decode = 2;
/*
* Do not disturb, the backend is currently receiving data
*/
if (rig->state.hold_decode) {
return -1;
}
if (rig->caps->get_vfo && rig->callbacks.vfo_event) {
vfo_t vfo = RIG_VFO_CURR;
rig->state.hold_decode = 2;
retval = rig->caps->get_vfo(rig, &vfo);
if (retval == RIG_OK) {
if (vfo != rs->current_vfo) {
rig->callbacks.vfo_event(rig, vfo, rig->callbacks.vfo_arg);
}
rs->current_vfo = vfo;
}
}
if (rig->caps->get_freq && rig->callbacks.freq_event) {
freq_t freq;
if (rig->caps->get_vfo && rig->callbacks.vfo_event) {
vfo_t vfo = RIG_VFO_CURR;
retval = rig->caps->get_freq(rig, RIG_VFO_CURR, &freq);
if (retval == RIG_OK) {
if (freq != rs->current_freq) {
rig->callbacks.freq_event(rig, RIG_VFO_CURR,
freq, rig->callbacks.freq_arg);
}
rs->current_freq = freq;
}
}
if (rig->caps->get_mode && rig->callbacks.mode_event) {
rmode_t rmode;
pbwidth_t width;
retval = rig->caps->get_vfo(rig, &vfo);
retval = rig->caps->get_mode(rig, RIG_VFO_CURR, &rmode, &width);
if (retval == RIG_OK) {
if (rmode != rs->current_mode || width != rs->current_width) {
rig->callbacks.mode_event(rig, RIG_VFO_CURR,
rmode, width, rig->callbacks.mode_arg);
}
rs->current_mode = rmode;
rs->current_width = width;
}
}
if (retval == RIG_OK) {
if (vfo != rs->current_vfo) {
rig->callbacks.vfo_event(rig, vfo, rig->callbacks.vfo_arg);
}
rig->state.hold_decode = 0;
rs->current_vfo = vfo;
}
}
return 1; /* process each opened rig */
if (rig->caps->get_freq && rig->callbacks.freq_event) {
freq_t freq;
retval = rig->caps->get_freq(rig, RIG_VFO_CURR, &freq);
if (retval == RIG_OK) {
if (freq != rs->current_freq) {
rig->callbacks.freq_event(rig, RIG_VFO_CURR,
freq, rig->callbacks.freq_arg);
}
rs->current_freq = freq;
}
}
if (rig->caps->get_mode && rig->callbacks.mode_event) {
rmode_t rmode;
pbwidth_t width;
retval = rig->caps->get_mode(rig, RIG_VFO_CURR, &rmode, &width);
if (retval == RIG_OK) {
if (rmode != rs->current_mode || width != rs->current_width) {
rig->callbacks.mode_event(rig, RIG_VFO_CURR,
rmode, width, rig->callbacks.mode_arg);
}
rs->current_mode = rmode;
rs->current_width = width;
}
}
rig->state.hold_decode = 0;
return 1; /* process each opened rig */
}
@ -369,18 +427,18 @@ static int search_rig_and_poll(RIG *rig, rig_ptr_t data)
#ifdef HAVE_SIGINFO_T
static void sa_sigioaction(int signum, siginfo_t *si, rig_ptr_t data)
{
rig_debug(RIG_DEBUG_VERBOSE, "sa_sigioaction: activity detected\n");
rig_debug(RIG_DEBUG_VERBOSE, "%s: activity detected\n", __func__);
foreach_opened_rig(search_rig_and_decode, si);
foreach_opened_rig(search_rig_and_decode, si);
}
#else
static void sa_sigiohandler(int signum)
{
rig_debug(RIG_DEBUG_VERBOSE, "sa_sigiohandler: activity detected\n");
rig_debug(RIG_DEBUG_VERBOSE, "%s: activity detected\n", __func__);
foreach_opened_rig(search_rig_and_decode, NULL);
foreach_opened_rig(search_rig_and_decode, NULL);
}
#endif
@ -396,31 +454,32 @@ static void sa_sigiohandler(int signum)
#ifdef HAVE_SIGINFO_T
static void sa_sigalrmaction(int signum, siginfo_t *si, rig_ptr_t data)
{
rig_debug(RIG_DEBUG_TRACE, "sa_sigalrmaction entered\n");
rig_debug(RIG_DEBUG_TRACE, "%s entered\n", __func__);
foreach_opened_rig(search_rig_and_poll, si);
foreach_opened_rig(search_rig_and_poll, si);
}
#else
static void sa_sigalrmhandler(int signum)
{
rig_debug(RIG_DEBUG_TRACE, "sa_sigalrmhandler entered\n");
rig_debug(RIG_DEBUG_TRACE, "%s entered\n", __func__);
foreach_opened_rig(search_rig_and_poll, NULL);
foreach_opened_rig(search_rig_and_poll, NULL);
}
#endif /* !HAVE_SIGINFO_T */
#endif /* HAVE_SIGINFO */
#endif /* !DOC_HIDDEN */
#endif /* !DOC_HIDDEN */
/**
* \brief set the callback for freq events
* \param rig The rig handle
* \param cb The callback to install
* \param arg A Pointer to some private data to pass later on to the callback
* \param rig The rig handle
* \param cb The callback to install
* \param arg A Pointer to some private data to pass later on to the callback
*
* Install a callback for freq events, to be called when in transceive mode.
*
@ -430,23 +489,26 @@ static void sa_sigalrmhandler(int signum)
*
* \sa rig_set_trn()
*/
int HAMLIB_API rig_set_freq_callback(RIG *rig, freq_cb_t cb, rig_ptr_t arg)
{
if (CHECK_RIG_ARG(rig))
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
rig->callbacks.freq_event = cb;
rig->callbacks.freq_arg = arg;
if (CHECK_RIG_ARG(rig)) {
return -RIG_EINVAL;
}
return RIG_OK;
rig->callbacks.freq_event = cb;
rig->callbacks.freq_arg = arg;
return RIG_OK;
}
/**
* \brief set the callback for mode events
* \param rig The rig handle
* \param cb The callback to install
* \param arg A Pointer to some private data to pass later on to the callback
* \param rig The rig handle
* \param cb The callback to install
* \param arg A Pointer to some private data to pass later on to the callback
*
* Install a callback for mode events, to be called when in transceive mode.
*
@ -456,23 +518,26 @@ int HAMLIB_API rig_set_freq_callback(RIG *rig, freq_cb_t cb, rig_ptr_t arg)
*
* \sa rig_set_trn()
*/
int HAMLIB_API rig_set_mode_callback(RIG *rig, mode_cb_t cb, rig_ptr_t arg)
{
if (CHECK_RIG_ARG(rig))
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
rig->callbacks.mode_event = cb;
rig->callbacks.mode_arg = arg;
if (CHECK_RIG_ARG(rig)) {
return -RIG_EINVAL;
}
return RIG_OK;
rig->callbacks.mode_event = cb;
rig->callbacks.mode_arg = arg;
return RIG_OK;
}
/**
* \brief set the callback for vfo events
* \param rig The rig handle
* \param cb The callback to install
* \param arg A Pointer to some private data to pass later on to the callback
* \param rig The rig handle
* \param cb The callback to install
* \param arg A Pointer to some private data to pass later on to the callback
*
* Install a callback for vfo events, to be called when in transceive mode.
*
@ -482,23 +547,26 @@ int HAMLIB_API rig_set_mode_callback(RIG *rig, mode_cb_t cb, rig_ptr_t arg)
*
* \sa rig_set_trn()
*/
int HAMLIB_API rig_set_vfo_callback(RIG *rig, vfo_cb_t cb, rig_ptr_t arg)
{
if (CHECK_RIG_ARG(rig))
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
rig->callbacks.vfo_event = cb;
rig->callbacks.vfo_arg = arg;
if (CHECK_RIG_ARG(rig)) {
return -RIG_EINVAL;
}
return RIG_OK;
rig->callbacks.vfo_event = cb;
rig->callbacks.vfo_arg = arg;
return RIG_OK;
}
/**
* \brief set the callback for ptt events
* \param rig The rig handle
* \param cb The callback to install
* \param arg A Pointer to some private data to pass later on to the callback
* \param rig The rig handle
* \param cb The callback to install
* \param arg A Pointer to some private data to pass later on to the callback
*
* Install a callback for ptt events, to be called when in transceive mode.
*
@ -508,23 +576,26 @@ int HAMLIB_API rig_set_vfo_callback(RIG *rig, vfo_cb_t cb, rig_ptr_t arg)
*
* \sa rig_set_trn()
*/
int HAMLIB_API rig_set_ptt_callback(RIG *rig, ptt_cb_t cb, rig_ptr_t arg)
{
if (CHECK_RIG_ARG(rig))
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
rig->callbacks.ptt_event = cb;
rig->callbacks.ptt_arg = arg;
if (CHECK_RIG_ARG(rig)) {
return -RIG_EINVAL;
}
return RIG_OK;
rig->callbacks.ptt_event = cb;
rig->callbacks.ptt_arg = arg;
return RIG_OK;
}
/**
* \brief set the callback for dcd events
* \param rig The rig handle
* \param cb The callback to install
* \param arg A Pointer to some private data to pass later on to the callback
* \param rig The rig handle
* \param cb The callback to install
* \param arg A Pointer to some private data to pass later on to the callback
*
* Install a callback for dcd events, to be called when in transceive mode.
*
@ -534,23 +605,26 @@ int HAMLIB_API rig_set_ptt_callback(RIG *rig, ptt_cb_t cb, rig_ptr_t arg)
*
* \sa rig_set_trn()
*/
int HAMLIB_API rig_set_dcd_callback(RIG *rig, dcd_cb_t cb, rig_ptr_t arg)
{
if (CHECK_RIG_ARG(rig))
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
rig->callbacks.dcd_event = cb;
rig->callbacks.dcd_arg = arg;
if (CHECK_RIG_ARG(rig)) {
return -RIG_EINVAL;
}
return RIG_OK;
rig->callbacks.dcd_event = cb;
rig->callbacks.dcd_arg = arg;
return RIG_OK;
}
/**
* \brief set the callback for pipelined tuning module
* \param rig The rig handle
* \param cb The callback to install
* \param arg A Pointer to some private data to pass later on to the callback
* \param rig The rig handle
* \param cb The callback to install
* \param arg A Pointer to some private data to pass later on to the callback
* used to maintain state during pipelined tuning.
*
* Install a callback for pipelined tuning module, to be called when the
@ -562,22 +636,25 @@ int HAMLIB_API rig_set_dcd_callback(RIG *rig, dcd_cb_t cb, rig_ptr_t arg)
*
* \sa rig_set_trn()
*/
int HAMLIB_API rig_set_pltune_callback(RIG *rig, pltune_cb_t cb, rig_ptr_t arg)
{
if (CHECK_RIG_ARG(rig))
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
rig->callbacks.pltune = cb;
rig->callbacks.pltune_arg = arg;
if (CHECK_RIG_ARG(rig)) {
return -RIG_EINVAL;
}
return RIG_OK;
rig->callbacks.pltune = cb;
rig->callbacks.pltune_arg = arg;
return RIG_OK;
}
/**
* \brief control the transceive mode
* \param rig The rig handle
* \param trn The transceive status to set to
* \param rig The rig handle
* \param trn The transceive status to set to
*
* Enable/disable the transceive handling of a rig and kick off async mode.
*
@ -587,111 +664,127 @@ int HAMLIB_API rig_set_pltune_callback(RIG *rig, pltune_cb_t cb, rig_ptr_t arg)
*
* \sa rig_get_trn()
*/
int HAMLIB_API rig_set_trn(RIG *rig, int trn)
{
const struct rig_caps *caps;
int retcode = RIG_OK;
const struct rig_caps *caps;
int retcode = RIG_OK;
#ifdef HAVE_SETITIMER
struct itimerval value;
struct itimerval value;
#endif
if (CHECK_RIG_ARG(rig))
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
caps = rig->caps;
if (CHECK_RIG_ARG(rig)) {
return -RIG_EINVAL;
}
/* detect whether tranceive is active already */
if (trn != RIG_TRN_OFF && rig->state.transceive != RIG_TRN_OFF) {
if (trn == rig->state.transceive) {
return RIG_OK;
} else {
/* when going POLL<->RIG, transtition to OFF */
retcode = rig_set_trn(rig, RIG_TRN_OFF);
if (retcode != RIG_OK)
return retcode;
}
}
caps = rig->caps;
switch (trn) {
case RIG_TRN_RIG:
if (caps->transceive != RIG_TRN_RIG)
return -RIG_ENAVAIL;
/* detect whether tranceive is active already */
if (trn != RIG_TRN_OFF && rig->state.transceive != RIG_TRN_OFF) {
if (trn == rig->state.transceive) {
return RIG_OK;
} else {
/* when going POLL<->RIG, transtition to OFF */
retcode = rig_set_trn(rig, RIG_TRN_OFF);
retcode = add_trn_rig(rig);
/* some protocols (e.g. CI-V's) offer no way
* to turn on/off the transceive mode */
if (retcode == RIG_OK && caps->set_trn) {
retcode = caps->set_trn(rig, RIG_TRN_RIG);
}
break;
if (retcode != RIG_OK) {
return retcode;
}
}
}
case RIG_TRN_POLL:
switch (trn) {
case RIG_TRN_RIG:
if (caps->transceive != RIG_TRN_RIG) {
return -RIG_ENAVAIL;
}
retcode = add_trn_rig(rig);
/* some protocols (e.g. CI-V's) offer no way
* to turn on/off the transceive mode */
if (retcode == RIG_OK && caps->set_trn) {
retcode = caps->set_trn(rig, RIG_TRN_RIG);
}
break;
case RIG_TRN_POLL:
#ifdef HAVE_SETITIMER
add_trn_poll_rig(rig);
add_trn_poll_rig(rig);
/* install handler here */
value.it_value.tv_sec = 0;
value.it_value.tv_usec = rig->state.poll_interval * 1000;
value.it_interval.tv_sec = 0;
value.it_interval.tv_usec = rig->state.poll_interval * 1000;
retcode = setitimer(ITIMER_REAL, &value, NULL);
if (retcode == -1) {
rig_debug(RIG_DEBUG_ERR,
"%s: setitimer: %s\n",
__func__,
strerror(errno));
remove_trn_poll_rig(rig);
return -RIG_EINTERNAL;
}
/* install handler here */
value.it_value.tv_sec = 0;
value.it_value.tv_usec = rig->state.poll_interval*1000;
value.it_interval.tv_sec = 0;
value.it_interval.tv_usec = rig->state.poll_interval*1000;
retcode = setitimer(ITIMER_REAL, &value, NULL);
if (retcode == -1) {
rig_debug(RIG_DEBUG_ERR, "%s: setitimer: %s\n",
__func__,
strerror(errno));
remove_trn_poll_rig(rig);
return -RIG_EINTERNAL;
}
#else
return -RIG_ENAVAIL;
return -RIG_ENAVAIL;
#endif
break;
break;
case RIG_TRN_OFF:
if (rig->state.transceive == RIG_TRN_POLL) {
case RIG_TRN_OFF:
if (rig->state.transceive == RIG_TRN_POLL) {
#ifdef HAVE_SETITIMER
retcode = remove_trn_poll_rig(rig);
retcode = remove_trn_poll_rig(rig);
value.it_value.tv_sec = 0;
value.it_value.tv_usec = 0;
value.it_interval.tv_sec = 0;
value.it_interval.tv_usec = 0;
value.it_value.tv_sec = 0;
value.it_value.tv_usec = 0;
value.it_interval.tv_sec = 0;
value.it_interval.tv_usec = 0;
retcode = setitimer(ITIMER_REAL, &value, NULL);
if (retcode == -1) {
rig_debug(RIG_DEBUG_ERR, "%s: setitimer: %s\n",
__func__,
strerror(errno));
return -RIG_EINTERNAL;
}
retcode = setitimer(ITIMER_REAL, &value, NULL);
if (retcode == -1) {
rig_debug(RIG_DEBUG_ERR, "%s: setitimer: %s\n",
__func__,
strerror(errno));
return -RIG_EINTERNAL;
}
#else
return -RIG_ENAVAIL;
return -RIG_ENAVAIL;
#endif
} else if (rig->state.transceive == RIG_TRN_RIG) {
retcode = remove_trn_rig(rig);
if (caps->set_trn && caps->transceive == RIG_TRN_RIG) {
retcode = caps->set_trn(rig, RIG_TRN_OFF);
}
}
break;
} else if (rig->state.transceive == RIG_TRN_RIG) {
retcode = remove_trn_rig(rig);
default:
return -RIG_EINVAL;
}
if (caps->set_trn && caps->transceive == RIG_TRN_RIG) {
retcode = caps->set_trn(rig, RIG_TRN_OFF);
}
}
if (retcode == RIG_OK)
rig->state.transceive = trn;
break;
return retcode;
default:
return -RIG_EINVAL;
}
if (retcode == RIG_OK) {
rig->state.transceive = trn;
}
return retcode;
}
/**
* \brief get the current transceive mode
* \param rig The rig handle
* \param trn The location where to store the current transceive mode
* \param rig The rig handle
* \param trn The location where to store the current transceive mode
*
* Retrieves the current status of the transceive mode, i.e. if radio
* sends new status automatically when some changes happened on the radio.
@ -704,14 +797,18 @@ int HAMLIB_API rig_set_trn(RIG *rig, int trn)
*/
int HAMLIB_API rig_get_trn(RIG *rig, int *trn)
{
if (CHECK_RIG_ARG(rig) || !trn)
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
if (rig->caps->get_trn != NULL)
return rig->caps->get_trn(rig, trn);
if (CHECK_RIG_ARG(rig) || !trn) {
return -RIG_EINVAL;
}
*trn = rig->state.transceive;
return RIG_OK;
if (rig->caps->get_trn != NULL) {
return rig->caps->get_trn(rig, trn);
}
*trn = rig->state.transceive;
return RIG_OK;
}
/** @} */

148
src/ext.c
Wyświetl plik

@ -18,6 +18,7 @@
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
*
*/
/**
* \addtogroup rig
* @{
@ -48,7 +49,6 @@
#include "token.h"
/**
* \param rig The rig handle
* \param cfunc callback function of each extlevel
@ -58,25 +58,37 @@
* A zero value means a normal end of iteration, and a negative value an abnormal end,
* which will be the return value of rig_ext_level_foreach.
*/
int HAMLIB_API rig_ext_level_foreach(RIG *rig, int (*cfunc)(RIG *, const struct confparams *, rig_ptr_t), rig_ptr_t data)
int HAMLIB_API rig_ext_level_foreach(RIG *rig,
int (*cfunc)(RIG *,
const struct confparams *,
rig_ptr_t),
rig_ptr_t data)
{
const struct confparams *cfp;
int ret;
const struct confparams *cfp;
int ret;
if (!rig || !rig->caps || !cfunc)
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
for (cfp = rig->caps->extlevels; cfp && cfp->name; cfp++) {
ret = (*cfunc)(rig, cfp, data);
if (ret == 0)
return RIG_OK;
if (ret < 0)
return ret;
}
if (!rig || !rig->caps || !cfunc) {
return -RIG_EINVAL;
}
return RIG_OK;
for (cfp = rig->caps->extlevels; cfp && cfp->name; cfp++) {
ret = (*cfunc)(rig, cfp, data);
if (ret == 0) {
return RIG_OK;
}
if (ret < 0) {
return ret;
}
}
return RIG_OK;
}
/**
* \param rig The rig handle
* \param cfunc callback function of each extparm
@ -86,25 +98,37 @@ int HAMLIB_API rig_ext_level_foreach(RIG *rig, int (*cfunc)(RIG *, const struct
* A zero value means a normal end of iteration, and a negative value an abnormal end,
* which will be the return value of rig_ext_parm_foreach.
*/
int HAMLIB_API rig_ext_parm_foreach(RIG *rig, int (*cfunc)(RIG *, const struct confparams *, rig_ptr_t), rig_ptr_t data)
int HAMLIB_API rig_ext_parm_foreach(RIG *rig,
int (*cfunc)(RIG *,
const struct confparams *,
rig_ptr_t),
rig_ptr_t data)
{
const struct confparams *cfp;
int ret;
const struct confparams *cfp;
int ret;
if (!rig || !rig->caps || !cfunc)
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
for (cfp = rig->caps->extparms; cfp && cfp->name; cfp++) {
ret = (*cfunc)(rig, cfp, data);
if (ret == 0)
return RIG_OK;
if (ret < 0)
return ret;
}
if (!rig || !rig->caps || !cfunc) {
return -RIG_EINVAL;
}
return RIG_OK;
for (cfp = rig->caps->extparms; cfp && cfp->name; cfp++) {
ret = (*cfunc)(rig, cfp, data);
if (ret == 0) {
return RIG_OK;
}
if (ret < 0) {
return ret;
}
}
return RIG_OK;
}
/**
* \param rig
* \param name
@ -118,20 +142,28 @@ int HAMLIB_API rig_ext_parm_foreach(RIG *rig, int (*cfunc)(RIG *, const struct c
*/
const struct confparams * HAMLIB_API rig_ext_lookup(RIG *rig, const char *name)
{
const struct confparams *cfp;
const struct confparams *cfp;
if (!rig || !rig->caps)
return NULL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
for (cfp = rig->caps->extlevels; cfp && cfp->name; cfp++)
if (!strcmp(cfp->name, name))
return cfp;
for (cfp = rig->caps->extparms; cfp && cfp->name; cfp++)
if (!strcmp(cfp->name, name))
return cfp;
return NULL;
if (!rig || !rig->caps) {
return NULL;
}
for (cfp = rig->caps->extlevels; cfp && cfp->name; cfp++)
if (!strcmp(cfp->name, name)) {
return cfp;
}
for (cfp = rig->caps->extparms; cfp && cfp->name; cfp++)
if (!strcmp(cfp->name, name)) {
return cfp;
}
return NULL;
}
/**
* \param rig
* \param token
@ -143,20 +175,28 @@ const struct confparams * HAMLIB_API rig_ext_lookup(RIG *rig, const char *name)
*/
const struct confparams * HAMLIB_API rig_ext_lookup_tok(RIG *rig, token_t token)
{
const struct confparams *cfp;
const struct confparams *cfp;
if (!rig || !rig->caps)
return NULL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
for (cfp = rig->caps->extlevels; cfp && cfp->token; cfp++)
if (cfp->token == token)
return cfp;
for (cfp = rig->caps->extparms; cfp && cfp->token; cfp++)
if (cfp->token == token)
return cfp;
return NULL;
if (!rig || !rig->caps) {
return NULL;
}
for (cfp = rig->caps->extlevels; cfp && cfp->token; cfp++)
if (cfp->token == token) {
return cfp;
}
for (cfp = rig->caps->extparms; cfp && cfp->token; cfp++)
if (cfp->token == token) {
return cfp;
}
return NULL;
}
/**
* \param rig
* \param name
@ -164,13 +204,17 @@ const struct confparams * HAMLIB_API rig_ext_lookup_tok(RIG *rig, token_t token)
*/
token_t HAMLIB_API rig_ext_token_lookup(RIG *rig, const char *name)
{
const struct confparams *cfp;
const struct confparams *cfp;
cfp = rig_ext_lookup(rig, name);
if (!cfp)
return RIG_CONF_END;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
return cfp->token;
cfp = rig_ext_lookup(rig, name);
if (!cfp) {
return RIG_CONF_END;
}
return cfp->token;
}
/** @} */

129
src/gpio.c
Wyświetl plik

@ -19,8 +19,6 @@
*
*/
#include "gpio.h"
#include <string.h>
#include <errno.h>
#include <unistd.h>
@ -28,74 +26,101 @@
#include <sys/stat.h>
#include <fcntl.h>
#include "gpio.h"
int gpio_open(hamlib_port_t *port, int on_value)
{
char pathname[FILPATHLEN];
FILE *fexp, *fdir;
int fd;
char pathname[FILPATHLEN];
FILE *fexp, *fdir;
int fd;
port->parm.gpio.on_value = on_value;
snprintf(pathname, FILPATHLEN, "/sys/class/gpio/export");
fexp = fopen(pathname, "w");
if (!fexp) {
rig_debug(RIG_DEBUG_ERR, "Export GPIO%s (using %s): %s\n",
port->pathname, pathname, strerror(errno));
return -RIG_EIO;
}
fprintf(fexp, "%s\n", port->pathname);
fclose(fexp);
port->parm.gpio.on_value = on_value;
snprintf(pathname, FILPATHLEN, "/sys/class/gpio/gpio%s/direction", port->pathname);
fdir = fopen(pathname, "w");
if (!fdir) {
rig_debug(RIG_DEBUG_ERR, "GPIO%s direction (using %s): %s\n",
port->pathname, pathname, strerror(errno));
return -RIG_EIO;
}
fprintf(fdir, "out\n");
fclose(fdir);
snprintf(pathname, FILPATHLEN, "/sys/class/gpio/export");
fexp = fopen(pathname, "w");
snprintf(pathname, FILPATHLEN, "/sys/class/gpio/gpio%s/value", port->pathname);
fd = open(pathname, O_WRONLY);
if (fd < 0) {
rig_debug(RIG_DEBUG_ERR, "GPIO%s opening value file %s: %s\n",
port->pathname, pathname, strerror(errno));
return -RIG_EIO;
}
if (!fexp) {
rig_debug(RIG_DEBUG_ERR,
"Export GPIO%s (using %s): %s\n",
port->pathname,
pathname,
strerror(errno));
return -RIG_EIO;
}
port->fd = fd;
return fd;
fprintf(fexp, "%s\n", port->pathname);
fclose(fexp);
snprintf(pathname,
FILPATHLEN,
"/sys/class/gpio/gpio%s/direction",
port->pathname);
fdir = fopen(pathname, "w");
if (!fdir) {
rig_debug(RIG_DEBUG_ERR,
"GPIO%s direction (using %s): %s\n",
port->pathname,
pathname,
strerror(errno));
return -RIG_EIO;
}
fprintf(fdir, "out\n");
fclose(fdir);
snprintf(pathname,
FILPATHLEN,
"/sys/class/gpio/gpio%s/value",
port->pathname);
fd = open(pathname, O_WRONLY);
if (fd < 0) {
rig_debug(RIG_DEBUG_ERR,
"GPIO%s opening value file %s: %s\n",
port->pathname,
pathname,
strerror(errno));
return -RIG_EIO;
}
port->fd = fd;
return fd;
}
int gpio_close(hamlib_port_t *port)
{
return close(port->fd);
return close(port->fd);
}
int gpio_ptt_set(hamlib_port_t *port, ptt_t pttx)
{
char *val;
port->parm.gpio.value = pttx != RIG_PTT_OFF;
char *val;
port->parm.gpio.value = pttx != RIG_PTT_OFF;
if ((port->parm.gpio.value && port->parm.gpio.on_value) ||
(!port->parm.gpio.value && !port->parm.gpio.on_value)) {
val = "1\n";
} else {
val = "0\n";
}
if (write(port->fd, val, strlen(val)) <= 0)
return -RIG_EIO;
return RIG_OK;
if ((port->parm.gpio.value && port->parm.gpio.on_value)
|| (!port->parm.gpio.value && !port->parm.gpio.on_value)) {
val = "1\n";
} else {
val = "0\n";
}
if (write(port->fd, val, strlen(val)) <= 0) {
return -RIG_EIO;
}
return RIG_OK;
}
int gpio_ptt_get(hamlib_port_t *port, ptt_t *pttx)
{
if (port->parm.gpio.value)
return RIG_PTT_ON;
else
return RIG_PTT_OFF;
if (port->parm.gpio.value) {
return RIG_PTT_ON;
} else {
return RIG_PTT_OFF;
}
}

146
src/idx_builtin.h
Wyświetl plik

@ -31,86 +31,86 @@
* everything at compile time.
*
* struct rig_caps foo = {
* .level_gran = { [LVL_PREAMP] = { .min = 0, .max = 20, .step = 10 } },
* .level_gran = { [LVL_PREAMP] = { .min = 0, .max = 20, .step = 10 } },
* }
*
* Of course, it can't work with setting2idx_builtin(RIG_LEVEL_XX|RIG_LEVEL_YY)
*/
#define setting2idx_builtin(s) ((s)==(1<<0)?0: \
(s)==(1<<1)?1: \
(s)==(1<<2)?2: \
(s)==(1<<3)?3: \
(s)==(1<<4)?4: \
(s)==(1<<5)?5: \
(s)==(1<<6)?6: \
(s)==(1<<7)?7: \
(s)==(1<<8)?8: \
(s)==(1<<9)?9: \
(s)==(1<<10)?10: \
(s)==(1<<11)?11: \
(s)==(1<<12)?12: \
(s)==(1<<13)?13: \
(s)==(1<<14)?14: \
(s)==(1<<15)?15: \
(s)==(1<<16)?16: \
(s)==(1<<17)?17: \
(s)==(1<<18)?18: \
(s)==(1<<19)?19: \
(s)==(1<<20)?20: \
(s)==(1<<21)?21: \
(s)==(1<<22)?22: \
(s)==(1<<23)?23: \
(s)==(1<<24)?24: \
(s)==(1<<25)?25: \
(s)==(1<<26)?26: \
(s)==(1<<27)?27: \
(s)==(1<<28)?28: \
(s)==(1<<29)?29: \
(s)==(1<<30)?30: \
(s)==(1<<31)?31: \
0 \
)
#define setting2idx_builtin(s) ((s)==(1<<0)?0: \
(s)==(1<<1)?1: \
(s)==(1<<2)?2: \
(s)==(1<<3)?3: \
(s)==(1<<4)?4: \
(s)==(1<<5)?5: \
(s)==(1<<6)?6: \
(s)==(1<<7)?7: \
(s)==(1<<8)?8: \
(s)==(1<<9)?9: \
(s)==(1<<10)?10: \
(s)==(1<<11)?11: \
(s)==(1<<12)?12: \
(s)==(1<<13)?13: \
(s)==(1<<14)?14: \
(s)==(1<<15)?15: \
(s)==(1<<16)?16: \
(s)==(1<<17)?17: \
(s)==(1<<18)?18: \
(s)==(1<<19)?19: \
(s)==(1<<20)?20: \
(s)==(1<<21)?21: \
(s)==(1<<22)?22: \
(s)==(1<<23)?23: \
(s)==(1<<24)?24: \
(s)==(1<<25)?25: \
(s)==(1<<26)?26: \
(s)==(1<<27)?27: \
(s)==(1<<28)?28: \
(s)==(1<<29)?29: \
(s)==(1<<30)?30: \
(s)==(1<<31)?31: \
0 \
)
#define LVL_PREAMP setting2idx_builtin(RIG_LEVEL_PREAMP)
#define LVL_ATT setting2idx_builtin(RIG_LEVEL_ATT)
#define LVL_VOX setting2idx_builtin(RIG_LEVEL_VOX)
#define LVL_AF setting2idx_builtin(RIG_LEVEL_AF)
#define LVL_RF setting2idx_builtin(RIG_LEVEL_RF)
#define LVL_SQL setting2idx_builtin(RIG_LEVEL_SQL)
#define LVL_IF setting2idx_builtin(RIG_LEVEL_IF)
#define LVL_APF setting2idx_builtin(RIG_LEVEL_APF)
#define LVL_NR setting2idx_builtin(RIG_LEVEL_NR)
#define LVL_PBT_IN setting2idx_builtin(RIG_LEVEL_PBT_IN)
#define LVL_PBT_OUT setting2idx_builtin(RIG_LEVEL_PBT_OUT)
#define LVL_CWPITCH setting2idx_builtin(RIG_LEVEL_CWPITCH)
#define LVL_RFPOWER setting2idx_builtin(RIG_LEVEL_RFPOWER)
#define LVL_MICGAIN setting2idx_builtin(RIG_LEVEL_MICGAIN)
#define LVL_KEYSPD setting2idx_builtin(RIG_LEVEL_KEYSPD)
#define LVL_NOTCHF setting2idx_builtin(RIG_LEVEL_NOTCHF)
#define LVL_COMP setting2idx_builtin(RIG_LEVEL_COMP)
#define LVL_AGC setting2idx_builtin(RIG_LEVEL_AGC)
#define LVL_BKINDL setting2idx_builtin(RIG_LEVEL_BKINDL)
#define LVL_BALANCE setting2idx_builtin(RIG_LEVEL_BALANCE)
#define LVL_METER setting2idx_builtin(RIG_LEVEL_METER)
#define LVL_VOXGAIN setting2idx_builtin(RIG_LEVEL_VOXGAIN)
#define LVL_VOXDELAY setting2idx_builtin(RIG_LEVEL_VOXDELAY)
#define LVL_ANTIVOX setting2idx_builtin(RIG_LEVEL_ANTIVOX)
#define LVL_PREAMP setting2idx_builtin(RIG_LEVEL_PREAMP)
#define LVL_ATT setting2idx_builtin(RIG_LEVEL_ATT)
#define LVL_VOX setting2idx_builtin(RIG_LEVEL_VOX)
#define LVL_AF setting2idx_builtin(RIG_LEVEL_AF)
#define LVL_RF setting2idx_builtin(RIG_LEVEL_RF)
#define LVL_SQL setting2idx_builtin(RIG_LEVEL_SQL)
#define LVL_IF setting2idx_builtin(RIG_LEVEL_IF)
#define LVL_APF setting2idx_builtin(RIG_LEVEL_APF)
#define LVL_NR setting2idx_builtin(RIG_LEVEL_NR)
#define LVL_PBT_IN setting2idx_builtin(RIG_LEVEL_PBT_IN)
#define LVL_PBT_OUT setting2idx_builtin(RIG_LEVEL_PBT_OUT)
#define LVL_CWPITCH setting2idx_builtin(RIG_LEVEL_CWPITCH)
#define LVL_RFPOWER setting2idx_builtin(RIG_LEVEL_RFPOWER)
#define LVL_MICGAIN setting2idx_builtin(RIG_LEVEL_MICGAIN)
#define LVL_KEYSPD setting2idx_builtin(RIG_LEVEL_KEYSPD)
#define LVL_NOTCHF setting2idx_builtin(RIG_LEVEL_NOTCHF)
#define LVL_COMP setting2idx_builtin(RIG_LEVEL_COMP)
#define LVL_AGC setting2idx_builtin(RIG_LEVEL_AGC)
#define LVL_BKINDL setting2idx_builtin(RIG_LEVEL_BKINDL)
#define LVL_BALANCE setting2idx_builtin(RIG_LEVEL_BALANCE)
#define LVL_METER setting2idx_builtin(RIG_LEVEL_METER)
#define LVL_VOXGAIN setting2idx_builtin(RIG_LEVEL_VOXGAIN)
#define LVL_VOXDELAY setting2idx_builtin(RIG_LEVEL_VOXDELAY)
#define LVL_ANTIVOX setting2idx_builtin(RIG_LEVEL_ANTIVOX)
#define LVL_RAWSTR setting2idx_builtin(RIG_LEVEL_RAWSTR)
#define LVL_SQLSTAT setting2idx_builtin(RIG_LEVEL_SQLSTAT)
#define LVL_SWR setting2idx_builtin(RIG_LEVEL_SWR)
#define LVL_ALC setting2idx_builtin(RIG_LEVEL_ALC)
#define LVL_STRENGTH setting2idx_builtin(RIG_LEVEL_STRENGTH)
/*#define LVL_BWC setting2idx_builtin(RIG_LEVEL_BWC)*/
#define LVL_RAWSTR setting2idx_builtin(RIG_LEVEL_RAWSTR)
#define LVL_SQLSTAT setting2idx_builtin(RIG_LEVEL_SQLSTAT)
#define LVL_SWR setting2idx_builtin(RIG_LEVEL_SWR)
#define LVL_ALC setting2idx_builtin(RIG_LEVEL_ALC)
#define LVL_STRENGTH setting2idx_builtin(RIG_LEVEL_STRENGTH)
/*#define LVL_BWC setting2idx_builtin(RIG_LEVEL_BWC)*/
#define PARM_ANN setting2idx_builtin(RIG_PARM_ANN)
#define PARM_APO setting2idx_builtin(RIG_PARM_APO)
#define PARM_BACKLIGHT setting2idx_builtin(RIG_PARM_BACKLIGHT)
#define PARM_BEEP setting2idx_builtin(RIG_PARM_BEEP)
#define PARM_TIME setting2idx_builtin(RIG_PARM_TIME)
#define PARM_BAT setting2idx_builtin(RIG_PARM_BAT)
#define PARM_KEYLIGHT setting2idx_builtin(RIG_PARM_KEYLIGHT)
#define PARM_ANN setting2idx_builtin(RIG_PARM_ANN)
#define PARM_APO setting2idx_builtin(RIG_PARM_APO)
#define PARM_BACKLIGHT setting2idx_builtin(RIG_PARM_BACKLIGHT)
#define PARM_BEEP setting2idx_builtin(RIG_PARM_BEEP)
#define PARM_TIME setting2idx_builtin(RIG_PARM_TIME)
#define PARM_BAT setting2idx_builtin(RIG_PARM_BAT)
#define PARM_KEYLIGHT setting2idx_builtin(RIG_PARM_KEYLIGHT)
#endif /* _IDX_BUILTIN_H */
#endif /* _IDX_BUILTIN_H */

737
src/iofunc.c
Wyświetl plik

@ -44,7 +44,7 @@
#include <sys/types.h>
#include <unistd.h>
#include "hamlib/rig.h"
#include <hamlib/rig.h>
#include "iofunc.h"
#include "misc.h"
@ -61,84 +61,112 @@
*/
int HAMLIB_API port_open(hamlib_port_t *p)
{
int status;
int want_state_delay = 0;
int status;
int want_state_delay = 0;
p->fd = -1;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
switch(p->type.rig) {
case RIG_PORT_SERIAL:
status = serial_open(p);
if (status < 0)
return status;
if (p->parm.serial.rts_state != RIG_SIGNAL_UNSET &&
p->parm.serial.handshake != RIG_HANDSHAKE_HARDWARE) {
status = ser_set_rts(p,
p->parm.serial.rts_state == RIG_SIGNAL_ON);
want_state_delay = 1;
}
if (status != 0)
return status;
if (p->parm.serial.dtr_state != RIG_SIGNAL_UNSET) {
status = ser_set_dtr(p,
p->parm.serial.dtr_state == RIG_SIGNAL_ON);
want_state_delay = 1;
}
if (status != 0)
return status;
/*
* Wait whatever electrolytics in the circuit come up to voltage.
* Is 100ms enough? Too much?
*/
if (want_state_delay)
usleep(100*1000);
p->fd = -1;
break;
switch (p->type.rig) {
case RIG_PORT_SERIAL:
status = serial_open(p);
case RIG_PORT_PARALLEL:
status = par_open(p);
if (status < 0)
return status;
break;
if (status < 0) {
return status;
}
case RIG_PORT_CM108:
status = cm108_open(p);
if (status < 0)
return status;
break;
if (p->parm.serial.rts_state != RIG_SIGNAL_UNSET
&& p->parm.serial.handshake != RIG_HANDSHAKE_HARDWARE) {
status = ser_set_rts(p,
p->parm.serial.rts_state == RIG_SIGNAL_ON);
want_state_delay = 1;
}
case RIG_PORT_DEVICE:
status = open(p->pathname, O_RDWR, 0);
if (status < 0)
return -RIG_EIO;
p->fd = status;
break;
if (status != 0) {
return status;
}
case RIG_PORT_USB:
status = usb_port_open(p);
if (status < 0)
return status;
break;
if (p->parm.serial.dtr_state != RIG_SIGNAL_UNSET) {
status = ser_set_dtr(p,
p->parm.serial.dtr_state == RIG_SIGNAL_ON);
want_state_delay = 1;
}
case RIG_PORT_NONE:
case RIG_PORT_RPC:
break; /* ez :) */
if (status != 0) {
return status;
}
case RIG_PORT_NETWORK:
case RIG_PORT_UDP_NETWORK:
/*
* Wait whatever electrolytics in the circuit come up to voltage.
* Is 100ms enough? Too much?
*/
if (want_state_delay) {
usleep(100 * 1000);
}
break;
case RIG_PORT_PARALLEL:
status = par_open(p);
if (status < 0) {
return status;
}
break;
case RIG_PORT_CM108:
status = cm108_open(p);
if (status < 0) {
return status;
}
break;
case RIG_PORT_DEVICE:
status = open(p->pathname, O_RDWR, 0);
if (status < 0) {
return -RIG_EIO;
}
p->fd = status;
break;
case RIG_PORT_USB:
status = usb_port_open(p);
if (status < 0) {
return status;
}
break;
case RIG_PORT_NONE:
case RIG_PORT_RPC:
break; /* ez :) */
case RIG_PORT_NETWORK:
case RIG_PORT_UDP_NETWORK:
/* FIXME: hardcoded network port */
status = network_open(p, 4532);
if (status < 0)
return status;
break;
status = network_open(p, 4532);
default:
return -RIG_EINVAL;
}
if (status < 0) {
return status;
}
return RIG_OK;
break;
default:
return -RIG_EINVAL;
}
return RIG_OK;
}
/**
* \brief Close a hamlib_port
* \param p rig port descriptor
@ -151,93 +179,119 @@ int HAMLIB_API port_close(hamlib_port_t *p, rig_port_t port_type)
{
int ret = RIG_OK;
if (p->fd != -1) {
switch (port_type) {
case RIG_PORT_SERIAL:
ret = ser_close(p);
break;
case RIG_PORT_PARALLEL:
ret = par_close(p);
break;
case RIG_PORT_CM108:
ret = cm108_close(p);
break;
case RIG_PORT_USB:
ret = usb_port_close(p);
break;
case RIG_PORT_NETWORK:
case RIG_PORT_UDP_NETWORK:
ret = network_close(p);
break;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
default:
rig_debug(RIG_DEBUG_ERR, "%s(): Unknown port type %d\n",
__func__, port_type);
/* fall through */
case RIG_PORT_DEVICE:
ret = close(p->fd);
}
p->fd = -1;
}
if (p->fd != -1) {
switch (port_type) {
case RIG_PORT_SERIAL:
ret = ser_close(p);
break;
return ret;
case RIG_PORT_PARALLEL:
ret = par_close(p);
break;
case RIG_PORT_CM108:
ret = cm108_close(p);
break;
case RIG_PORT_USB:
ret = usb_port_close(p);
break;
case RIG_PORT_NETWORK:
case RIG_PORT_UDP_NETWORK:
ret = network_close(p);
break;
default:
rig_debug(RIG_DEBUG_ERR, "%s(): Unknown port type %d\n",
__func__, port_type);
/* fall through */
case RIG_PORT_DEVICE:
ret = close(p->fd);
}
p->fd = -1;
}
return ret;
}
#if defined(WIN32) && !defined(HAVE_TERMIOS_H)
#include "win32termios.h"
/* On MinGW32/MSVC/.. the appropriate accessor must be used
* depending on the port type, sigh.
*/
static ssize_t port_read(hamlib_port_t *p, void *buf, size_t count)
{
int i;
ssize_t ret;
int i;
ssize_t ret;
if (p->type.rig == RIG_PORT_SERIAL) {
ret = win32_serial_read(p->fd, buf, count);
if (p->parm.serial.data_bits == 7) {
unsigned char *pbuf = buf;
/* clear MSB */
for (i=0; i<ret; i++) {
pbuf[i] &= ~0x80;
if (p->type.rig == RIG_PORT_SERIAL) {
ret = win32_serial_read(p->fd, buf, count);
if (p->parm.serial.data_bits == 7) {
unsigned char *pbuf = buf;
/* clear MSB */
for (i = 0; i < ret; i++) {
pbuf[i] &= ~0x80;
}
}
return ret;
} else if (p->type.rig == RIG_PORT_NETWORK
|| p->type.rig == RIG_PORT_UDP_NETWORK) {
return recv(p->fd, buf, count, 0);
} else {
return read(p->fd, buf, count);
}
return ret;
} else if (p->type.rig == RIG_PORT_NETWORK || p->type.rig == RIG_PORT_UDP_NETWORK)
return recv(p->fd, buf, count, 0);
else
return read(p->fd, buf, count);
}
static ssize_t port_write(hamlib_port_t *p, const void *buf, size_t count)
{
if (p->type.rig == RIG_PORT_SERIAL)
return win32_serial_write(p->fd, buf, count);
else if (p->type.rig == RIG_PORT_NETWORK || p->type.rig == RIG_PORT_UDP_NETWORK)
return send(p->fd, buf, count, 0);
else
return write(p->fd, buf, count);
if (p->type.rig == RIG_PORT_SERIAL) {
return win32_serial_write(p->fd, buf, count);
} else if (p->type.rig == RIG_PORT_NETWORK
|| p->type.rig == RIG_PORT_UDP_NETWORK) {
return send(p->fd, buf, count, 0);
} else {
return write(p->fd, buf, count);
}
}
static int port_select(hamlib_port_t *p, int n, fd_set *readfds, fd_set *writefds, fd_set *exceptfds, struct timeval *timeout)
static int port_select(hamlib_port_t *p, int n, fd_set *readfds,
fd_set *writefds, fd_set *exceptfds,
struct timeval *timeout)
{
#if 1
/* select does not work very well with writefds/exceptfds
* So let's pretend there's none of them
*/
if (exceptfds)
FD_ZERO(exceptfds);
if (writefds)
FD_ZERO(writefds);
writefds = NULL;
exceptfds = NULL;
/* select does not work very well with writefds/exceptfds
* So let's pretend there's none of them
*/
if (exceptfds) {
FD_ZERO(exceptfds);
}
if (writefds) {
FD_ZERO(writefds);
}
writefds = NULL;
exceptfds = NULL;
#endif
if (p->type.rig == RIG_PORT_SERIAL)
return win32_serial_select(n, readfds, writefds, exceptfds, timeout);
else
return select(n, readfds, writefds, exceptfds, timeout);
if (p->type.rig == RIG_PORT_SERIAL) {
return win32_serial_select(n, readfds, writefds, exceptfds, timeout);
} else {
return select(n, readfds, writefds, exceptfds, timeout);
}
}
@ -247,21 +301,23 @@ static int port_select(hamlib_port_t *p, int n, fd_set *readfds, fd_set *writefd
static ssize_t port_read(hamlib_port_t *p, void *buf, size_t count)
{
int i;
ssize_t ret;
int i;
ssize_t ret;
if (p->type.rig == RIG_PORT_SERIAL && p->parm.serial.data_bits == 7) {
unsigned char *pbuf = buf;
if (p->type.rig == RIG_PORT_SERIAL && p->parm.serial.data_bits == 7) {
unsigned char *pbuf = buf;
ret = read(p->fd, buf, count);
/* clear MSB */
for (i=0; i<ret; i++) {
pbuf[i] &= ~0x80;
ret = read(p->fd, buf, count);
/* clear MSB */
for (i = 0; i < ret; i++) {
pbuf[i] &= ~0x80;
}
return ret;
} else {
return read(p->fd, buf, count);
}
return ret;
} else {
return read(p->fd, buf, count);
}
}
#define port_write(p,b,c) write((p)->fd,(b),(c))
@ -300,67 +356,77 @@ static ssize_t port_read(hamlib_port_t *p, void *buf, size_t count)
int HAMLIB_API write_block(hamlib_port_t *p, const char *txbuffer, size_t count)
{
int i, ret;
int i, ret;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
#ifdef WANT_NON_ACTIVE_POST_WRITE_DELAY
if (p->post_write_date.tv_sec != 0) {
signed int date_delay; /* in us */
struct timeval tv;
/* FIXME in Y2038 ... */
gettimeofday(&tv, NULL);
date_delay = p->post_write_delay*1000 -
((tv.tv_sec - p->post_write_date.tv_sec)*1000000 +
(tv.tv_usec - p->post_write_date.tv_usec));
if (date_delay > 0) {
/*
* optional delay after last write
*/
usleep(date_delay);
}
p->post_write_date.tv_sec = 0;
}
if (p->post_write_date.tv_sec != 0) {
signed int date_delay; /* in us */
struct timeval tv;
/* FIXME in Y2038 ... */
gettimeofday(&tv, NULL);
date_delay = p->post_write_delay * 1000 -
((tv.tv_sec - p->post_write_date.tv_sec) * 1000000 +
(tv.tv_usec - p->post_write_date.tv_usec));
if (date_delay > 0) {
/*
* optional delay after last write
*/
usleep(date_delay);
}
p->post_write_date.tv_sec = 0;
}
#endif
if (p->write_delay > 0) {
for (i=0; i < count; i++) {
ret = port_write(p, txbuffer+i, 1);
if (ret != 1) {
rig_debug(RIG_DEBUG_ERR,"%s():%d failed %d - %s\n",
__func__, __LINE__, ret, strerror(errno));
return -RIG_EIO;
}
usleep(p->write_delay*1000);
}
} else {
ret = port_write(p, txbuffer, count);
if (ret != count) {
rig_debug(RIG_DEBUG_ERR,"%s():%d failed %d - %s\n",
__func__, __LINE__, ret, strerror(errno));
return -RIG_EIO;
}
}
if (p->write_delay > 0) {
for (i = 0; i < count; i++) {
ret = port_write(p, txbuffer + i, 1);
if (p->post_write_delay > 0) {
if (ret != 1) {
rig_debug(RIG_DEBUG_ERR, "%s():%d failed %d - %s\n",
__func__, __LINE__, ret, strerror(errno));
return -RIG_EIO;
}
usleep(p->write_delay * 1000);
}
} else {
ret = port_write(p, txbuffer, count);
if (ret != count) {
rig_debug(RIG_DEBUG_ERR, "%s():%d failed %d - %s\n",
__func__, __LINE__, ret, strerror(errno));
return -RIG_EIO;
}
}
if (p->post_write_delay > 0) {
#ifdef WANT_NON_ACTIVE_POST_WRITE_DELAY
#define POST_WRITE_DELAY_TRSHLD 10
if (p->post_write_delay > POST_WRITE_DELAY_TRSHLD) {
struct timeval tv;
gettimeofday(&tv, NULL);
p->post_write_date.tv_sec = tv.tv_sec;
p->post_write_date.tv_usec = tv.tv_usec;
}
else
if (p->post_write_delay > POST_WRITE_DELAY_TRSHLD) {
struct timeval tv;
gettimeofday(&tv, NULL);
p->post_write_date.tv_sec = tv.tv_sec;
p->post_write_date.tv_usec = tv.tv_usec;
} else
#endif
usleep(p->post_write_delay*1000); /* optional delay after last write */
/* otherwise some yaesu rigs get confused */
/* with sequential fast writes*/
}
rig_debug(RIG_DEBUG_TRACE,"%s(): TX %d bytes\n", __func__, count);
dump_hex((unsigned char *) txbuffer,count);
usleep(p->post_write_delay * 1000); /* optional delay after last write */
return RIG_OK;
/* otherwise some yaesu rigs get confused */
/* with sequential fast writes*/
}
rig_debug(RIG_DEBUG_TRACE, "%s(): TX %d bytes\n", __func__, count);
dump_hex((unsigned char *) txbuffer, count);
return RIG_OK;
}
@ -384,73 +450,90 @@ int HAMLIB_API write_block(hamlib_port_t *p, const char *txbuffer, size_t count)
int HAMLIB_API read_block(hamlib_port_t *p, char *rxbuffer, size_t count)
{
fd_set rfds, efds;
struct timeval tv, tv_timeout, start_time, end_time, elapsed_time;
int rd_count, total_count = 0;
int retval;
fd_set rfds, efds;
struct timeval tv, tv_timeout, start_time, end_time, elapsed_time;
int rd_count, total_count = 0;
int retval;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
/*
* Wait up to timeout ms.
*/
tv_timeout.tv_sec = p->timeout/1000;
tv_timeout.tv_usec = (p->timeout%1000)*1000;
/*
* Wait up to timeout ms.
*/
tv_timeout.tv_sec = p->timeout / 1000;
tv_timeout.tv_usec = (p->timeout % 1000) * 1000;
/* Store the time of the read loop start */
gettimeofday(&start_time, NULL);
/* Store the time of the read loop start */
gettimeofday(&start_time, NULL);
while (count > 0) {
tv = tv_timeout; /* select may have updated it */
while (count > 0) {
tv = tv_timeout; /* select may have updated it */
FD_ZERO(&rfds);
FD_SET(p->fd, &rfds);
efds = rfds;
FD_ZERO(&rfds);
FD_SET(p->fd, &rfds);
efds = rfds;
retval = port_select(p, p->fd+1, &rfds, NULL, &efds, &tv);
if (retval == 0) {
/* Record timeout time and caculate elapsed time */
gettimeofday(&end_time, NULL);
timersub(&end_time, &start_time, &elapsed_time);
retval = port_select(p, p->fd + 1, &rfds, NULL, &efds, &tv);
dump_hex((unsigned char *) rxbuffer, total_count);
rig_debug(RIG_DEBUG_WARN, "%s(): Timed out %d.%d seconds after %d chars\n",
__func__, elapsed_time.tv_sec, elapsed_time.tv_usec, total_count);
if (retval == 0) {
/* Record timeout time and caculate elapsed time */
gettimeofday(&end_time, NULL);
timersub(&end_time, &start_time, &elapsed_time);
return -RIG_ETIMEOUT;
}
if (retval < 0) {
dump_hex((unsigned char *) rxbuffer, total_count);
rig_debug(RIG_DEBUG_ERR,"%s(): select() error after %d chars: %s\n",
__func__, total_count, strerror(errno));
dump_hex((unsigned char *) rxbuffer, total_count);
rig_debug(RIG_DEBUG_WARN,
"%s(): Timed out %d.%d seconds after %d chars\n",
__func__,
elapsed_time.tv_sec,
elapsed_time.tv_usec,
total_count);
return -RIG_EIO;
}
if (FD_ISSET(p->fd, &efds)) {
rig_debug(RIG_DEBUG_ERR, "%s(): fd error after %d chars\n",
__func__, total_count);
return -RIG_ETIMEOUT;
}
return -RIG_EIO;
}
if (retval < 0) {
dump_hex((unsigned char *) rxbuffer, total_count);
rig_debug(RIG_DEBUG_ERR,
"%s(): select() error after %d chars: %s\n",
__func__,
total_count,
strerror(errno));
/*
* grab bytes from the rig
* The file descriptor must have been set up non blocking.
*/
rd_count = port_read(p, rxbuffer+total_count, count);
if (rd_count < 0) {
rig_debug(RIG_DEBUG_ERR, "%s(): read() failed - %s\n",
__func__, strerror(errno));
return -RIG_EIO;
}
return -RIG_EIO;
}
total_count += rd_count;
count -= rd_count;
}
if (FD_ISSET(p->fd, &efds)) {
rig_debug(RIG_DEBUG_ERR,
"%s(): fd error after %d chars\n",
__func__,
total_count);
rig_debug(RIG_DEBUG_TRACE,"%s(): RX %d bytes\n", __func__, total_count);
dump_hex((unsigned char *) rxbuffer, total_count);
return -RIG_EIO;
}
return total_count; /* return bytes count read */
/*
* grab bytes from the rig
* The file descriptor must have been set up non blocking.
*/
rd_count = port_read(p, rxbuffer + total_count, count);
if (rd_count < 0) {
rig_debug(RIG_DEBUG_ERR,
"%s(): read() failed - %s\n",
__func__,
strerror(errno));
return -RIG_EIO;
}
total_count += rd_count;
count -= rd_count;
}
rig_debug(RIG_DEBUG_TRACE, "%s(): RX %d bytes\n", __func__, total_count);
dump_hex((unsigned char *) rxbuffer, total_count);
return total_count; /* return bytes count read */
}
@ -479,89 +562,119 @@ int HAMLIB_API read_block(hamlib_port_t *p, char *rxbuffer, size_t count)
*
* Assumes rxbuffer!=NULL
*/
int HAMLIB_API read_string(hamlib_port_t *p, char *rxbuffer, size_t rxmax, const char *stopset,
int stopset_len)
int HAMLIB_API read_string(hamlib_port_t *p, char *rxbuffer, size_t rxmax,
const char *stopset,
int stopset_len)
{
fd_set rfds, efds;
struct timeval tv, tv_timeout, start_time, end_time, elapsed_time;
int rd_count, total_count = 0;
int retval;
fd_set rfds, efds;
struct timeval tv, tv_timeout, start_time, end_time, elapsed_time;
int rd_count, total_count = 0;
int retval;
if (!p || !rxbuffer) return -RIG_EINVAL;
if (rxmax < 1) return 0;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
/*
* Wait up to timeout ms.
*/
tv_timeout.tv_sec = p->timeout/1000;
tv_timeout.tv_usec = (p->timeout%1000)*1000;
/* Store the time of the read loop start */
gettimeofday(&start_time, NULL);
while (total_count < rxmax-1) {
tv = tv_timeout; /* select may have updated it */
FD_ZERO(&rfds);
FD_SET(p->fd, &rfds);
efds = rfds;
retval = port_select(p, p->fd+1, &rfds, NULL, &efds, &tv);
if (retval == 0) {
if (0 == total_count) {
/* Record timeout time and caculate elapsed time */
gettimeofday(&end_time, NULL);
timersub(&end_time, &start_time, &elapsed_time);
dump_hex((unsigned char *) rxbuffer, total_count);
rig_debug(RIG_DEBUG_WARN, "%s(): Timed out %d.%d seconds after %d chars\n",
__func__, elapsed_time.tv_sec, elapsed_time.tv_usec, total_count);
return -RIG_ETIMEOUT;
if (!p || !rxbuffer) {
return -RIG_EINVAL;
}
break; /* return what we have read */
}
if (retval < 0) {
dump_hex((unsigned char *) rxbuffer, total_count);
rig_debug(RIG_DEBUG_ERR, "%s(): select() error after %d chars: %s\n",
__func__, total_count, strerror(errno));
if (rxmax < 1) {
return 0;
}
return -RIG_EIO;
}
if (FD_ISSET(p->fd, &efds)) {
rig_debug(RIG_DEBUG_ERR, "%s(): fd error after %d chars\n",
__func__, total_count);
/*
* Wait up to timeout ms.
*/
tv_timeout.tv_sec = p->timeout / 1000;
tv_timeout.tv_usec = (p->timeout % 1000) * 1000;
return -RIG_EIO;
}
/* Store the time of the read loop start */
gettimeofday(&start_time, NULL);
/*
* read 1 character from the rig, (check if in stop set)
* The file descriptor must have been set up non blocking.
*/
while (total_count < rxmax - 1) {
tv = tv_timeout; /* select may have updated it */
FD_ZERO(&rfds);
FD_SET(p->fd, &rfds);
efds = rfds;
retval = port_select(p, p->fd + 1, &rfds, NULL, &efds, &tv);
if (retval == 0) {
if (0 == total_count) {
/* Record timeout time and caculate elapsed time */
gettimeofday(&end_time, NULL);
timersub(&end_time, &start_time, &elapsed_time);
dump_hex((unsigned char *) rxbuffer, total_count);
rig_debug(RIG_DEBUG_WARN,
"%s(): Timed out %d.%d seconds after %d chars\n",
__func__,
elapsed_time.tv_sec,
elapsed_time.tv_usec,
total_count);
return -RIG_ETIMEOUT;
}
break; /* return what we have read */
}
if (retval < 0) {
dump_hex((unsigned char *) rxbuffer, total_count);
rig_debug(RIG_DEBUG_ERR,
"%s(): select() error after %d chars: %s\n",
__func__,
total_count,
strerror(errno));
return -RIG_EIO;
}
if (FD_ISSET(p->fd, &efds)) {
rig_debug(RIG_DEBUG_ERR,
"%s(): fd error after %d chars\n",
__func__,
total_count);
return -RIG_EIO;
}
/*
* read 1 character from the rig, (check if in stop set)
* The file descriptor must have been set up non blocking.
*/
rd_count = port_read(p, &rxbuffer[total_count], 1);
if (rd_count < 0) {
dump_hex((unsigned char *) rxbuffer, total_count);
rig_debug(RIG_DEBUG_ERR, "%s(): read() failed - %s\n",
__func__, strerror(errno));
return -RIG_EIO;
}
if (rd_count < 0) {
dump_hex((unsigned char *) rxbuffer, total_count);
rig_debug(RIG_DEBUG_ERR,
"%s(): read() failed - %s\n",
__func__,
strerror(errno));
return -RIG_EIO;
}
++total_count;
if (stopset && memchr(stopset, rxbuffer[total_count-1], stopset_len))
break;
}
/*
* Doesn't hurt anyway. But be aware, some binary protocols may have
* null chars within th received buffer.
*/
rxbuffer[total_count] = '\000';
rig_debug(RIG_DEBUG_TRACE,"%s(): RX %d characters\n", __func__, total_count);
dump_hex((unsigned char *) rxbuffer, total_count);
if (stopset && memchr(stopset, rxbuffer[total_count - 1], stopset_len)) {
break;
}
}
return total_count; /* return bytes count read */
/*
* Doesn't hurt anyway. But be aware, some binary protocols may have
* null chars within th received buffer.
*/
rxbuffer[total_count] = '\000';
rig_debug(RIG_DEBUG_TRACE,
"%s(): RX %d characters\n",
__func__,
total_count);
dump_hex((unsigned char *) rxbuffer, total_count);
return total_count; /* return bytes count read */
}
/** @} */

18
src/iofunc.h
Wyświetl plik

@ -29,9 +29,19 @@
extern HAMLIB_EXPORT(int) port_open(hamlib_port_t *p);
extern HAMLIB_EXPORT(int) port_close(hamlib_port_t *p, rig_port_t port_type);
extern HAMLIB_EXPORT(int) read_block(hamlib_port_t *p, char *rxbuffer, size_t count);
extern HAMLIB_EXPORT(int) write_block(hamlib_port_t *p, const char *txbuffer, size_t count);
extern HAMLIB_EXPORT(int) read_string(hamlib_port_t *p, char *rxbuffer, size_t rxmax, const char *stopset, int stopset_len);
extern HAMLIB_EXPORT(int) read_block(hamlib_port_t *p,
char *rxbuffer,
size_t count);
extern HAMLIB_EXPORT(int) write_block(hamlib_port_t *p,
const char *txbuffer,
size_t count);
extern HAMLIB_EXPORT(int) read_string(hamlib_port_t *p,
char *rxbuffer,
size_t rxmax,
const char *stopset,
int stopset_len);
#endif /* _IOFUNC_H */

544
src/locator.c
Wyświetl plik

@ -28,7 +28,7 @@
* taken from wwl, by IK0ZSN Mirko Caserta.
*
* New bearing code added by N0NB was found at:
* http://williams.best.vwh.net/avform.htm#Crs
* http://williams.best.vwh.net/avform.htm#Crs
*
*
* This library is free software; you can redistribute it and/or
@ -88,7 +88,7 @@
* locators described in section 3L of "The IARU region 1 VHF managers
* handbook". Values of 5 and 6 will extent the format even more, to the
* longest definition I have seen for locators, see
* http://www.btinternet.com/~g8yoa/geog/non-ra.html
* http://www.btinternet.com/~g8yoa/geog/non-ra.html
* Beware that there seems to be no universally accepted standard for 10 & 12
* character locators.
*
@ -115,14 +115,15 @@ const static int loc_char_range[] = { 18, 10, 24, 10, 24, 10 };
/* end dph */
#endif /* !DOC_HIDDEN */
#endif /* !DOC_HIDDEN */
/**
* \brief Convert DMS to decimal degrees
* \param degrees Degrees, whole degrees
* \param minutes Minutes, whole minutes
* \param seconds Seconds, decimal seconds
* \param sw South or West
* \param degrees Degrees, whole degrees
* \param minutes Minutes, whole minutes
* \param seconds Seconds, decimal seconds
* \param sw South or West
*
* Convert degree/minute/second angle to decimal degrees angle.
* \a degrees >360, \a minutes > 60, and \a seconds > 60.0 are allowed,
@ -137,30 +138,39 @@ const static int loc_char_range[] = { 18, 10, 24, 10, 24, 10 };
*
* \sa dec2dms()
*/
double HAMLIB_API dms2dec(int degrees, int minutes, double seconds, int sw)
{
double st;
double HAMLIB_API dms2dec(int degrees, int minutes, double seconds, int sw) {
double st;
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
if (degrees < 0)
degrees = abs(degrees);
if (minutes < 0)
minutes = abs(minutes);
if (seconds < 0)
seconds = fabs(seconds);
if (degrees < 0) {
degrees = abs(degrees);
}
st = (double)degrees + (double)minutes / 60. + seconds / 3600.;
if (minutes < 0) {
minutes = abs(minutes);
}
if (sw == 1)
return -st;
else
return st;
if (seconds < 0) {
seconds = fabs(seconds);
}
st = (double)degrees + (double)minutes / 60. + seconds / 3600.;
if (sw == 1) {
return -st;
} else {
return st;
}
}
/**
* \brief Convert D M.MMM notation to decimal degrees
* \param degrees Degrees, whole degrees
* \param minutes Minutes, decimal minutes
* \param sw South or West
* \param degrees Degrees, whole degrees
* \param minutes Minutes, decimal minutes
* \param sw South or West
*
* Convert a degrees, decimal minutes notation common on
* many GPS units to its decimal degrees value.
@ -177,30 +187,37 @@ double HAMLIB_API dms2dec(int degrees, int minutes, double seconds, int sw) {
*
* \sa dec2dmmm()
*/
double HAMLIB_API dmmm2dec(int degrees, double minutes, int sw)
{
double st;
double HAMLIB_API dmmm2dec(int degrees, double minutes, int sw) {
double st;
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
if (degrees < 0)
degrees = abs(degrees);
if (minutes < 0)
minutes = fabs(minutes);
if (degrees < 0) {
degrees = abs(degrees);
}
st = (double)degrees + minutes / 60.;
if (minutes < 0) {
minutes = fabs(minutes);
}
if (sw == 1)
return -st;
else
return st;
st = (double)degrees + minutes / 60.;
if (sw == 1) {
return -st;
} else {
return st;
}
}
/**
* \brief Convert decimal degrees angle into DMS notation
* \param dec Decimal degrees
* \param degrees Pointer for the calculated whole Degrees
* \param minutes Pointer for the calculated whole Minutes
* \param seconds Pointer for the calculated decimal Seconds
* \param sw Pointer for the calculated SW flag
* \param dec Decimal degrees
* \param degrees Pointer for the calculated whole Degrees
* \param minutes Pointer for the calculated whole Minutes
* \param seconds Pointer for the calculated decimal Seconds
* \param sw Pointer for the calculated SW flag
*
* Convert decimal degrees angle into its degree/minute/second
* notation.
@ -221,62 +238,69 @@ double HAMLIB_API dmmm2dec(int degrees, double minutes, int sw) {
*
* \sa dms2dec()
*/
int HAMLIB_API dec2dms(double dec, int *degrees, int *minutes, double *seconds,
int *sw)
{
int deg, min;
double st;
int HAMLIB_API dec2dms(double dec, int *degrees, int *minutes, double *seconds, int *sw) {
int deg, min;
double st;
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
/* bail if NULL pointers passed */
if (!degrees || !minutes || !seconds || !sw)
return -RIG_EINVAL;
/* bail if NULL pointers passed */
if (!degrees || !minutes || !seconds || !sw) {
return -RIG_EINVAL;
}
/* reverse the sign if dec has a magnitude greater
* than 180 and factor out multiples of 360.
* e.g. when passed 270 st will be set to -90
* and when passed -270 st will be set to 90. If
* passed 361 st will be set to 1, etc. If passed
* a value > -180 || < 180, value will be unchanged.
*/
if (dec >= 0.0)
st = fmod(dec + 180, 360) - 180;
else
st = fmod(dec - 180, 360) + 180;
/* reverse the sign if dec has a magnitude greater
* than 180 and factor out multiples of 360.
* e.g. when passed 270 st will be set to -90
* and when passed -270 st will be set to 90. If
* passed 361 st will be set to 1, etc. If passed
* a value > -180 || < 180, value will be unchanged.
*/
if (dec >= 0.0) {
st = fmod(dec + 180, 360) - 180;
} else {
st = fmod(dec - 180, 360) + 180;
}
/* if after all of that st is negative, we want deg
* to be negative as well except for 180 which we want
* to be positive.
*/
if (st < 0.0 && st != -180)
*sw = 1;
else
*sw = 0;
/* if after all of that st is negative, we want deg
* to be negative as well except for 180 which we want
* to be positive.
*/
if (st < 0.0 && st != -180) {
*sw = 1;
} else {
*sw = 0;
}
/* work on st as a positive value to remove a
* bug introduced by the effect of floor() when
* passed a negative value. e.g. when passed
* -96.8333 floor() returns -95! Also avoids
* a rounding error introduced on negative values.
*/
st = fabs(st);
/* work on st as a positive value to remove a
* bug introduced by the effect of floor() when
* passed a negative value. e.g. when passed
* -96.8333 floor() returns -95! Also avoids
* a rounding error introduced on negative values.
*/
st = fabs(st);
deg = (int)floor(st);
st = 60. * (st - (double)deg);
min = (int)floor(st);
st = 60. * (st - (double)min);
deg = (int)floor(st);
st = 60. * (st - (double)deg);
min = (int)floor(st);
st = 60. * (st - (double)min);
*degrees = deg;
*minutes = min;
*seconds = st;
*degrees = deg;
*minutes = min;
*seconds = st;
return RIG_OK;
return RIG_OK;
}
/**
* \brief Convert a decimal angle into D M.MMM notation
* \param dec Decimal degrees
* \param degrees Pointer for the calculated whole Degrees
* \param minutes Pointer for the calculated decimal Minutes
* \param sw Pointer for the calculated SW flag
* \param dec Decimal degrees
* \param degrees Pointer for the calculated whole Degrees
* \param minutes Pointer for the calculated decimal Minutes
* \param sw Pointer for the calculated SW flag
*
* Convert a decimal angle into its degree, decimal minute
* notation common on many GPS units.
@ -297,29 +321,35 @@ int HAMLIB_API dec2dms(double dec, int *degrees, int *minutes, double *seconds,
*
* \sa dmmm2dec()
*/
int HAMLIB_API dec2dmmm(double dec, int *degrees, double *minutes, int *sw)
{
int r, min;
double sec;
int HAMLIB_API dec2dmmm(double dec, int *degrees, double *minutes, int *sw) {
int r, min;
double sec;
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
/* bail if NULL pointers passed */
if (!degrees || !minutes || !sw)
return -RIG_EINVAL;
/* bail if NULL pointers passed */
if (!degrees || !minutes || !sw) {
return -RIG_EINVAL;
}
r = dec2dms(dec, degrees, &min, &sec, sw);
if (r != RIG_OK)
return r;
r = dec2dms(dec, degrees, &min, &sec, sw);
*minutes = (double)min + sec / 60;
if (r != RIG_OK) {
return r;
}
return RIG_OK;
*minutes = (double)min + sec / 60;
return RIG_OK;
}
/**
* \brief Convert Maidenhead grid locator to Longitude/Latitude
* \param longitude Pointer for the calculated Longitude
* \param latitude Pointer for the calculated Latitude
* \param locator The Maidenhead grid locator--2 through 12 char + nul string
* \param longitude Pointer for the calculated Longitude
* \param latitude Pointer for the calculated Latitude
* \param locator The Maidenhead grid locator--2 through 12 char + nul string
*
* Convert Maidenhead grid locator to Longitude/Latitude (decimal degrees).
* The locator should be in 2 through 12 chars long format.
@ -342,63 +372,71 @@ int HAMLIB_API dec2dmmm(double dec, int *degrees, double *minutes, int *sw) {
*/
/* begin dph */
int HAMLIB_API locator2longlat(double *longitude, double *latitude,
const char *locator)
{
int x_or_y, paircount;
int locvalue, pair;
int divisions;
double xy[2], ordinate;
int HAMLIB_API locator2longlat(double *longitude, double *latitude, const char *locator) {
int x_or_y, paircount;
int locvalue, pair;
int divisions;
double xy[2], ordinate;
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
/* bail if NULL pointers passed */
if (!longitude || !latitude)
return -RIG_EINVAL;
/* bail if NULL pointers passed */
if (!longitude || !latitude) {
return -RIG_EINVAL;
}
paircount = strlen(locator) / 2;
paircount = strlen(locator) / 2;
/* verify paircount is within limits */
if (paircount > MAX_LOCATOR_PAIRS)
paircount = MAX_LOCATOR_PAIRS;
else if (paircount < MIN_LOCATOR_PAIRS)
return -RIG_EINVAL;
/* verify paircount is within limits */
if (paircount > MAX_LOCATOR_PAIRS) {
paircount = MAX_LOCATOR_PAIRS;
} else if (paircount < MIN_LOCATOR_PAIRS) {
return -RIG_EINVAL;
}
/* For x(=longitude) and y(=latitude) */
for (x_or_y = 0; x_or_y < 2; ++x_or_y) {
ordinate = -90.0;
divisions = 1;
/* For x(=longitude) and y(=latitude) */
for (x_or_y = 0; x_or_y < 2; ++x_or_y) {
ordinate = -90.0;
divisions = 1;
for (pair = 0; pair < paircount; ++pair) {
locvalue = locator[pair*2 + x_or_y];
for (pair = 0; pair < paircount; ++pair) {
locvalue = locator[pair * 2 + x_or_y];
/* Value of digit or letter */
locvalue -= (loc_char_range[pair] == 10) ? '0' :
(isupper(locvalue)) ? 'A' : 'a';
/* Value of digit or letter */
locvalue -= (loc_char_range[pair] == 10) ? '0' :
(isupper(locvalue)) ? 'A' : 'a';
/* Check range for non-letter/digit or out of range */
if ((locvalue < 0) || (locvalue >= loc_char_range[pair]))
return -RIG_EINVAL;
/* Check range for non-letter/digit or out of range */
if ((locvalue < 0) || (locvalue >= loc_char_range[pair])) {
return -RIG_EINVAL;
}
divisions *= loc_char_range[pair];
ordinate += locvalue * 180.0 / divisions;
}
/* Center ordinate in the Maidenhead "square" or "subsquare" */
ordinate += 90.0 / divisions;
divisions *= loc_char_range[pair];
ordinate += locvalue * 180.0 / divisions;
}
xy[x_or_y] = ordinate;
}
/* Center ordinate in the Maidenhead "square" or "subsquare" */
ordinate += 90.0 / divisions;
*longitude = xy[0] * 2.0;
*latitude = xy[1];
xy[x_or_y] = ordinate;
}
return RIG_OK;
*longitude = xy[0] * 2.0;
*latitude = xy[1];
return RIG_OK;
}
/* end dph */
/**
* \brief Convert longitude/latitude to Maidenhead grid locator
* \param longitude Longitude, decimal degrees
* \param latitude Latitude, decimal degrees
* \param locator Pointer for the Maidenhead Locator
* \param pair_count Precision expressed as lon/lat pairs in the locator
* \param longitude Longitude, decimal degrees
* \param latitude Latitude, decimal degrees
* \param locator Pointer for the Maidenhead Locator
* \param pair_count Precision expressed as lon/lat pairs in the locator
*
* Convert longitude/latitude (decimal degrees) to Maidenhead grid locator.
* \a locator must point to an array at least \a pair_count * 2 char + '\\0'.
@ -416,55 +454,62 @@ int HAMLIB_API locator2longlat(double *longitude, double *latitude, const char *
*/
/* begin dph */
int HAMLIB_API longlat2locator(double longitude, double latitude, char *locator,
int pair_count)
{
int x_or_y, pair, locvalue, divisions;
double square_size, ordinate;
int HAMLIB_API longlat2locator(double longitude, double latitude, char *locator, int pair_count) {
int x_or_y, pair, locvalue, divisions;
double square_size, ordinate;
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
if (!locator)
return -RIG_EINVAL;
if (!locator) {
return -RIG_EINVAL;
}
if (pair_count < MIN_LOCATOR_PAIRS || pair_count > MAX_LOCATOR_PAIRS)
return -RIG_EINVAL;
if (pair_count < MIN_LOCATOR_PAIRS || pair_count > MAX_LOCATOR_PAIRS) {
return -RIG_EINVAL;
}
for (x_or_y = 0; x_or_y < 2; ++x_or_y) {
ordinate = (x_or_y == 0) ? longitude / 2.0 : latitude;
divisions = 1;
for (x_or_y = 0; x_or_y < 2; ++x_or_y) {
ordinate = (x_or_y == 0) ? longitude / 2.0 : latitude;
divisions = 1;
/* The 1e-6 here guards against floating point rounding errors */
ordinate = fmod(ordinate + 270.000001, 180.0);
for (pair = 0; pair < pair_count; ++pair) {
divisions *= loc_char_range[pair];
square_size = 180.0 / divisions;
/* The 1e-6 here guards against floating point rounding errors */
ordinate = fmod(ordinate + 270.000001, 180.0);
locvalue = (int) (ordinate / square_size);
ordinate -= square_size * locvalue;
locvalue += (loc_char_range[pair] == 10) ? '0':'A';
locator[pair * 2 + x_or_y] = locvalue;
}
}
locator[pair_count * 2] = '\0';
for (pair = 0; pair < pair_count; ++pair) {
divisions *= loc_char_range[pair];
square_size = 180.0 / divisions;
return RIG_OK;
locvalue = (int)(ordinate / square_size);
ordinate -= square_size * locvalue;
locvalue += (loc_char_range[pair] == 10) ? '0' : 'A';
locator[pair * 2 + x_or_y] = locvalue;
}
}
locator[pair_count * 2] = '\0';
return RIG_OK;
}
/* end dph */
/**
* \brief Calculate the distance and bearing between two points.
* \param lon1 The local Longitude, decimal degrees
* \param lat1 The local Latitude, decimal degrees
* \param lon2 The remote Longitude, decimal degrees
* \param lat2 The remote Latitude, decimal degrees
* \param distance Pointer for the distance, km
* \param azimuth Pointer for the bearing, decimal degrees
* \param lon1 The local Longitude, decimal degrees
* \param lat1 The local Latitude, decimal degrees
* \param lon2 The remote Longitude, decimal degrees
* \param lat2 The remote Latitude, decimal degrees
* \param distance Pointer for the distance, km
* \param azimuth Pointer for the bearing, decimal degrees
*
* Calculate the QRB between \a lon1, \a lat1 and \a lon2, \a lat2.
*
* This version will calculate the QRB to a precision sufficient
* for 12 character locators. Antipodal points, which are easily
* calculated, are considered equidistant and the bearing is
* simply resolved to be true north (0.0°).
* This version will calculate the QRB to a precision sufficient
* for 12 character locators. Antipodal points, which are easily
* calculated, are considered equidistant and the bearing is
* simply resolved to be true north (0.0°).
*
* \retval -RIG_EINVAL if NULL pointer passed or lat and lon values
* exceed -90 to 90 or -180 to 180.
@ -475,90 +520,99 @@ int HAMLIB_API longlat2locator(double longitude, double latitude, char *locator,
*
* \sa distance_long_path(), azimuth_long_path()
*/
int HAMLIB_API qrb(double lon1, double lat1, double lon2, double lat2,
double *distance, double *azimuth)
{
double delta_long, tmp, arc, az;
int HAMLIB_API qrb(double lon1, double lat1, double lon2, double lat2, double *distance, double *azimuth) {
double delta_long, tmp, arc, az;
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
/* bail if NULL pointers passed */
if (!distance || !azimuth)
return -RIG_EINVAL;
/* bail if NULL pointers passed */
if (!distance || !azimuth) {
return -RIG_EINVAL;
}
if ((lat1 > 90.0 || lat1 < -90.0) || (lat2 > 90.0 || lat2 < -90.0))
return -RIG_EINVAL;
if ((lat1 > 90.0 || lat1 < -90.0) || (lat2 > 90.0 || lat2 < -90.0)) {
return -RIG_EINVAL;
}
if ((lon1 > 180.0 || lon1 < -180.0) || (lon2 > 180.0 || lon2 < -180.0))
return -RIG_EINVAL;
if ((lon1 > 180.0 || lon1 < -180.0) || (lon2 > 180.0 || lon2 < -180.0)) {
return -RIG_EINVAL;
}
/* Prevent ACOS() Domain Error */
if (lat1 == 90.0)
lat1 = 89.999999999;
else if (lat1 == -90.0)
lat1 = -89.999999999;
/* Prevent ACOS() Domain Error */
if (lat1 == 90.0) {
lat1 = 89.999999999;
} else if (lat1 == -90.0) {
lat1 = -89.999999999;
}
if (lat2 == 90.0)
lat2 = 89.999999999;
else if (lat2 == -90.0)
lat2 = -89.999999999;
if (lat2 == 90.0) {
lat2 = 89.999999999;
} else if (lat2 == -90.0) {
lat2 = -89.999999999;
}
/* Convert variables to Radians */
lat1 /= RADIAN;
lon1 /= RADIAN;
lat2 /= RADIAN;
lon2 /= RADIAN;
/* Convert variables to Radians */
lat1 /= RADIAN;
lon1 /= RADIAN;
lat2 /= RADIAN;
lon2 /= RADIAN;
delta_long = lon2 - lon1;
delta_long = lon2 - lon1;
tmp = sin(lat1) * sin(lat2) + cos(lat1) * cos(lat2) * cos(delta_long);
tmp = sin(lat1) * sin(lat2) + cos(lat1) * cos(lat2) * cos(delta_long);
if (tmp > .999999999999999) {
/* Station points coincide, use an Omni! */
*distance = 0.0;
*azimuth = 0.0;
return RIG_OK;
}
if (tmp > .999999999999999) {
/* Station points coincide, use an Omni! */
*distance = 0.0;
*azimuth = 0.0;
return RIG_OK;
}
if (tmp < -.999999) {
/*
* points are antipodal, it's straight down.
* Station is equal distance in all Azimuths.
* So take 180 Degrees of arc times 60 nm,
* and you get 10800 nm, or whatever units...
*/
*distance = 180.0 * ARC_IN_KM;
*azimuth = 0.0;
return RIG_OK;
}
if (tmp < -.999999) {
/*
* points are antipodal, it's straight down.
* Station is equal distance in all Azimuths.
* So take 180 Degrees of arc times 60 nm,
* and you get 10800 nm, or whatever units...
*/
*distance = 180.0 * ARC_IN_KM;
*azimuth = 0.0;
return RIG_OK;
}
arc = acos(tmp);
arc = acos(tmp);
/*
* One degree of arc is 60 Nautical miles
* at the surface of the earth, 111.2 km, or 69.1 sm
* This method is easier than the one in the handbook
*/
/*
* One degree of arc is 60 Nautical miles
* at the surface of the earth, 111.2 km, or 69.1 sm
* This method is easier than the one in the handbook
*/
*distance = ARC_IN_KM * RADIAN * arc;
/* Short Path */
/* Change to azimuth computation by Dave Freese, W1HKJ */
az = RADIAN * atan2(sin(lon2 - lon1) * cos(lat2),
(cos(lat1) * sin(lat2) - sin(lat1) * cos(lat2) * cos(lon2 - lon1)));
*distance = ARC_IN_KM * RADIAN * arc;
az = fmod(360.0 + az, 360.0);
/* Short Path */
/* Change to azimuth computation by Dave Freese, W1HKJ */
if (az < 0.0) {
az += 360.0;
} else if (az >= 360.0) {
az -= 360.0;
}
az = RADIAN * atan2(sin(lon2 - lon1) * cos(lat2),
(cos(lat1) * sin(lat2) - sin(lat1) * cos(lat2) * cos(lon2 - lon1)));
*azimuth = floor(az + 0.5);
az = fmod(360.0 + az, 360.0);
if (az < 0.0)
az += 360.0;
else if (az >= 360.0)
az -= 360.0;
*azimuth = floor(az + 0.5);
return RIG_OK;
return RIG_OK;
}
/**
* \brief Calculate the long path distance between two points.
* \param distance The shortpath distance
* \param distance The shortpath distance
*
* Calculate the long path (respective of the short path)
* of a given distance.
@ -567,14 +621,17 @@ int HAMLIB_API qrb(double lon1, double lat1, double lon2, double lat2, double *d
*
* \sa qrb()
*/
double HAMLIB_API distance_long_path(double distance)
{
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
double HAMLIB_API distance_long_path(double distance) {
return (ARC_IN_KM * 360.0) - distance;
return (ARC_IN_KM * 360.0) - distance;
}
/**
* \brief Calculate the long path bearing between two points.
* \param azimuth The shortpath bearing--0.0 to 360.0 degrees
* \param azimuth The shortpath bearing--0.0 to 360.0 degrees
*
* Calculate the long path (respective of the short path)
* of a given bearing.
@ -584,18 +641,21 @@ double HAMLIB_API distance_long_path(double distance) {
*
* \sa qrb()
*/
double HAMLIB_API azimuth_long_path(double azimuth)
{
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
double HAMLIB_API azimuth_long_path(double azimuth) {
if (azimuth == 0.0 || azimuth == 360.0)
if (azimuth == 0.0 || azimuth == 360.0) {
return 180.0;
else if (azimuth > 0.0 && azimuth < 180.0)
} else if (azimuth > 0.0 && azimuth < 180.0) {
return 180.0 + azimuth;
else if (azimuth == 180.0)
} else if (azimuth == 180.0) {
return 0.0;
else if (azimuth > 180.0 && azimuth < 360.0)
} else if (azimuth > 180.0 && azimuth < 360.0) {
return (180.0 - azimuth) * -1.0;
else
} else {
return -RIG_EINVAL;
}
}
/*! @} */

1656
src/mem.c
Wyświetl plik

Plik diff jest za duży Load Diff

877
src/misc.c
Wyświetl plik

Plik diff jest za duży Load Diff

33
src/misc.h
Wyświetl plik

@ -26,7 +26,7 @@
/*
* Carefull!! These marcos are NOT reentrant!
* Carefull!! These macros are NOT reentrant!
* ie. they may not be executed atomically,
* thus not ensure mutual exclusion.
* Fix it when making Hamlib reentrant! --SF
@ -44,20 +44,31 @@ void dump_hex(const unsigned char ptr[], size_t size);
/*
* BCD conversion routines.
* to_bcd converts a long long int to a little endian BCD array,
* and return a pointer to this array.
* from_bcd converts a little endian BCD array to long long int
*
* to_bcd() converts a long long int to a little endian BCD array,
* and return a pointer to this array.
*
* from_bcd() converts a little endian BCD array to long long int
* reprensentation, and return it.
*
* bcd_len is the number of digits in the BCD array.
*/
extern HAMLIB_EXPORT(unsigned char *) to_bcd(unsigned char bcd_data[], unsigned long long freq, unsigned bcd_len);
extern HAMLIB_EXPORT(unsigned long long) from_bcd(const unsigned char bcd_data[], unsigned bcd_len);
extern HAMLIB_EXPORT(unsigned char *) to_bcd(unsigned char bcd_data[],
unsigned long long freq,
unsigned bcd_len);
extern HAMLIB_EXPORT(unsigned long long) from_bcd(const unsigned char bcd_data[],
unsigned bcd_len);
/*
* same as to_bcd and from_bcd, but in Big Endian mode
* same as to_bcd() and from_bcd(), but in Big Endian mode
*/
extern HAMLIB_EXPORT(unsigned char *) to_bcd_be(unsigned char bcd_data[], unsigned long long freq, unsigned bcd_len);
extern HAMLIB_EXPORT(unsigned long long) from_bcd_be(const unsigned char bcd_data[], unsigned bcd_len);
extern HAMLIB_EXPORT(unsigned char *) to_bcd_be(unsigned char bcd_data[],
unsigned long long freq,
unsigned bcd_len);
extern HAMLIB_EXPORT(unsigned long long) from_bcd_be(const unsigned char bcd_data[],
unsigned bcd_len);
extern HAMLIB_EXPORT(int) sprintf_freq(char *str, freq_t);
@ -77,7 +88,9 @@ extern int no_restore_ai;
#include <sys/time.h>
#endif
extern HAMLIB_EXPORT(int) rig_check_cache_timeout(const struct timeval *tv, int timeout);
extern HAMLIB_EXPORT(int) rig_check_cache_timeout(const struct timeval *tv,
int timeout);
extern HAMLIB_EXPORT(void) rig_force_cache_timeout(struct timeval *tv);

300
src/network.c
Wyświetl plik

@ -60,12 +60,12 @@
#include <sys/ioctl.h>
#elif HAVE_WS2TCPIP_H
#include <ws2tcpip.h>
# if defined(HAVE_WSPIAPI_H)
# include <wspiapi.h>
# endif
# if defined(HAVE_WSPIAPI_H)
# include <wspiapi.h>
# endif
#endif
#include "hamlib/rig.h"
#include <hamlib/rig.h>
#include "network.h"
#include "misc.h"
@ -76,36 +76,37 @@ static int wsstarted;
#define NET_BUFFER_SIZE 64
static void handle_error (enum rig_debug_level_e lvl, const char *msg)
static void handle_error(enum rig_debug_level_e lvl, const char *msg)
{
int e;
int e;
#ifdef __MINGW32__
LPVOID lpMsgBuf;
LPVOID lpMsgBuf;
lpMsgBuf = (LPVOID)"Unknown error";
e = WSAGetLastError();
if (FormatMessage(FORMAT_MESSAGE_ALLOCATE_BUFFER
| FORMAT_MESSAGE_FROM_SYSTEM
| FORMAT_MESSAGE_IGNORE_INSERTS,
NULL, e,
MAKELANGID(LANG_NEUTRAL, SUBLANG_DEFAULT),
// Default language
(LPTSTR)&lpMsgBuf,
0,
NULL)) {
rig_debug(lvl, "%s: Network error %d: %s\n", msg, e, lpMsgBuf);
LocalFree(lpMsgBuf);
} else {
rig_debug(lvl, "%s: Network error %d\n", msg, e);
}
lpMsgBuf = (LPVOID)"Unknown error";
e = WSAGetLastError();
if (FormatMessage(
FORMAT_MESSAGE_ALLOCATE_BUFFER |
FORMAT_MESSAGE_FROM_SYSTEM |
FORMAT_MESSAGE_IGNORE_INSERTS,
NULL, e,
MAKELANGID(LANG_NEUTRAL, SUBLANG_DEFAULT),
// Default language
(LPTSTR)&lpMsgBuf, 0, NULL))
{
rig_debug (lvl, "%s: Network error %d: %s\n", msg, e, lpMsgBuf);
LocalFree(lpMsgBuf);
}
else
{
rig_debug (lvl, "%s: Network error %d\n", msg, e);
}
#else
e = errno;
rig_debug (lvl, "%s: Network error %d: %s\n", msg, e, strerror (e));
e = errno;
rig_debug(lvl, "%s: Network error %d: %s\n", msg, e, strerror(e));
#endif
}
/**
* \brief Open network port using rig.state data
*
@ -118,157 +119,184 @@ static void handle_error (enum rig_debug_level_e lvl, const char *msg)
*/
int network_open(hamlib_port_t *rp, int default_port)
{
int fd; /* File descriptor for the port */
int status;
struct addrinfo hints, *res, *saved_res;
char *hoststr = NULL, *portstr = NULL, *bracketstr1, *bracketstr2;
char hostname[FILPATHLEN];
char defaultportstr[8];
int fd; /* File descriptor for the port */
int status;
struct addrinfo hints, *res, *saved_res;
char *hoststr = NULL, *portstr = NULL, *bracketstr1, *bracketstr2;
char hostname[FILPATHLEN];
char defaultportstr[8];
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
#ifdef __MINGW32__
WSADATA wsadata;
if (!(wsstarted++) && WSAStartup(MAKEWORD(1,1), &wsadata) == SOCKET_ERROR) {
rig_debug(RIG_DEBUG_ERR, "Error creating socket\n");
return -RIG_EIO;
}
WSADATA wsadata;
if (!(wsstarted++) && WSAStartup(MAKEWORD(1, 1), &wsadata) == SOCKET_ERROR) {
rig_debug(RIG_DEBUG_ERR, "%s: error creating socket\n", __func__);
return -RIG_EIO;
}
#endif
if (!rp)
return -RIG_EINVAL;
if (!rp) {
return -RIG_EINVAL;
}
memset(&hints, 0, sizeof(hints));
hints.ai_family = PF_UNSPEC;
if (rp->type.rig == RIG_PORT_UDP_NETWORK)
hints.ai_socktype = SOCK_DGRAM;
else
hints.ai_socktype = SOCK_STREAM;
memset(&hints, 0, sizeof(hints));
hints.ai_family = PF_UNSPEC;
hoststr = NULL; /* default of all local interfaces */
if (rp->pathname[0] == ':')
{
portstr = rp->pathname + 1;
}
else
{
if (strlen (rp->pathname))
{
strncpy(hostname, rp->pathname, FILPATHLEN-1);
hoststr = hostname;
/* look for IPv6 numeric form [<addr>] */
bracketstr1 = strchr(hoststr, '[');
bracketstr2 = strrchr(hoststr, ']');
if (bracketstr1 && bracketstr2 && bracketstr2 > bracketstr1)
{
hoststr = bracketstr1 + 1;
*bracketstr2 = '\0';
portstr = bracketstr2 + 1; /* possible port after ]: */
}
else
{
bracketstr2 = NULL;
portstr = hoststr; /* possible port after : */
}
/* search last ':' */
portstr = strrchr(portstr, ':');
if (portstr)
{
*portstr++ = '\0';
}
}
if (!portstr)
{
sprintf(defaultportstr, "%d", default_port);
portstr = defaultportstr;
}
}
if (rp->type.rig == RIG_PORT_UDP_NETWORK) {
hints.ai_socktype = SOCK_DGRAM;
} else {
hints.ai_socktype = SOCK_STREAM;
}
status=getaddrinfo(hoststr, portstr, &hints, &res);
if (status != 0) {
rig_debug(RIG_DEBUG_ERR, "Cannot get host \"%s\": %s\n",
rp->pathname, gai_strerror(errno));
return -RIG_ECONF;
}
saved_res = res;
/* default of all local interfaces */
hoststr = NULL;
/* we don't want a signal when connection get broken */
if (rp->pathname[0] == ':') {
portstr = rp->pathname + 1;
} else {
if (strlen(rp->pathname)) {
strncpy(hostname, rp->pathname, FILPATHLEN - 1);
hoststr = hostname;
/* look for IPv6 numeric form [<addr>] */
bracketstr1 = strchr(hoststr, '[');
bracketstr2 = strrchr(hoststr, ']');
if (bracketstr1 && bracketstr2 && bracketstr2 > bracketstr1) {
hoststr = bracketstr1 + 1;
*bracketstr2 = '\0';
portstr = bracketstr2 + 1; /* possible port after ]: */
} else {
bracketstr2 = NULL;
portstr = hoststr; /* possible port after : */
}
/* search last ':' */
portstr = strrchr(portstr, ':');
if (portstr) {
*portstr++ = '\0';
}
}
if (!portstr) {
sprintf(defaultportstr, "%d", default_port);
portstr = defaultportstr;
}
}
status = getaddrinfo(hoststr, portstr, &hints, &res);
if (status != 0) {
rig_debug(RIG_DEBUG_ERR,
"%s: cannot get host \"%s\": %s\n",
__func__,
rp->pathname,
gai_strerror(errno));
return -RIG_ECONF;
}
saved_res = res;
/* we don't want a signal when connection get broken */
#ifdef SIGPIPE
signal(SIGPIPE, SIG_IGN);
signal(SIGPIPE, SIG_IGN);
#endif
do
{
fd = socket(res->ai_family, res->ai_socktype, res->ai_protocol);
if (fd < 0)
{
handle_error (RIG_DEBUG_ERR, "socket");
freeaddrinfo (saved_res);
return -RIG_EIO;
}
do {
fd = socket(res->ai_family, res->ai_socktype, res->ai_protocol);
if ((status = connect(fd, res->ai_addr, res->ai_addrlen)) == 0)
{
break;
}
handle_error (RIG_DEBUG_WARN, "connect (trying next interface)");
if (fd < 0) {
handle_error(RIG_DEBUG_ERR, "socket");
freeaddrinfo(saved_res);
return -RIG_EIO;
}
if ((status = connect(fd, res->ai_addr, res->ai_addrlen)) == 0) {
break;
}
handle_error(RIG_DEBUG_WARN, "connect (trying next interface)");
#ifdef __MINGW32__
closesocket (fd);
closesocket(fd);
#else
close (fd);
close(fd);
#endif
} while ((res = res->ai_next) != NULL);
} while ((res = res->ai_next) != NULL);
freeaddrinfo (saved_res);
freeaddrinfo(saved_res);
if (NULL == res) {
rig_debug (RIG_DEBUG_ERR, "Failed to connect to %s\n" , rp->pathname);
return -RIG_EIO;
}
if (NULL == res) {
rig_debug(RIG_DEBUG_ERR,
"%s: failed to connect to %s\n",
__func__,
rp->pathname);
return -RIG_EIO;
}
rp->fd = fd;
return RIG_OK;
rp->fd = fd;
return RIG_OK;
}
/**
* \brief Clears any data in the read buffer of the socket
*
* \param rp Port data structure
*/
void network_flush(hamlib_port_t* rp)
void network_flush(hamlib_port_t *rp)
{
#ifdef __MINGW32__
ULONG len = 0;
ULONG len = 0;
#else
uint len = 0;
uint len = 0;
#endif
char buffer[NET_BUFFER_SIZE] = { 0 };
for (;;) {
char buffer[NET_BUFFER_SIZE] = { 0 };
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
for (;;) {
#ifdef __MINGW32__
ioctlsocket (rp->fd, FIONREAD, &len);
ioctlsocket(rp->fd, FIONREAD, &len);
#else
ioctl(rp->fd, FIONREAD, &len);
ioctl(rp->fd, FIONREAD, &len);
#endif
if (len > 0) {
len = read(rp->fd, &buffer, len < NET_BUFFER_SIZE ? len : NET_BUFFER_SIZE);
rig_debug(RIG_DEBUG_WARN, "Network data cleared: %s\n", buffer);
} else {
break;
if (len > 0) {
len = read(rp->fd, &buffer, len < NET_BUFFER_SIZE ? len : NET_BUFFER_SIZE);
rig_debug(RIG_DEBUG_WARN,
"%s: network data cleared: %s\n",
__func__,
buffer);
} else {
break;
}
}
}
}
int network_close(hamlib_port_t *rp)
{
int ret;
int ret;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
#ifdef __MINGW32__
ret = closesocket(rp->fd);
if (--wsstarted)
WSACleanup();
ret = closesocket(rp->fd);
if (--wsstarted) {
WSACleanup();
}
#else
ret = close(rp->fd);
ret = close(rp->fd);
#endif
return ret;
return ret;
}
/** @} */

46
src/par_nt.h
Wyświetl plik

@ -1,12 +1,12 @@
/* NT Parport Access stuff - Matthew Duggan (2002) */
/*
* ParallelVdm Device (0x2C) is mostly undocumented, used by VDM for parallel
/*
* ParallelVdm Device (0x2C) is mostly undocumented, used by VDM for parallel
* port compatibility.
*/
/*
* Different from CTL_CODE in DDK, limited to ParallelVdm but makes this
/*
* Different from CTL_CODE in DDK, limited to ParallelVdm but makes this
* code cleaner.
*/
@ -28,28 +28,26 @@
*/
/* The status pin functions operate in terms of these bits: */
enum ieee1284_status_bits
{
S1284_NFAULT = 0x08,
S1284_SELECT = 0x10,
S1284_PERROR = 0x20,
S1284_NACK = 0x40,
S1284_BUSY = 0x80,
/* To convert those values into PC-style register values, use this: */
S1284_INVERTED = S1284_BUSY
enum ieee1284_status_bits {
S1284_NFAULT = 0x08,
S1284_SELECT = 0x10,
S1284_PERROR = 0x20,
S1284_NACK = 0x40,
S1284_BUSY = 0x80,
/* To convert those values into PC-style register values, use this: */
S1284_INVERTED = S1284_BUSY
};
/* The control pin functions operate in terms of these bits: */
enum ieee1284_control_bits
{
C1284_NSTROBE = 0x01,
C1284_NAUTOFD = 0x02,
C1284_NINIT = 0x04,
C1284_NSELECTIN = 0x08,
/* To convert those values into PC-style register values, use this: */
C1284_INVERTED = (C1284_NSTROBE|
C1284_NAUTOFD|
C1284_NSELECTIN)
enum ieee1284_control_bits {
C1284_NSTROBE = 0x01,
C1284_NAUTOFD = 0x02,
C1284_NINIT = 0x04,
C1284_NSELECTIN = 0x08,
/* To convert those values into PC-style register values, use this: */
C1284_INVERTED = (C1284_NSTROBE
| C1284_NAUTOFD
| C1284_NSELECTIN)
};
#endif /* _PAR_NT_H */
#endif /* _PAR_NT_H */

569
src/parallel.c
Wyświetl plik

@ -60,7 +60,7 @@
#include <winbase.h>
#endif
#include "hamlib/rig.h"
#include <hamlib/rig.h>
#include "parallel.h"
#ifdef HAVE_LINUX_PPDEV_H
@ -78,14 +78,14 @@
* We toggle them so that this weirdness doesn't get propagated
* through our interface.
*/
#define CP_ACTIVE_LOW_BITS 0x0B
#define CP_ACTIVE_LOW_BITS 0x0B
/*
* These status port bits are active low.
* We toggle them so that this weirdness doesn't get propagated
* through our interface.
*/
#define SP_ACTIVE_LOW_BITS 0x80
#define SP_ACTIVE_LOW_BITS 0x80
/*
Pinout table of parallel port from http://en.wikipedia.org/wiki/Parallel_port#Pinouts
@ -112,6 +112,7 @@
* means low true, e.g., *Strobe.
*/
/**
* \brief Open Parallel Port
* \param port
@ -120,85 +121,107 @@
* TODO: to be called before exiting: atexit(parport_cleanup)
* void parport_cleanup() { ioctl(fd, PPRELEASE); }
*/
int par_open(hamlib_port_t *port)
{
int fd;
int fd;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
#ifdef HAVE_LINUX_PPDEV_H
int mode;
int mode;
#endif
#if defined (__WIN64__) || defined(__WIN32__)
HANDLE handle;
HANDLE handle;
#endif
if (!port->pathname[0])
return -RIG_EINVAL;
if (!port->pathname[0]) {
return -RIG_EINVAL;
}
#ifdef HAVE_LINUX_PPDEV_H
/* TODO: open with O_NONBLOCK ? */
fd = open(port->pathname, O_RDWR);
/* TODO: open with O_NONBLOCK ? */
fd = open(port->pathname, O_RDWR);
if (fd < 0) {
rig_debug(RIG_DEBUG_ERR, "Opening device \"%s\": %s\n", port->pathname, strerror(errno));
return -RIG_EIO;
}
if (fd < 0) {
rig_debug(RIG_DEBUG_ERR,
"%s: opening device \"%s\": %s\n",
__func__,
port->pathname,
strerror(errno));
return -RIG_EIO;
}
mode = IEEE1284_MODE_COMPAT;
mode = IEEE1284_MODE_COMPAT;
if (ioctl(fd, PPSETMODE, &mode) != 0) {
rig_debug(RIG_DEBUG_ERR, "PPSETMODE \"%s\": %s\n", port->pathname, strerror(errno));
close(fd);
return -RIG_EIO;
}
if (ioctl(fd, PPSETMODE, &mode) != 0) {
rig_debug(RIG_DEBUG_ERR, "%s: PPSETMODE \"%s\": %s\n",
__func__,
port->pathname,
strerror(errno));
close(fd);
return -RIG_EIO;
}
#elif defined(HAVE_DEV_PPBUS_PPI_H)
fd = open(port->pathname, O_RDWR);
fd = open(port->pathname, O_RDWR);
if (fd < 0) {
rig_debug(RIG_DEBUG_ERR, "Opening device \"%s\": %s\n", port->pathname, strerror(errno));
return -RIG_EIO;
}
if (fd < 0) {
rig_debug(RIG_DEBUG_ERR,
"%s: opening device \"%s\": %s\n",
__func__,
port->pathname,
strerror(errno));
return -RIG_EIO;
}
#elif defined(__WIN64__) || defined(__WIN32__)
handle = CreateFile(port->pathname, GENERIC_READ | GENERIC_WRITE,
0, NULL, OPEN_EXISTING, 0, NULL);
handle = CreateFile(port->pathname, GENERIC_READ | GENERIC_WRITE,
0, NULL, OPEN_EXISTING, 0, NULL);
if (handle == INVALID_HANDLE_VALUE) {
rig_debug(RIG_DEBUG_ERR, "Opening device \"%s\"\n", port->pathname);
CloseHandle(handle);
return -RIG_EIO;
} else {
fd = _open_osfhandle((intptr_t)handle, _O_APPEND | _O_RDONLY);
if (handle == INVALID_HANDLE_VALUE) {
rig_debug(RIG_DEBUG_ERR,
"%s: opening device \"%s\"\n",
__func__,
port->pathname);
CloseHandle(handle);
return -RIG_EIO;
} else {
fd = _open_osfhandle((intptr_t)handle, _O_APPEND | _O_RDONLY);
if (fd == -1)
return -RIG_EIO;
}
if (fd == -1) {
return -RIG_EIO;
}
}
#else
return -RIG_ENIMPL;
return -RIG_ENIMPL;
#endif
port->fd = fd;
return fd;
port->fd = fd;
return fd;
}
/**
* \brief Close Parallel Port
* \param port
*/
int par_close(hamlib_port_t *port)
{
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
#ifdef HAVE_LINUX_PPDEV_H
#elif defined(HAVE_DEV_PPBUS_PPI_H)
#elif defined(__WIN64__) || defined(__WIN32__)
_close(port->fd);
_close(port->fd);
return RIG_OK;
return RIG_OK;
#endif
return close(port->fd);
return close(port->fd);
}
/**
* \brief Send data on Parallel port
* \param port
@ -206,35 +229,38 @@ int par_close(hamlib_port_t *port)
*/
int HAMLIB_API par_write_data(hamlib_port_t *port, unsigned char data)
{
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
#ifdef HAVE_LINUX_PPDEV_H
int status;
status = ioctl(port->fd, PPWDATA, &data);
return status == 0 ? RIG_OK : -RIG_EIO;
int status;
status = ioctl(port->fd, PPWDATA, &data);
return status == 0 ? RIG_OK : -RIG_EIO;
#elif defined(HAVE_DEV_PPBUS_PPI_H)
int status;
status = ioctl(port->fd, PPISDATA, &data);
return status == 0 ? RIG_OK : -RIG_EIO;
int status;
status = ioctl(port->fd, PPISDATA, &data);
return status == 0 ? RIG_OK : -RIG_EIO;
#elif defined(__WIN64__) || defined(__WIN32__)
unsigned int dummy;
unsigned int dummy;
intptr_t handle;
intptr_t handle;
handle = _get_osfhandle(port->fd);
handle = _get_osfhandle(port->fd);
if (handle != (intptr_t)INVALID_HANDLE_VALUE) {
if (!(DeviceIoControl((HANDLE)handle, NT_IOCTL_DATA, &data, sizeof(data),
NULL, 0, (LPDWORD)&dummy, NULL))) {
rig_debug(RIG_DEBUG_ERR, "%s: DeviceIoControl failed!\n", __FUNCTION__);
return -RIG_EIO;
}
}
if (handle != (intptr_t)INVALID_HANDLE_VALUE) {
if (!(DeviceIoControl((HANDLE)handle, NT_IOCTL_DATA, &data, sizeof(data),
NULL, 0, (LPDWORD)&dummy, NULL))) {
rig_debug(RIG_DEBUG_ERR, "%s: DeviceIoControl failed!\n", __func__);
return -RIG_EIO;
}
}
return RIG_OK;
return RIG_OK;
#else
return -RIG_ENIMPL;
return -RIG_ENIMPL;
#endif
}
/**
* \brief Receive data on Parallel port
* \param port
@ -242,37 +268,40 @@ int HAMLIB_API par_write_data(hamlib_port_t *port, unsigned char data)
*/
int HAMLIB_API par_read_data(hamlib_port_t *port, unsigned char *data)
{
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
#ifdef HAVE_LINUX_PPDEV_H
int status;
status = ioctl(port->fd, PPRDATA, data);
return status == 0 ? RIG_OK : -RIG_EIO;
int status;
status = ioctl(port->fd, PPRDATA, data);
return status == 0 ? RIG_OK : -RIG_EIO;
#elif defined(HAVE_DEV_PPBUS_PPI_H)
int status;
status = ioctl(port->fd, PPIGDATA, &data);
return status == 0 ? RIG_OK : -RIG_EIO;
int status;
status = ioctl(port->fd, PPIGDATA, &data);
return status == 0 ? RIG_OK : -RIG_EIO;
#elif defined(__WIN64__) || defined(__WIN32__)
unsigned char ret;
unsigned int dummy;
unsigned char ret;
unsigned int dummy;
intptr_t handle;
intptr_t handle;
handle = _get_osfhandle(port->fd);
handle = _get_osfhandle(port->fd);
if (handle != (intptr_t)INVALID_HANDLE_VALUE) {
if (!(DeviceIoControl((HANDLE)handle, NT_IOCTL_STATUS, NULL, 0, &ret,
sizeof(ret), (LPDWORD)&dummy, NULL))) {
rig_debug(RIG_DEBUG_ERR, "%s: DeviceIoControl failed!\n", __FUNCTION__);
return -RIG_EIO;
}
}
if (handle != (intptr_t)INVALID_HANDLE_VALUE) {
if (!(DeviceIoControl((HANDLE)handle, NT_IOCTL_STATUS, NULL, 0, &ret,
sizeof(ret), (LPDWORD)&dummy, NULL))) {
rig_debug(RIG_DEBUG_ERR, "%s: DeviceIoControl failed!\n", __func__);
return -RIG_EIO;
}
}
*data = ret ^ S1284_INVERTED;
return RIG_OK;
*data = ret ^ S1284_INVERTED;
return RIG_OK;
#else
return -RIG_ENIMPL;
return -RIG_ENIMPL;
#endif
}
/**
* \brief Set control data for Parallel Port
* \param port
@ -280,54 +309,71 @@ int HAMLIB_API par_read_data(hamlib_port_t *port, unsigned char *data)
*/
int HAMLIB_API par_write_control(hamlib_port_t *port, unsigned char control)
{
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
#ifdef HAVE_LINUX_PPDEV_H
int status;
unsigned char ctrl = control ^ CP_ACTIVE_LOW_BITS;
status = ioctl(port->fd, PPWCONTROL, &ctrl);
int status;
unsigned char ctrl = control ^ CP_ACTIVE_LOW_BITS;
status = ioctl(port->fd, PPWCONTROL, &ctrl);
if (status < 0)
rig_debug(RIG_DEBUG_ERR, "ioctl(PPWCONTROL) failed: %s\n", strerror(errno));
if (status < 0) {
rig_debug(RIG_DEBUG_ERR,
"%s: ioctl(PPWCONTROL) failed: %s\n",
__func__,
strerror(errno));
}
return status == 0 ? RIG_OK : -RIG_EIO;
return status == 0 ? RIG_OK : -RIG_EIO;
#elif defined(HAVE_DEV_PPBUS_PPI_H)
int status;
unsigned char ctrl = control ^ CP_ACTIVE_LOW_BITS;
status = ioctl(port->fd, PPISCTRL, &ctrl);
return status == 0 ? RIG_OK : -RIG_EIO;
int status;
unsigned char ctrl = control ^ CP_ACTIVE_LOW_BITS;
status = ioctl(port->fd, PPISCTRL, &ctrl);
return status == 0 ? RIG_OK : -RIG_EIO;
#elif defined(__WIN64__) || defined(__WIN32__)
unsigned char ctr = control;
unsigned char dummyc;
unsigned int dummy;
const unsigned char wm = (C1284_NSTROBE |
C1284_NAUTOFD |
C1284_NINIT |
C1284_NSELECTIN);
intptr_t handle;
unsigned char ctr = control;
unsigned char dummyc;
unsigned int dummy;
const unsigned char wm = (C1284_NSTROBE
| C1284_NAUTOFD
| C1284_NINIT
| C1284_NSELECTIN);
intptr_t handle;
if (ctr & 0x20) {
rig_debug(RIG_DEBUG_WARN, "use ieee1284_data_dir to change data line direction!\n");
}
if (ctr & 0x20) {
rig_debug(RIG_DEBUG_WARN,
"%s: use ieee1284_data_dir to change data line direction!\n",
__func__);
}
/* Deal with inversion issues. */
ctr ^= wm & C1284_INVERTED;
ctr = (ctr & ~wm) ^ (ctr & wm);
/* Deal with inversion issues. */
ctr ^= wm & C1284_INVERTED;
ctr = (ctr & ~wm) ^ (ctr & wm);
handle = _get_osfhandle(port->fd);
handle = _get_osfhandle(port->fd);
if (handle != (intptr_t)INVALID_HANDLE_VALUE) {
if (!(DeviceIoControl((HANDLE)handle, NT_IOCTL_CONTROL, &ctr,
sizeof(ctr), &dummyc, sizeof(dummyc), (LPDWORD)&dummy, NULL))) {
rig_debug(RIG_DEBUG_ERR, "frob_control: DeviceIoControl failed!\n");
return -RIG_EIO;
}
}
if (handle != (intptr_t)INVALID_HANDLE_VALUE) {
if (!(DeviceIoControl((HANDLE)handle,
NT_IOCTL_CONTROL,
&ctr,
sizeof(ctr),
&dummyc,
sizeof(dummyc),
(LPDWORD)&dummy,
NULL))) {
rig_debug(RIG_DEBUG_ERR,
"%s: frob_control: DeviceIoControl failed!\n",
__func__);
return -RIG_EIO;
}
}
return RIG_OK;
return RIG_OK;
#else
return -RIG_ENIMPL;
return -RIG_ENIMPL;
#endif
}
/**
* \brief Read control data for Parallel Port
* \param port
@ -335,45 +381,53 @@ int HAMLIB_API par_write_control(hamlib_port_t *port, unsigned char control)
*/
int HAMLIB_API par_read_control(hamlib_port_t *port, unsigned char *control)
{
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
#ifdef HAVE_LINUX_PPDEV_H
int status;
unsigned char ctrl;
status = ioctl(port->fd, PPRCONTROL, &ctrl);
int status;
unsigned char ctrl;
status = ioctl(port->fd, PPRCONTROL, &ctrl);
if (status < 0)
rig_debug(RIG_DEBUG_ERR, "ioctl(PPRCONTROL) failed: %s\n", strerror(errno));
if (status < 0) {
rig_debug(RIG_DEBUG_ERR,
"%s: ioctl(PPRCONTROL) failed: %s\n",
__func__,
strerror(errno));
}
*control = ctrl ^ CP_ACTIVE_LOW_BITS;
return status == 0 ? RIG_OK : -RIG_EIO;
*control = ctrl ^ CP_ACTIVE_LOW_BITS;
return status == 0 ? RIG_OK : -RIG_EIO;
#elif defined(HAVE_DEV_PPBUS_PPI_H)
int status;
unsigned char ctrl;
status = ioctl(port->fd, PPIGCTRL, &ctrl);
*control = ctrl ^ CP_ACTIVE_LOW_BITS;
return status == 0 ? RIG_OK : -RIG_EIO;
int status;
unsigned char ctrl;
status = ioctl(port->fd, PPIGCTRL, &ctrl);
*control = ctrl ^ CP_ACTIVE_LOW_BITS;
return status == 0 ? RIG_OK : -RIG_EIO;
#elif defined(__WIN64__) || defined(__WIN32__)
unsigned char ret;
unsigned int dummy;
unsigned char ret;
unsigned int dummy;
intptr_t handle;
intptr_t handle;
handle = _get_osfhandle(port->fd);
handle = _get_osfhandle(port->fd);
if (handle != (intptr_t)INVALID_HANDLE_VALUE) {
if (!(DeviceIoControl((HANDLE)handle, NT_IOCTL_CONTROL, NULL, 0, &ret,
sizeof(ret), (LPDWORD)&dummy, NULL))) {
rig_debug(RIG_DEBUG_ERR, "%s: DeviceIoControl failed!\n", __FUNCTION__);
return -RIG_EIO;
}
}
if (handle != (intptr_t)INVALID_HANDLE_VALUE) {
if (!(DeviceIoControl((HANDLE)handle, NT_IOCTL_CONTROL, NULL, 0, &ret,
sizeof(ret), (LPDWORD)&dummy, NULL))) {
rig_debug(RIG_DEBUG_ERR, "%s: DeviceIoControl failed!\n", __func__);
return -RIG_EIO;
}
}
*control = ret ^ S1284_INVERTED;
return RIG_OK;
*control = ret ^ S1284_INVERTED;
return RIG_OK;
#else
return -RIG_ENIMPL;
return -RIG_ENIMPL;
#endif
}
/**
* \brief Get parallel port status
* \param port
@ -382,41 +436,45 @@ int HAMLIB_API par_read_control(hamlib_port_t *port, unsigned char *control)
*/
int HAMLIB_API par_read_status(hamlib_port_t *port, unsigned char *status)
{
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
#ifdef HAVE_LINUX_PPDEV_H
int ret;
unsigned char sta;
ret = ioctl(port->fd, PPRSTATUS, &sta);
*status = sta ^ SP_ACTIVE_LOW_BITS;
return ret == 0 ? RIG_OK : -RIG_EIO;
int ret;
unsigned char sta;
ret = ioctl(port->fd, PPRSTATUS, &sta);
*status = sta ^ SP_ACTIVE_LOW_BITS;
return ret == 0 ? RIG_OK : -RIG_EIO;
#elif defined(HAVE_DEV_PPBUS_PPI_H)
int ret;
unsigned char sta;
ret = ioctl(port->fd, PPIGSTATUS, &sta);
*status = sta ^ SP_ACTIVE_LOW_BITS;
return ret == 0 ? RIG_OK : -RIG_EIO;
int ret;
unsigned char sta;
ret = ioctl(port->fd, PPIGSTATUS, &sta);
*status = sta ^ SP_ACTIVE_LOW_BITS;
return ret == 0 ? RIG_OK : -RIG_EIO;
#elif defined(__WIN64__) || defined(__WIN32__)
unsigned char ret;
unsigned int dummy;
unsigned char ret;
unsigned int dummy;
intptr_t handle;
intptr_t handle;
handle = _get_osfhandle(port->fd);
handle = _get_osfhandle(port->fd);
if (handle != (intptr_t)INVALID_HANDLE_VALUE) {
if (!(DeviceIoControl((HANDLE)handle, NT_IOCTL_STATUS, NULL, 0, &ret,
sizeof(ret), (LPDWORD)&dummy, NULL))) {
rig_debug(RIG_DEBUG_ERR, "%s: DeviceIoControl failed!\n", __FUNCTION__);
return -RIG_EIO;
}
}
if (handle != (intptr_t)INVALID_HANDLE_VALUE) {
if (!(DeviceIoControl((HANDLE)handle, NT_IOCTL_STATUS, NULL, 0, &ret,
sizeof(ret), (LPDWORD)&dummy, NULL))) {
rig_debug(RIG_DEBUG_ERR, "%s: DeviceIoControl failed!\n", __func__);
return -RIG_EIO;
}
}
*status = ret ^ S1284_INVERTED;
return RIG_OK;
*status = ret ^ S1284_INVERTED;
return RIG_OK;
#else
return -RIG_ENIMPL;
return -RIG_ENIMPL;
#endif
}
/**
* \brief Get a lock on the Parallel Port
* \param port
@ -424,23 +482,30 @@ int HAMLIB_API par_read_status(hamlib_port_t *port, unsigned char *status)
*/
int HAMLIB_API par_lock(hamlib_port_t *port)
{
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
#ifdef HAVE_LINUX_PPDEV_H
if (ioctl(port->fd, PPCLAIM) < 0) {
rig_debug(RIG_DEBUG_ERR, "Claiming device \"%s\": %s\n", port->pathname, strerror(errno));
return -RIG_EIO;
}
if (ioctl(port->fd, PPCLAIM) < 0) {
rig_debug(RIG_DEBUG_ERR,
"%s: claiming device \"%s\": %s\n",
__func__,
port->pathname,
strerror(errno));
return -RIG_EIO;
}
return RIG_OK;
return RIG_OK;
#elif defined(HAVE_DEV_PPBUS_PPI_H)
return RIG_OK;
return RIG_OK;
#elif defined(__WIN64__) || defined(__WIN32__)
return RIG_OK;
return RIG_OK;
#else
return -RIG_ENIMPL;
return -RIG_ENIMPL;
#endif
}
/**
* \brief Release lock on Parallel Port
* \param port
@ -448,23 +513,30 @@ int HAMLIB_API par_lock(hamlib_port_t *port)
*/
int HAMLIB_API par_unlock(hamlib_port_t *port)
{
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
#ifdef HAVE_LINUX_PPDEV_H
if (ioctl(port->fd, PPRELEASE) < 0) {
rig_debug(RIG_DEBUG_ERR, "Releasing device \"%s\": %s\n", port->pathname, strerror(errno));
return -RIG_EIO;
}
if (ioctl(port->fd, PPRELEASE) < 0) {
rig_debug(RIG_DEBUG_ERR,
"%s: releasing device \"%s\": %s\n",
__func__,
port->pathname,
strerror(errno));
return -RIG_EIO;
}
return RIG_OK;
return RIG_OK;
#elif defined(HAVE_DEV_PPBUS_PPI_H)
return RIG_OK;
return RIG_OK;
#elif defined(__WIN64__) || defined(__WIN32__)
return RIG_OK;
return RIG_OK;
#else
return -RIG_ENIMPL;
return -RIG_ENIMPL;
#endif
}
#ifndef PARPORT_CONTROL_STROBE
#define PARPORT_CONTROL_STROBE 0x1
#endif
@ -472,6 +544,7 @@ int HAMLIB_API par_unlock(hamlib_port_t *port)
#define PARPORT_CONTROL_INIT 0x4
#endif
/**
* \brief Set or unset Push to talk bit on Parallel Port
* \param p
@ -480,42 +553,49 @@ int HAMLIB_API par_unlock(hamlib_port_t *port)
*/
int par_ptt_set(hamlib_port_t *p, ptt_t pttx)
{
switch (p->type.ptt) {
case RIG_PTT_PARALLEL: {
unsigned char ctl;
int status;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
par_lock(p);
status = par_read_control(p, &ctl);
switch (p->type.ptt) {
case RIG_PTT_PARALLEL: {
unsigned char ctl;
int status;
if (status != RIG_OK)
return status;
par_lock(p);
status = par_read_control(p, &ctl);
/* Enable CW & PTT - /STROBE bit (pin 1) */
ctl &= ~PARPORT_CONTROL_STROBE;
if (status != RIG_OK) {
return status;
}
/* TODO: kill parm.parallel.pin? */
/* Enable CW & PTT - /STROBE bit (pin 1) */
ctl &= ~PARPORT_CONTROL_STROBE;
/* PTT keying - /INIT bit (pin 16) (inverted) */
if (pttx == RIG_PTT_ON)
ctl |= PARPORT_CONTROL_INIT;
else
ctl &= ~PARPORT_CONTROL_INIT;
/* TODO: kill parm.parallel.pin? */
status = par_write_control(p, ctl);
par_unlock(p);
return status;
}
/* PTT keying - /INIT bit (pin 16) (inverted) */
if (pttx == RIG_PTT_ON) {
ctl |= PARPORT_CONTROL_INIT;
} else {
ctl &= ~PARPORT_CONTROL_INIT;
}
default:
rig_debug(RIG_DEBUG_ERR, "Unsupported PTT type %d\n",
p->type.ptt);
return -RIG_EINVAL;
}
status = par_write_control(p, ctl);
par_unlock(p);
return status;
}
return RIG_OK;
default:
rig_debug(RIG_DEBUG_ERR,
"%s: unsupported PTT type %d\n",
__func__,
p->type.ptt);
return -RIG_EINVAL;
}
return RIG_OK;
}
/**
* \brief Get state of Push to Talk from Parallel Port
* \param p
@ -524,30 +604,35 @@ int par_ptt_set(hamlib_port_t *p, ptt_t pttx)
*/
int par_ptt_get(hamlib_port_t *p, ptt_t *pttx)
{
switch (p->type.ptt) {
case RIG_PTT_PARALLEL: {
unsigned char ctl;
int status;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
par_lock(p);
status = par_read_control(p, &ctl);
par_unlock(p);
switch (p->type.ptt) {
case RIG_PTT_PARALLEL: {
unsigned char ctl;
int status;
*pttx = (ctl & PARPORT_CONTROL_INIT) &&
!(ctl & PARPORT_CONTROL_STROBE) ?
RIG_PTT_ON : RIG_PTT_OFF;
return status;
}
par_lock(p);
status = par_read_control(p, &ctl);
par_unlock(p);
default:
rig_debug(RIG_DEBUG_ERR, "Unsupported PTT type %d\n",
p->type.ptt);
return -RIG_ENAVAIL;
}
*pttx = (ctl & PARPORT_CONTROL_INIT) &&
!(ctl & PARPORT_CONTROL_STROBE) ?
RIG_PTT_ON : RIG_PTT_OFF;
return status;
}
return RIG_OK;
default:
rig_debug(RIG_DEBUG_ERR,
"Unsupported PTT type %d\n",
__func__,
p->type.ptt);
return -RIG_ENAVAIL;
}
return RIG_OK;
}
/**
* \brief get Data Carrier Detect (squelch) from Parallel Port
* \param p
@ -556,24 +641,28 @@ int par_ptt_get(hamlib_port_t *p, ptt_t *pttx)
*/
int par_dcd_get(hamlib_port_t *p, dcd_t *dcdx)
{
switch (p->type.dcd) {
case RIG_DCD_PARALLEL: {
unsigned char reg;
int status;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
status = par_read_data(p, &reg);
*dcdx = reg & (1 << p->parm.parallel.pin) ?
RIG_DCD_ON : RIG_DCD_OFF;
return status;
}
switch (p->type.dcd) {
case RIG_DCD_PARALLEL: {
unsigned char reg;
int status;
default:
rig_debug(RIG_DEBUG_ERR, "Unsupported DCD type %d\n",
p->type.dcd);
return -RIG_ENAVAIL;
}
status = par_read_data(p, &reg);
*dcdx = reg & (1 << p->parm.parallel.pin) ?
RIG_DCD_ON : RIG_DCD_OFF;
return status;
}
return RIG_OK;
default:
rig_debug(RIG_DEBUG_ERR,
"%s: unsupported DCD type %d\n",
__func__,
p->type.dcd);
return -RIG_ENAVAIL;
}
return RIG_OK;
}
/** @} */

12
src/parallel.h
Wyświetl plik

@ -69,10 +69,16 @@ int par_ptt_get(hamlib_port_t *p, ptt_t *pttx);
int par_dcd_get(hamlib_port_t *p, dcd_t *dcdx);
extern HAMLIB_EXPORT(int) par_write_data(hamlib_port_t *p, unsigned char data);
extern HAMLIB_EXPORT(int) par_write_control(hamlib_port_t *p, unsigned char control);
extern HAMLIB_EXPORT(int) par_write_control(hamlib_port_t *p,
unsigned char control);
extern HAMLIB_EXPORT(int) par_read_data(hamlib_port_t *p, unsigned char *data);
extern HAMLIB_EXPORT(int) par_read_control(hamlib_port_t *p, unsigned char *control);
extern HAMLIB_EXPORT(int) par_read_status(hamlib_port_t *p, unsigned char *status);
extern HAMLIB_EXPORT(int) par_read_control(hamlib_port_t *p,
unsigned char *control);
extern HAMLIB_EXPORT(int) par_read_status(hamlib_port_t *p,
unsigned char *status);
extern HAMLIB_EXPORT(int) par_lock(hamlib_port_t *p);
extern HAMLIB_EXPORT(int) par_unlock(hamlib_port_t *p);

362
src/register.c
Wyświetl plik

@ -48,8 +48,8 @@
#define RIG_BACKEND_MAX 32
#define DEFINE_INITRIG_BACKEND(backend) \
int MAKE_VERSIONED_FN(PREFIX_INITRIG, ABI_VERSION, backend(void *be_handle)); \
rig_model_t MAKE_VERSIONED_FN(PREFIX_PROBERIG, ABI_VERSION, backend(hamlib_port_t *port, rig_probe_func_t cfunc, rig_ptr_t data))
int MAKE_VERSIONED_FN(PREFIX_INITRIG, ABI_VERSION, backend(void *be_handle)); \
rig_model_t MAKE_VERSIONED_FN(PREFIX_PROBERIG, ABI_VERSION, backend(hamlib_port_t *port, rig_probe_func_t cfunc, rig_ptr_t data))
#define RIG_FUNCNAMA(backend) MAKE_VERSIONED_FN(PREFIX_INITRIG, ABI_VERSION, backend)
#define RIG_FUNCNAMB(backend) MAKE_VERSIONED_FN(PREFIX_PROBERIG, ABI_VERSION, backend)
@ -57,11 +57,8 @@
#define RIG_FUNCNAM(backend) RIG_FUNCNAMA(backend),RIG_FUNCNAMB(backend)
/*
* RIG_BACKEND_LIST is defined here, please keep it up to data,
* ie. each time you give birth to a new backend
* Also, it should be possible to register "external" backend,
* that is backend that were not known by Hamlib at compile time.
* Maybe, riglist.h should reserve some numbers for them? --SF
* RIG_BACKEND_LIST is defined here, please keep it up to date,
* i.e. each time you implement a new backend.
*/
DEFINE_INITRIG_BACKEND(dummy);
DEFINE_INITRIG_BACKEND(yaesu);
@ -104,95 +101,109 @@ DEFINE_INITRIG_BACKEND(winradio);
* and the branch name, which is a character string.
*/
static struct {
int be_num;
const char *be_name;
int (* be_init_all)(void * handle);
rig_model_t (* be_probe_all)(hamlib_port_t*, rig_probe_func_t, rig_ptr_t);
} rig_backend_list[RIG_BACKEND_MAX] =
{
{ RIG_DUMMY, RIG_BACKEND_DUMMY, RIG_FUNCNAMA(dummy) },
{ RIG_YAESU, RIG_BACKEND_YAESU, RIG_FUNCNAM(yaesu) },
{ RIG_KENWOOD, RIG_BACKEND_KENWOOD, RIG_FUNCNAM(kenwood) },
{ RIG_ICOM, RIG_BACKEND_ICOM, RIG_FUNCNAM(icom) },
{ RIG_ICMARINE, RIG_BACKEND_ICMARINE, RIG_FUNCNAMA(icmarine) },
{ RIG_PCR, RIG_BACKEND_PCR, RIG_FUNCNAMA(pcr) },
{ RIG_AOR, RIG_BACKEND_AOR, RIG_FUNCNAMA(aor) },
{ RIG_JRC, RIG_BACKEND_JRC, RIG_FUNCNAMA(jrc) },
{ RIG_UNIDEN, RIG_BACKEND_UNIDEN, RIG_FUNCNAM(uniden) },
{ RIG_DRAKE, RIG_BACKEND_DRAKE, RIG_FUNCNAM(drake) },
{ RIG_LOWE, RIG_BACKEND_LOWE, RIG_FUNCNAM(lowe) },
{ RIG_RACAL, RIG_BACKEND_RACAL, RIG_FUNCNAMA(racal) },
{ RIG_WJ, RIG_BACKEND_WJ, RIG_FUNCNAMA(wj) },
{ RIG_SKANTI, RIG_BACKEND_SKANTI, RIG_FUNCNAMA(skanti) },
int be_num;
const char *be_name;
int (* be_init_all)(void *handle);
rig_model_t (* be_probe_all)(hamlib_port_t *, rig_probe_func_t, rig_ptr_t);
} rig_backend_list[RIG_BACKEND_MAX] = {
{ RIG_DUMMY, RIG_BACKEND_DUMMY, RIG_FUNCNAMA(dummy) },
{ RIG_YAESU, RIG_BACKEND_YAESU, RIG_FUNCNAM(yaesu) },
{ RIG_KENWOOD, RIG_BACKEND_KENWOOD, RIG_FUNCNAM(kenwood) },
{ RIG_ICOM, RIG_BACKEND_ICOM, RIG_FUNCNAM(icom) },
{ RIG_ICMARINE, RIG_BACKEND_ICMARINE, RIG_FUNCNAMA(icmarine) },
{ RIG_PCR, RIG_BACKEND_PCR, RIG_FUNCNAMA(pcr) },
{ RIG_AOR, RIG_BACKEND_AOR, RIG_FUNCNAMA(aor) },
{ RIG_JRC, RIG_BACKEND_JRC, RIG_FUNCNAMA(jrc) },
{ RIG_UNIDEN, RIG_BACKEND_UNIDEN, RIG_FUNCNAM(uniden) },
{ RIG_DRAKE, RIG_BACKEND_DRAKE, RIG_FUNCNAM(drake) },
{ RIG_LOWE, RIG_BACKEND_LOWE, RIG_FUNCNAM(lowe) },
{ RIG_RACAL, RIG_BACKEND_RACAL, RIG_FUNCNAMA(racal) },
{ RIG_WJ, RIG_BACKEND_WJ, RIG_FUNCNAMA(wj) },
{ RIG_SKANTI, RIG_BACKEND_SKANTI, RIG_FUNCNAMA(skanti) },
#ifdef HAVE_WINRADIO
{ RIG_WINRADIO, RIG_BACKEND_WINRADIO, RIG_FUNCNAMA(winradio) },
{ RIG_WINRADIO, RIG_BACKEND_WINRADIO, RIG_FUNCNAMA(winradio) },
#endif /* HAVE_WINRADIO */
{ RIG_TENTEC, RIG_BACKEND_TENTEC, RIG_FUNCNAMA(tentec) },
{ RIG_ALINCO, RIG_BACKEND_ALINCO, RIG_FUNCNAMA(alinco) },
{ RIG_KACHINA, RIG_BACKEND_KACHINA, RIG_FUNCNAMA(kachina) },
{ RIG_TAPR, RIG_BACKEND_TAPR, RIG_FUNCNAMA(tapr) },
{ RIG_FLEXRADIO, RIG_BACKEND_FLEXRADIO, RIG_FUNCNAMA(flexradio) },
{ RIG_RFT, RIG_BACKEND_RFT, RIG_FUNCNAMA(rft) },
{ RIG_KIT, RIG_BACKEND_KIT, RIG_FUNCNAMA(kit) },
{ RIG_TUNER, RIG_BACKEND_TUNER, RIG_FUNCNAMA(tuner) },
{ RIG_RS, RIG_BACKEND_RS, RIG_FUNCNAMA(rs) },
{ RIG_PRM80, RIG_BACKEND_PRM80, RIG_FUNCNAMA(prm80) },
{ RIG_ADAT, RIG_BACKEND_ADAT, RIG_FUNCNAM(adat) },
{ RIG_DORJI, RIG_BACKEND_DORJI, RIG_FUNCNAMA(dorji) },
{ RIG_BARRETT, RIG_BACKEND_BARRETT, RIG_FUNCNAMA(barrett) },
{ 0, NULL }, /* end */
{ RIG_TENTEC, RIG_BACKEND_TENTEC, RIG_FUNCNAMA(tentec) },
{ RIG_ALINCO, RIG_BACKEND_ALINCO, RIG_FUNCNAMA(alinco) },
{ RIG_KACHINA, RIG_BACKEND_KACHINA, RIG_FUNCNAMA(kachina) },
{ RIG_TAPR, RIG_BACKEND_TAPR, RIG_FUNCNAMA(tapr) },
{ RIG_FLEXRADIO, RIG_BACKEND_FLEXRADIO, RIG_FUNCNAMA(flexradio) },
{ RIG_RFT, RIG_BACKEND_RFT, RIG_FUNCNAMA(rft) },
{ RIG_KIT, RIG_BACKEND_KIT, RIG_FUNCNAMA(kit) },
{ RIG_TUNER, RIG_BACKEND_TUNER, RIG_FUNCNAMA(tuner) },
{ RIG_RS, RIG_BACKEND_RS, RIG_FUNCNAMA(rs) },
{ RIG_PRM80, RIG_BACKEND_PRM80, RIG_FUNCNAMA(prm80) },
{ RIG_ADAT, RIG_BACKEND_ADAT, RIG_FUNCNAM(adat) },
{ RIG_DORJI, RIG_BACKEND_DORJI, RIG_FUNCNAMA(dorji) },
{ RIG_BARRETT, RIG_BACKEND_BARRETT, RIG_FUNCNAMA(barrett) },
{ 0, NULL }, /* end */
};
/*
* This struct to keep track of known rig models.
* It is chained, and used in a hash table, see below.
*/
struct rig_list {
const struct rig_caps *caps;
struct rig_list *next;
const struct rig_caps *caps;
struct rig_list *next;
};
#define RIGLSTHASHSZ 16
#define HASH_FUNC(a) ((a)%RIGLSTHASHSZ)
/*
* The rig_hash_table is a hash table pointing to a list of next==NULL
* terminated caps.
* terminated caps.
*/
static struct rig_list *rig_hash_table[RIGLSTHASHSZ] = { NULL, };
static int rig_lookup_backend(rig_model_t rig_model);
/*
* Basically, this is a hash insert function that doesn't check for dup!
*/
int HAMLIB_API rig_register(const struct rig_caps *caps)
{
int hval;
struct rig_list *p;
int hval;
struct rig_list *p;
if (!caps)
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
rig_debug(RIG_DEBUG_VERBOSE, "rig_register (%d)\n",caps->rig_model);
if (!caps) {
return -RIG_EINVAL;
}
rig_debug(RIG_DEBUG_VERBOSE,
"%s: rig_register (%d)\n",
__func__,
caps->rig_model);
#ifndef DONT_WANT_DUP_CHECK
if (rig_get_caps(caps->rig_model)!=NULL)
return -RIG_EINVAL;
if (rig_get_caps(caps->rig_model) != NULL) {
return -RIG_EINVAL;
}
#endif
p = (struct rig_list*)malloc(sizeof(struct rig_list));
if (!p)
return -RIG_ENOMEM;
p = (struct rig_list *)malloc(sizeof(struct rig_list));
hval = HASH_FUNC(caps->rig_model);
p->caps = caps;
// p->handle = NULL;
p->next = rig_hash_table[hval];
rig_hash_table[hval] = p;
if (!p) {
return -RIG_ENOMEM;
}
return RIG_OK;
hval = HASH_FUNC(caps->rig_model);
p->caps = caps;
// p->handle = NULL;
p->next = rig_hash_table[hval];
rig_hash_table[hval] = p;
return RIG_OK;
}
/*
@ -200,16 +211,17 @@ int HAMLIB_API rig_register(const struct rig_caps *caps)
* ie. rig_hash_table lookup
*/
const struct rig_caps * HAMLIB_API rig_get_caps(rig_model_t rig_model)
const struct rig_caps *HAMLIB_API rig_get_caps(rig_model_t rig_model)
{
struct rig_list *p;
struct rig_list *p;
for (p = rig_hash_table[HASH_FUNC(rig_model)]; p; p=p->next) {
if (p->caps->rig_model == rig_model)
return p->caps;
}
for (p = rig_hash_table[HASH_FUNC(rig_model)]; p; p = p->next) {
if (p->caps->rig_model == rig_model) {
return p->caps;
}
}
return NULL; /* sorry, caps not registered! */
return NULL; /* sorry, caps not registered! */
}
/*
@ -219,15 +231,16 @@ const struct rig_caps * HAMLIB_API rig_get_caps(rig_model_t rig_model)
*/
static int rig_lookup_backend(rig_model_t rig_model)
{
int i;
int i;
for (i=0; i<RIG_BACKEND_MAX && rig_backend_list[i].be_name; i++) {
if (RIG_BACKEND_NUM(rig_model) ==
rig_backend_list[i].be_num)
return i;
}
for (i = 0; i < RIG_BACKEND_MAX && rig_backend_list[i].be_name; i++) {
if (RIG_BACKEND_NUM(rig_model) ==
rig_backend_list[i].be_num) {
return i;
}
}
return -1;
return -1;
}
/*
@ -238,85 +251,96 @@ static int rig_lookup_backend(rig_model_t rig_model)
*/
int HAMLIB_API rig_check_backend(rig_model_t rig_model)
{
const struct rig_caps *caps;
int be_idx;
int retval;
const struct rig_caps *caps;
int be_idx;
int retval;
/* already loaded ? */
caps = rig_get_caps(rig_model);
if (caps)
return RIG_OK;
/* already loaded ? */
caps = rig_get_caps(rig_model);
be_idx = rig_lookup_backend(rig_model);
if (caps) {
return RIG_OK;
}
/*
* Never heard about this backend family!
*/
if (be_idx == -1) {
rig_debug(RIG_DEBUG_VERBOSE, "rig_check_backend: unsupported "
"backend %d for model %d\n",
RIG_BACKEND_NUM(rig_model), rig_model);
return -RIG_ENAVAIL;
}
be_idx = rig_lookup_backend(rig_model);
retval = rig_load_backend(rig_backend_list[be_idx].be_name);
/*
* Never heard about this backend family!
*/
if (be_idx == -1) {
rig_debug(RIG_DEBUG_VERBOSE, "rig_check_backend: unsupported "
"backend %d for model %d\n",
RIG_BACKEND_NUM(rig_model), rig_model);
return -RIG_ENAVAIL;
}
return retval;
retval = rig_load_backend(rig_backend_list[be_idx].be_name);
return retval;
}
int HAMLIB_API rig_unregister(rig_model_t rig_model)
{
int hval;
struct rig_list *p,*q;
int hval;
struct rig_list *p, *q;
hval = HASH_FUNC(rig_model);
q = NULL;
for (p = rig_hash_table[hval]; p; p=p->next) {
if (p->caps->rig_model == rig_model) {
if (q == NULL)
rig_hash_table[hval] = p->next;
else
q->next = p->next;
hval = HASH_FUNC(rig_model);
q = NULL;
free(p);
return RIG_OK;
}
q = p;
}
for (p = rig_hash_table[hval]; p; p = p->next) {
if (p->caps->rig_model == rig_model) {
if (q == NULL) {
rig_hash_table[hval] = p->next;
} else {
q->next = p->next;
}
return -RIG_EINVAL; /* sorry, caps not registered! */
free(p);
return RIG_OK;
}
q = p;
}
return -RIG_EINVAL; /* sorry, caps not registered! */
}
/*
* rig_list_foreach
* executes cfunc on all the elements stored in the rig hash list
*/
int HAMLIB_API rig_list_foreach(int (*cfunc)(const struct rig_caps*, rig_ptr_t),rig_ptr_t data)
int HAMLIB_API rig_list_foreach(int (*cfunc)(const struct rig_caps *,
rig_ptr_t), rig_ptr_t data)
{
struct rig_list *p;
int i;
struct rig_list *p;
int i;
if (!cfunc)
return -RIG_EINVAL;
for (i=0; i<RIGLSTHASHSZ; i++) {
struct rig_list * next = NULL;
for (p=rig_hash_table[i]; p; p=next) {
next = p->next; /* read before call in case it is unregistered */
if ((*cfunc)(p->caps,data) == 0)
return RIG_OK;
if (!cfunc) {
return -RIG_EINVAL;
}
}
return RIG_OK;
for (i = 0; i < RIGLSTHASHSZ; i++) {
struct rig_list *next = NULL;
for (p = rig_hash_table[i]; p; p = next) {
next = p->next; /* read before call in case it is unregistered */
if ((*cfunc)(p->caps, data) == 0) {
return RIG_OK;
}
}
}
return RIG_OK;
}
static int dummy_rig_probe(const hamlib_port_t *p, rig_model_t model, rig_ptr_t data)
static int dummy_rig_probe(const hamlib_port_t *p, rig_model_t model,
rig_ptr_t data)
{
rig_debug(RIG_DEBUG_TRACE, "Found rig, model %d\n", model);
return RIG_OK;
rig_debug(RIG_DEBUG_TRACE, "Found rig, model %d\n", model);
return RIG_OK;
}
/*
@ -325,46 +349,52 @@ static int dummy_rig_probe(const hamlib_port_t *p, rig_model_t model, rig_ptr_t
*/
rig_model_t rig_probe_first(hamlib_port_t *p)
{
int i;
rig_model_t model;
int i;
rig_model_t model;
for (i=0; i<RIG_BACKEND_MAX && rig_backend_list[i].be_name; i++) {
if (rig_backend_list[i].be_probe_all) {
model = (*rig_backend_list[i].be_probe_all)(p, dummy_rig_probe, (rig_ptr_t)NULL);
/* stop at first one found */
if (model != RIG_MODEL_NONE)
return model;
}
}
return RIG_MODEL_NONE;
for (i = 0; i < RIG_BACKEND_MAX && rig_backend_list[i].be_name; i++) {
if (rig_backend_list[i].be_probe_all) {
model = (*rig_backend_list[i].be_probe_all)(p, dummy_rig_probe,
(rig_ptr_t)NULL);
/* stop at first one found */
if (model != RIG_MODEL_NONE) {
return model;
}
}
}
return RIG_MODEL_NONE;
}
/*
* rig_probe_all_backends
* called straight by rig_probe_all
*/
int rig_probe_all_backends(hamlib_port_t *p, rig_probe_func_t cfunc, rig_ptr_t data)
int rig_probe_all_backends(hamlib_port_t *p, rig_probe_func_t cfunc,
rig_ptr_t data)
{
int i;
int i;
for (i=0; i<RIG_BACKEND_MAX && rig_backend_list[i].be_name; i++) {
if (rig_backend_list[i].be_probe_all) {
(*rig_backend_list[i].be_probe_all)(p, cfunc, data);
}
}
return RIG_OK;
for (i = 0; i < RIG_BACKEND_MAX && rig_backend_list[i].be_name; i++) {
if (rig_backend_list[i].be_probe_all) {
(*rig_backend_list[i].be_probe_all)(p, cfunc, data);
}
}
return RIG_OK;
}
int rig_load_all_backends()
{
int i;
int i;
for (i=0; i<RIG_BACKEND_MAX && rig_backend_list[i].be_name; i++) {
rig_load_backend(rig_backend_list[i].be_name);
}
for (i = 0; i < RIG_BACKEND_MAX && rig_backend_list[i].be_name; i++) {
rig_load_backend(rig_backend_list[i].be_name);
}
return RIG_OK;
return RIG_OK;
}
@ -375,22 +405,20 @@ typedef int (*backend_init_t)(rig_ptr_t);
*/
int HAMLIB_API rig_load_backend(const char *be_name)
{
int i;
backend_init_t be_init;
int i;
backend_init_t be_init;
for (i=0; i<RIG_BACKEND_MAX && rig_backend_list[i].be_name; i++) {
if (!strcmp(be_name, rig_backend_list[i].be_name)) {
be_init = rig_backend_list[i].be_init_all ;
if(be_init)
{
return (*be_init)(NULL);
}
else
{
return -RIG_EINVAL;
}
}
}
for (i = 0; i < RIG_BACKEND_MAX && rig_backend_list[i].be_name; i++) {
if (!strcmp(be_name, rig_backend_list[i].be_name)) {
be_init = rig_backend_list[i].be_init_all ;
return -RIG_EINVAL;
if (be_init) {
return (*be_init)(NULL);
} else {
return -RIG_EINVAL;
}
}
}
return -RIG_EINVAL;
}

26
src/register.h
Wyświetl plik

@ -42,15 +42,31 @@
#define PREFIX_INITRIG initrigs
#define PREFIX_PROBERIG probeallrigs
#define DECLARE_INITRIG_BACKEND(backend) EXTERN_C BACKEND_EXPORT(int) MAKE_VERSIONED_FN(PREFIX_INITRIG, ABI_VERSION, backend(void *be_handle))
#define DECLARE_INITRIG_BACKEND(backend) \
EXTERN_C BACKEND_EXPORT(int) \
MAKE_VERSIONED_FN(PREFIX_INITRIG, ABI_VERSION, backend(void *be_handle))
#define DECLARE_PROBERIG_BACKEND(backend) EXTERN_C BACKEND_EXPORT(rig_model_t) MAKE_VERSIONED_FN(PREFIX_PROBERIG, ABI_VERSION, backend(hamlib_port_t *port, rig_probe_func_t cfunc, rig_ptr_t data))
#define DECLARE_PROBERIG_BACKEND(backend) \
EXTERN_C BACKEND_EXPORT(rig_model_t) \
MAKE_VERSIONED_FN(PREFIX_PROBERIG, \
ABI_VERSION, \
backend(hamlib_port_t *port, \
rig_probe_func_t cfunc, \
rig_ptr_t data))
#define PREFIX_INITROTS initrots
#define PREFIX_PROBEROTS probeallrots
#define DECLARE_INITROT_BACKEND(backend) EXTERN_C BACKEND_EXPORT(int) MAKE_VERSIONED_FN(PREFIX_INITROTS, ABI_VERSION, backend(void *be_handle))
#define DECLARE_INITROT_BACKEND(backend) \
EXTERN_C BACKEND_EXPORT(int) \
MAKE_VERSIONED_FN(PREFIX_INITROTS, ABI_VERSION, backend(void *be_handle))
#define DECLARE_PROBEROT_BACKEND(backend) EXTERN_C BACKEND_EXPORT(rot_model_t) MAKE_VERSIONED_FN(PREFIX_PROBEROTS, ABI_VERSION, backend(hamlib_port_t *port, rig_probe_func_t cfunc, rig_ptr_t data))
#define DECLARE_PROBEROT_BACKEND(backend) \
EXTERN_C BACKEND_EXPORT(rot_model_t) \
MAKE_VERSIONED_FN(PREFIX_PROBEROTS, \
ABI_VERSION, \
backend(hamlib_port_t *port, \
rig_probe_func_t cfunc, \
rig_ptr_t data))
#endif /* _REGISTER_H */
#endif /* _REGISTER_H */

4646
src/rig.c
Wyświetl plik

Plik diff jest za duży Load Diff

741
src/rot_conf.c
Wyświetl plik

@ -49,70 +49,86 @@
* Configuration options available in the rot->state struct.
*/
static const struct confparams rotfrontend_cfg_params[] = {
{ TOK_PATHNAME, "rot_pathname", "Rig path name",
"Path name to the device file of the rotator",
"/dev/rotator", RIG_CONF_STRING,
},
{ TOK_WRITE_DELAY, "write_delay", "Write delay",
"Delay in ms between each byte sent out",
"0", RIG_CONF_NUMERIC, { .n = { 0, 1000, 1 } }
},
{ TOK_POST_WRITE_DELAY, "post_write_delay", "Post write delay",
"Delay in ms between each command sent out",
"0", RIG_CONF_NUMERIC, { .n = { 0, 1000, 1 } }
},
{ TOK_TIMEOUT, "timeout", "Timeout", "Timeout in ms",
"0", RIG_CONF_NUMERIC, { .n = { 0, 10000, 1 } }
},
{ TOK_RETRY, "retry", "Retry", "Max number of retry",
"0", RIG_CONF_NUMERIC, { .n = { 0, 10, 1 } }
},
{
TOK_PATHNAME, "rot_pathname", "Rig path name",
"Path name to the device file of the rotator",
"/dev/rotator", RIG_CONF_STRING,
},
{
TOK_WRITE_DELAY, "write_delay", "Write delay",
"Delay in ms between each byte sent out",
"0", RIG_CONF_NUMERIC, { .n = { 0, 1000, 1 } }
},
{
TOK_POST_WRITE_DELAY, "post_write_delay", "Post write delay",
"Delay in ms between each command sent out",
"0", RIG_CONF_NUMERIC, { .n = { 0, 1000, 1 } }
},
{
TOK_TIMEOUT, "timeout", "Timeout", "Timeout in ms",
"0", RIG_CONF_NUMERIC, { .n = { 0, 10000, 1 } }
},
{
TOK_RETRY, "retry", "Retry", "Max number of retry",
"0", RIG_CONF_NUMERIC, { .n = { 0, 10, 1 } }
},
{ TOK_MIN_AZ, "min_az", "Minimum azimuth",
"Minimum rotator azimuth in degrees",
"-180", RIG_CONF_NUMERIC, { .n = { -360, 360, .001 } }
},
{ TOK_MAX_AZ, "max_az", "Maximum azimuth",
"Maximum rotator azimuth in degrees",
"180", RIG_CONF_NUMERIC, { .n = { -360, 360, .001 } }
},
{ TOK_MIN_EL, "min_el", "Minimum elevation",
"Minimum rotator elevation in degrees",
"0", RIG_CONF_NUMERIC, { .n = { -90, 180, .001 } }
},
{ TOK_MAX_EL, "max_el", "Maximum elevation",
"Maximum rotator elevation in degrees",
"90", RIG_CONF_NUMERIC, { .n = { -90, 180, .001 } }
},
{
TOK_MIN_AZ, "min_az", "Minimum azimuth",
"Minimum rotator azimuth in degrees",
"-180", RIG_CONF_NUMERIC, { .n = { -360, 360, .001 } }
},
{
TOK_MAX_AZ, "max_az", "Maximum azimuth",
"Maximum rotator azimuth in degrees",
"180", RIG_CONF_NUMERIC, { .n = { -360, 360, .001 } }
},
{
TOK_MIN_EL, "min_el", "Minimum elevation",
"Minimum rotator elevation in degrees",
"0", RIG_CONF_NUMERIC, { .n = { -90, 180, .001 } }
},
{
TOK_MAX_EL, "max_el", "Maximum elevation",
"Maximum rotator elevation in degrees",
"90", RIG_CONF_NUMERIC, { .n = { -90, 180, .001 } }
},
{ RIG_CONF_END, NULL, }
{ RIG_CONF_END, NULL, }
};
static const struct confparams rotfrontend_serial_cfg_params[] = {
{ TOK_SERIAL_SPEED, "serial_speed", "Serial speed",
"Serial port baud rate",
"0", RIG_CONF_NUMERIC, { .n = { 300, 115200, 1 } }
},
{ TOK_DATA_BITS, "data_bits", "Serial data bits",
"Serial port data bits",
"8", RIG_CONF_NUMERIC, { .n = { 5, 8, 1 } }
},
{ TOK_STOP_BITS, "stop_bits", "Serial stop bits",
"Serial port stop bits",
"1", RIG_CONF_NUMERIC, { .n = { 0, 3, 1 } }
},
{ TOK_PARITY, "serial_parity", "Serial parity",
"Serial port parity",
"None", RIG_CONF_COMBO, { .c = {{ "None", "Odd", "Even", "Mark", "Space", NULL }} }
},
{ TOK_HANDSHAKE, "serial_handshake", "Serial handshake",
"Serial port handshake",
"None", RIG_CONF_COMBO, { .c = {{ "None", "XONXOFF", "Hardware", NULL }} }
},
{
TOK_SERIAL_SPEED, "serial_speed", "Serial speed",
"Serial port baud rate",
"0", RIG_CONF_NUMERIC, { .n = { 300, 115200, 1 } }
},
{
TOK_DATA_BITS, "data_bits", "Serial data bits",
"Serial port data bits",
"8", RIG_CONF_NUMERIC, { .n = { 5, 8, 1 } }
},
{
TOK_STOP_BITS, "stop_bits", "Serial stop bits",
"Serial port stop bits",
"1", RIG_CONF_NUMERIC, { .n = { 0, 3, 1 } }
},
{
TOK_PARITY, "serial_parity", "Serial parity",
"Serial port parity",
"None", RIG_CONF_COMBO, { .c = {{ "None", "Odd", "Even", "Mark", "Space", NULL }} }
},
{
TOK_HANDSHAKE, "serial_handshake", "Serial handshake",
"Serial port handshake",
"None", RIG_CONF_COMBO, { .c = {{ "None", "XONXOFF", "Hardware", NULL }} }
},
{ RIG_CONF_END, NULL, }
{ RIG_CONF_END, NULL, }
};
/**
* \brief Set rotator state info from alpha input
* \param rot
@ -124,105 +140,148 @@ static const struct confparams rotfrontend_serial_cfg_params[] = {
*/
int frontrot_set_conf(ROT *rot, token_t token, const char *val)
{
struct rot_state *rs;
int val_i;
struct rot_state *rs;
int val_i;
rs = &rot->state;
rs = &rot->state;
switch(token) {
case TOK_PATHNAME:
strncpy(rs->rotport.pathname, val, FILPATHLEN-1);
break;
case TOK_WRITE_DELAY:
if (1 != sscanf(val, "%d", &val_i))
return -RIG_EINVAL;
rs->rotport.write_delay = val_i;
break;
case TOK_POST_WRITE_DELAY:
if (1 != sscanf(val, "%d", &val_i))
return -RIG_EINVAL;
rs->rotport.post_write_delay = val_i;
break;
case TOK_TIMEOUT:
if (1 != sscanf(val, "%d", &val_i))
return -RIG_EINVAL;
rs->rotport.timeout = val_i;
break;
case TOK_RETRY:
if (1 != sscanf(val, "%d", &val_i))
return -RIG_EINVAL;
rs->rotport.retry = val_i;
break;
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
case TOK_SERIAL_SPEED:
if (rs->rotport.type.rig != RIG_PORT_SERIAL)
return -RIG_EINVAL;
if (1 != sscanf(val, "%d", &val_i))
return -RIG_EINVAL;
rs->rotport.parm.serial.rate = val_i;
break;
case TOK_DATA_BITS:
if (rs->rotport.type.rig != RIG_PORT_SERIAL)
return -RIG_EINVAL;
if (1 != sscanf(val, "%d", &val_i))
return -RIG_EINVAL;
rs->rotport.parm.serial.data_bits = val_i;
break;
case TOK_STOP_BITS:
if (rs->rotport.type.rig != RIG_PORT_SERIAL)
return -RIG_EINVAL;
if (1 != sscanf(val, "%d", &val_i))
return -RIG_EINVAL;
rs->rotport.parm.serial.stop_bits = val_i;
break;
case TOK_PARITY:
if (rs->rotport.type.rig != RIG_PORT_SERIAL)
return -RIG_EINVAL;
if (!strcmp(val, "None"))
rs->rotport.parm.serial.parity = RIG_PARITY_NONE;
else if (!strcmp(val, "Odd"))
rs->rotport.parm.serial.parity = RIG_PARITY_ODD;
else if (!strcmp(val, "Even"))
rs->rotport.parm.serial.parity = RIG_PARITY_EVEN;
else if (!strcmp(val, "Mark"))
rs->rotport.parm.serial.parity = RIG_PARITY_MARK;
else if (!strcmp(val, "Space"))
rs->rotport.parm.serial.parity = RIG_PARITY_SPACE;
else
return -RIG_EINVAL;
break;
case TOK_HANDSHAKE:
if (rs->rotport.type.rig != RIG_PORT_SERIAL)
return -RIG_EINVAL;
if (!strcmp(val, "None"))
rs->rotport.parm.serial.handshake = RIG_HANDSHAKE_NONE;
else if (!strcmp(val, "XONXOFF"))
rs->rotport.parm.serial.handshake = RIG_HANDSHAKE_XONXOFF;
else if (!strcmp(val, "Hardware"))
rs->rotport.parm.serial.handshake = RIG_HANDSHAKE_HARDWARE;
else
return -RIG_EINVAL;
break;
switch (token) {
case TOK_PATHNAME:
strncpy(rs->rotport.pathname, val, FILPATHLEN - 1);
break;
case TOK_MIN_AZ:
rs->min_az = atof(val);
break;
case TOK_MAX_AZ:
rs->max_az = atof(val);
break;
case TOK_MIN_EL:
rs->min_el = atof(val);
break;
case TOK_MAX_EL:
rs->max_el = atof(val);
break;
case TOK_WRITE_DELAY:
if (1 != sscanf(val, "%d", &val_i)) {
return -RIG_EINVAL;
}
default:
return -RIG_EINVAL;
}
return RIG_OK;
rs->rotport.write_delay = val_i;
break;
case TOK_POST_WRITE_DELAY:
if (1 != sscanf(val, "%d", &val_i)) {
return -RIG_EINVAL;
}
rs->rotport.post_write_delay = val_i;
break;
case TOK_TIMEOUT:
if (1 != sscanf(val, "%d", &val_i)) {
return -RIG_EINVAL;
}
rs->rotport.timeout = val_i;
break;
case TOK_RETRY:
if (1 != sscanf(val, "%d", &val_i)) {
return -RIG_EINVAL;
}
rs->rotport.retry = val_i;
break;
case TOK_SERIAL_SPEED:
if (rs->rotport.type.rig != RIG_PORT_SERIAL) {
return -RIG_EINVAL;
}
if (1 != sscanf(val, "%d", &val_i)) {
return -RIG_EINVAL;
}
rs->rotport.parm.serial.rate = val_i;
break;
case TOK_DATA_BITS:
if (rs->rotport.type.rig != RIG_PORT_SERIAL) {
return -RIG_EINVAL;
}
if (1 != sscanf(val, "%d", &val_i)) {
return -RIG_EINVAL;
}
rs->rotport.parm.serial.data_bits = val_i;
break;
case TOK_STOP_BITS:
if (rs->rotport.type.rig != RIG_PORT_SERIAL) {
return -RIG_EINVAL;
}
if (1 != sscanf(val, "%d", &val_i)) {
return -RIG_EINVAL;
}
rs->rotport.parm.serial.stop_bits = val_i;
break;
case TOK_PARITY:
if (rs->rotport.type.rig != RIG_PORT_SERIAL) {
return -RIG_EINVAL;
}
if (!strcmp(val, "None")) {
rs->rotport.parm.serial.parity = RIG_PARITY_NONE;
} else if (!strcmp(val, "Odd")) {
rs->rotport.parm.serial.parity = RIG_PARITY_ODD;
} else if (!strcmp(val, "Even")) {
rs->rotport.parm.serial.parity = RIG_PARITY_EVEN;
} else if (!strcmp(val, "Mark")) {
rs->rotport.parm.serial.parity = RIG_PARITY_MARK;
} else if (!strcmp(val, "Space")) {
rs->rotport.parm.serial.parity = RIG_PARITY_SPACE;
} else {
return -RIG_EINVAL;
}
break;
case TOK_HANDSHAKE:
if (rs->rotport.type.rig != RIG_PORT_SERIAL) {
return -RIG_EINVAL;
}
if (!strcmp(val, "None")) {
rs->rotport.parm.serial.handshake = RIG_HANDSHAKE_NONE;
} else if (!strcmp(val, "XONXOFF")) {
rs->rotport.parm.serial.handshake = RIG_HANDSHAKE_XONXOFF;
} else if (!strcmp(val, "Hardware")) {
rs->rotport.parm.serial.handshake = RIG_HANDSHAKE_HARDWARE;
} else {
return -RIG_EINVAL;
}
break;
case TOK_MIN_AZ:
rs->min_az = atof(val);
break;
case TOK_MAX_AZ:
rs->max_az = atof(val);
break;
case TOK_MIN_EL:
rs->min_el = atof(val);
break;
case TOK_MAX_EL:
rs->max_el = atof(val);
break;
default:
return -RIG_EINVAL;
}
return RIG_OK;
}
/**
* \brief Get data from rotator state in alpha form
* \param rot non-null
@ -232,84 +291,140 @@ int frontrot_set_conf(ROT *rot, token_t token, const char *val)
*/
int frontrot_get_conf(ROT *rot, token_t token, char *val)
{
struct rot_state *rs;
const char *s;
struct rot_state *rs;
const char *s;
rs = &rot->state;
rs = &rot->state;
switch(token) {
case TOK_PATHNAME:
strcpy(val, rs->rotport.pathname);
break;
case TOK_WRITE_DELAY:
sprintf(val, "%d", rs->rotport.write_delay);
break;
case TOK_POST_WRITE_DELAY:
sprintf(val, "%d", rs->rotport.post_write_delay);
break;
case TOK_TIMEOUT:
sprintf(val, "%d", rs->rotport.timeout);
break;
case TOK_RETRY:
sprintf(val, "%d", rs->rotport.retry);
break;
case TOK_SERIAL_SPEED:
if (rs->rotport.type.rig != RIG_PORT_SERIAL)
return -RIG_EINVAL;
sprintf(val, "%d", rs->rotport.parm.serial.rate);
break;
case TOK_DATA_BITS:
if (rs->rotport.type.rig != RIG_PORT_SERIAL)
return -RIG_EINVAL;
sprintf(val, "%d", rs->rotport.parm.serial.data_bits);
break;
case TOK_STOP_BITS:
if (rs->rotport.type.rig != RIG_PORT_SERIAL)
return -RIG_EINVAL;
sprintf(val, "%d", rs->rotport.parm.serial.stop_bits);
break;
case TOK_PARITY:
if (rs->rotport.type.rig != RIG_PORT_SERIAL)
return -RIG_EINVAL;
switch (rs->rotport.parm.serial.parity) {
case RIG_PARITY_NONE: s = "None"; break;
case RIG_PARITY_ODD: s = "Odd"; break;
case RIG_PARITY_EVEN: s = "Even"; break;
case RIG_PARITY_MARK: s = "Mark"; break;
case RIG_PARITY_SPACE: s = "Space"; break;
default: return -RIG_EINVAL;
}
strcpy(val, s);
break;
case TOK_HANDSHAKE:
if (rs->rotport.type.rig != RIG_PORT_SERIAL)
return -RIG_EINVAL;
switch (rs->rotport.parm.serial.handshake) {
case RIG_HANDSHAKE_NONE: s = "None"; break;
case RIG_HANDSHAKE_XONXOFF: s = "XONXOFF"; break;
case RIG_HANDSHAKE_HARDWARE: s = "Hardware"; break;
default: return -RIG_EINVAL;
}
strcpy(val, s);
break;
case TOK_MIN_AZ:
sprintf(val, "%f", rs->min_az);
break;
case TOK_MAX_AZ:
sprintf(val, "%f", rs->max_az);
break;
case TOK_MIN_EL:
sprintf(val, "%f", rs->min_el);
break;
case TOK_MAX_EL:
sprintf(val, "%f", rs->max_el);
break;
default:
return -RIG_EINVAL;
}
return RIG_OK;
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
switch (token) {
case TOK_PATHNAME:
strcpy(val, rs->rotport.pathname);
break;
case TOK_WRITE_DELAY:
sprintf(val, "%d", rs->rotport.write_delay);
break;
case TOK_POST_WRITE_DELAY:
sprintf(val, "%d", rs->rotport.post_write_delay);
break;
case TOK_TIMEOUT:
sprintf(val, "%d", rs->rotport.timeout);
break;
case TOK_RETRY:
sprintf(val, "%d", rs->rotport.retry);
break;
case TOK_SERIAL_SPEED:
if (rs->rotport.type.rig != RIG_PORT_SERIAL) {
return -RIG_EINVAL;
}
sprintf(val, "%d", rs->rotport.parm.serial.rate);
break;
case TOK_DATA_BITS:
if (rs->rotport.type.rig != RIG_PORT_SERIAL) {
return -RIG_EINVAL;
}
sprintf(val, "%d", rs->rotport.parm.serial.data_bits);
break;
case TOK_STOP_BITS:
if (rs->rotport.type.rig != RIG_PORT_SERIAL) {
return -RIG_EINVAL;
}
sprintf(val, "%d", rs->rotport.parm.serial.stop_bits);
break;
case TOK_PARITY:
if (rs->rotport.type.rig != RIG_PORT_SERIAL) {
return -RIG_EINVAL;
}
switch (rs->rotport.parm.serial.parity) {
case RIG_PARITY_NONE:
s = "None";
break;
case RIG_PARITY_ODD:
s = "Odd";
break;
case RIG_PARITY_EVEN:
s = "Even";
break;
case RIG_PARITY_MARK:
s = "Mark";
break;
case RIG_PARITY_SPACE:
s = "Space";
break;
default:
return -RIG_EINVAL;
}
strcpy(val, s);
break;
case TOK_HANDSHAKE:
if (rs->rotport.type.rig != RIG_PORT_SERIAL) {
return -RIG_EINVAL;
}
switch (rs->rotport.parm.serial.handshake) {
case RIG_HANDSHAKE_NONE:
s = "None";
break;
case RIG_HANDSHAKE_XONXOFF:
s = "XONXOFF";
break;
case RIG_HANDSHAKE_HARDWARE:
s = "Hardware";
break;
default:
return -RIG_EINVAL;
}
strcpy(val, s);
break;
case TOK_MIN_AZ:
sprintf(val, "%f", rs->min_az);
break;
case TOK_MAX_AZ:
sprintf(val, "%f", rs->max_az);
break;
case TOK_MIN_EL:
sprintf(val, "%f", rs->min_el);
break;
case TOK_MAX_EL:
sprintf(val, "%f", rs->max_el);
break;
default:
return -RIG_EINVAL;
}
return RIG_OK;
}
/**
* \brief Executes cfunc on all the elements stored in the conf table
* \param rot non-null
@ -318,28 +433,39 @@ int frontrot_get_conf(ROT *rot, token_t token, char *val)
*
* start first with backend conf table, then finish with frontend table
*/
int HAMLIB_API rot_token_foreach(ROT *rot, int (*cfunc)(const struct confparams *, rig_ptr_t), rig_ptr_t data)
int HAMLIB_API rot_token_foreach(ROT *rot,
int (*cfunc)(const struct confparams *, rig_ptr_t),
rig_ptr_t data)
{
const struct confparams *cfp;
const struct confparams *cfp;
if (!rot || !rot->caps || !cfunc)
return -RIG_EINVAL;
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
for (cfp = rotfrontend_cfg_params; cfp->name; cfp++)
if ((*cfunc)(cfp, data) == 0)
return RIG_OK;
if (!rot || !rot->caps || !cfunc) {
return -RIG_EINVAL;
}
if (rot->caps->port_type == RIG_PORT_SERIAL) {
for (cfp = rotfrontend_serial_cfg_params; cfp->name; cfp++)
if ((*cfunc)(cfp, data) == 0)
return RIG_OK;
}
for (cfp = rotfrontend_cfg_params; cfp->name; cfp++) {
if ((*cfunc)(cfp, data) == 0) {
return RIG_OK;
}
}
for (cfp = rot->caps->cfgparams; cfp && cfp->name; cfp++)
if ((*cfunc)(cfp, data) == 0)
return RIG_OK;
if (rot->caps->port_type == RIG_PORT_SERIAL) {
for (cfp = rotfrontend_serial_cfg_params; cfp->name; cfp++) {
if ((*cfunc)(cfp, data) == 0) {
return RIG_OK;
}
}
}
return RIG_OK;
for (cfp = rot->caps->cfgparams; cfp && cfp->name; cfp++) {
if ((*cfunc)(cfp, data) == 0) {
return RIG_OK;
}
}
return RIG_OK;
}
@ -352,31 +478,45 @@ int HAMLIB_API rot_token_foreach(ROT *rot, int (*cfunc)(const struct confparams
* lookup backend config table first, then fall back to frontend.
* TODO: should use Lex to speed it up, strcmp hurts!
*/
const struct confparams * HAMLIB_API rot_confparam_lookup(ROT *rot, const char *name)
const struct confparams * HAMLIB_API rot_confparam_lookup(ROT *rot,
const char *name)
{
const struct confparams *cfp;
token_t token;
const struct confparams *cfp;
token_t token;
if (!rot || !rot->caps)
return NULL;
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
/* 0 returned for invalid format */
token = strtol(name, NULL, 0);
if (!rot || !rot->caps) {
return NULL;
}
for (cfp = rot->caps->cfgparams; cfp && cfp->name; cfp++)
if (!strcmp(cfp->name, name) || token == cfp->token)
return cfp;
for (cfp = rotfrontend_cfg_params; cfp->name; cfp++)
if (!strcmp(cfp->name, name) || token == cfp->token)
return cfp;
if (rot->caps->port_type == RIG_PORT_SERIAL) {
for (cfp = rotfrontend_serial_cfg_params; cfp->name; cfp++)
if (!strcmp(cfp->name, name) || token == cfp->token)
return cfp;
}
return NULL;
/* 0 returned for invalid format */
token = strtol(name, NULL, 0);
for (cfp = rot->caps->cfgparams; cfp && cfp->name; cfp++) {
if (!strcmp(cfp->name, name) || token == cfp->token) {
return cfp;
}
}
for (cfp = rotfrontend_cfg_params; cfp->name; cfp++) {
if (!strcmp(cfp->name, name) || token == cfp->token) {
return cfp;
}
}
if (rot->caps->port_type == RIG_PORT_SERIAL) {
for (cfp = rotfrontend_serial_cfg_params; cfp->name; cfp++) {
if (!strcmp(cfp->name, name) || token == cfp->token) {
return cfp;
}
}
}
return NULL;
}
/**
* \brief Simple lookup returning token id associated with name
* \param rot
@ -385,20 +525,25 @@ const struct confparams * HAMLIB_API rot_confparam_lookup(ROT *rot, const char *
*/
token_t HAMLIB_API rot_token_lookup(ROT *rot, const char *name)
{
const struct confparams *cfp;
const struct confparams *cfp;
cfp = rot_confparam_lookup(rot, name);
if (!cfp)
return RIG_CONF_END;
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
return cfp->token;
cfp = rot_confparam_lookup(rot, name);
if (!cfp) {
return RIG_CONF_END;
}
return cfp->token;
}
/**
* \brief set a rotator configuration parameter
* \param rot The rot handle
* \param token The parameter
* \param val The value to set the parameter to
* \param rot The rot handle
* \param token The parameter
* \param val The value to set the parameter to
*
* Sets a configuration parameter.
*
@ -410,33 +555,42 @@ token_t HAMLIB_API rot_token_lookup(ROT *rot, const char *name)
*/
int HAMLIB_API rot_set_conf(ROT *rot, token_t token, const char *val)
{
if (!rot || !rot->caps)
return -RIG_EINVAL;
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
if (rig_need_debug(RIG_DEBUG_VERBOSE)) {
const struct confparams *cfp;
char tokenstr[12];
sprintf(tokenstr, "%ld", token);
cfp = rot_confparam_lookup(rot, tokenstr);
if (!cfp)
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s: %s='%s'\n", __func__, cfp->name, val);
}
if (!rot || !rot->caps) {
return -RIG_EINVAL;
}
if (IS_TOKEN_FRONTEND(token))
return frontrot_set_conf(rot, token, val);
if (rig_need_debug(RIG_DEBUG_VERBOSE)) {
const struct confparams *cfp;
char tokenstr[12];
sprintf(tokenstr, "%ld", token);
cfp = rot_confparam_lookup(rot, tokenstr);
if (rot->caps->set_conf == NULL)
return -RIG_ENAVAIL;
if (!cfp) {
return -RIG_EINVAL;
}
return rot->caps->set_conf(rot, token, val);
rot_debug(RIG_DEBUG_VERBOSE, "%s: %s='%s'\n", __func__, cfp->name, val);
}
if (IS_TOKEN_FRONTEND(token)) {
return frontrot_set_conf(rot, token, val);
}
if (rot->caps->set_conf == NULL) {
return -RIG_ENAVAIL;
}
return rot->caps->set_conf(rot, token, val);
}
/**
* \brief get the value of a configuration parameter
* \param rot The rot handle
* \param token The parameter
* \param val The location where to store the value of config \a token
* \param rot The rot handle
* \param token The parameter
* \param val The location where to store the value of config \a token
*
* Retrieves the value of a configuration paramter associated with \a token.
*
@ -448,16 +602,21 @@ int HAMLIB_API rot_set_conf(ROT *rot, token_t token, const char *val)
*/
int HAMLIB_API rot_get_conf(ROT *rot, token_t token, char *val)
{
if (!rot || !rot->caps || !val)
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
if (IS_TOKEN_FRONTEND(token))
return frontrot_get_conf(rot, token, val);
if (!rot || !rot->caps || !val) {
return -RIG_EINVAL;
}
if (rot->caps->get_conf == NULL)
return -RIG_ENAVAIL;
if (IS_TOKEN_FRONTEND(token)) {
return frontrot_get_conf(rot, token, val);
}
return rot->caps->get_conf(rot, token, val);
if (rot->caps->get_conf == NULL) {
return -RIG_ENAVAIL;
}
return rot->caps->get_conf(rot, token, val);
}
/** @} */

328
src/rot_reg.c
Wyświetl plik

@ -48,10 +48,15 @@
#define ROT_BACKEND_MAX 32
#define DEFINE_INITROT_BACKEND(backend) \
int MAKE_VERSIONED_FN(PREFIX_INITROTS, ABI_VERSION, backend(void *be_handle)); \
rig_model_t MAKE_VERSIONED_FN(PREFIX_PROBEROTS, ABI_VERSION, backend(hamlib_port_t *port, rig_probe_func_t cfunc, rig_ptr_t data))
#define DEFINE_INITROT_BACKEND(backend) \
int MAKE_VERSIONED_FN(PREFIX_INITROTS, \
ABI_VERSION, \
backend(void *be_handle)); \
rig_model_t MAKE_VERSIONED_FN(PREFIX_PROBEROTS, \
ABI_VERSION, \
backend(hamlib_port_t *port, \
rig_probe_func_t cfunc, \
rig_ptr_t data))
#define ROT_FUNCNAMA(backend) MAKE_VERSIONED_FN(PREFIX_INITROTS, ABI_VERSION, backend)
#define ROT_FUNCNAMB(backend) MAKE_VERSIONED_FN(PREFIX_PROBEROTS, ABI_VERSION, backend)
@ -77,6 +82,7 @@ DEFINE_INITROT_BACKEND(ether6);
DEFINE_INITROT_BACKEND(cnctrk);
DEFINE_INITROT_BACKEND(prosistel);
/*! \def ROT_BACKEND_LIST
* \brief Static list of rotator models.
*
@ -87,40 +93,37 @@ DEFINE_INITROT_BACKEND(prosistel);
* in this array.
*/
static struct {
int be_num;
const char *be_name;
int (*be_init)(void *);
rot_model_t (*be_probe)(hamlib_port_t *);
} rot_backend_list[ROT_BACKEND_MAX] =
{
{ ROT_DUMMY, ROT_BACKEND_DUMMY, ROT_FUNCNAMA(dummy) },
{ ROT_EASYCOMM, ROT_BACKEND_EASYCOMM, ROT_FUNCNAMA(easycomm) },
{ ROT_FODTRACK, ROT_BACKEND_FODTRACK, ROT_FUNCNAMA(fodtrack) },
{ ROT_ROTOREZ, ROT_BACKEND_ROTOREZ, ROT_FUNCNAMA(rotorez) },
{ ROT_SARTEK, ROT_BACKEND_SARTEK, ROT_FUNCNAMA(sartek) },
{ ROT_GS232A, ROT_BACKEND_GS232A, ROT_FUNCNAMA(gs232a) },
{ ROT_KIT, ROT_BACKEND_KIT, ROT_FUNCNAMA(kit) },
{ ROT_HEATHKIT, ROT_BACKEND_HEATHKIT, ROT_FUNCNAMA(heathkit) },
{ ROT_SPID, ROT_BACKEND_SPID, ROT_FUNCNAMA(spid) },
{ ROT_M2, ROT_BACKEND_M2, ROT_FUNCNAMA(m2) },
{ ROT_ARS, ROT_BACKEND_ARS, ROT_FUNCNAMA(ars) },
{ ROT_AMSAT, ROT_BACKEND_AMSAT, ROT_FUNCNAMA(amsat) },
{ ROT_TS7400, ROT_BACKEND_TS7400, ROT_FUNCNAMA(ts7400) },
{ ROT_CELESTRON, ROT_BACKEND_CELESTRON, ROT_FUNCNAMA(celestron) },
{ ROT_ETHER6, ROT_BACKEND_ETHER6, ROT_FUNCNAMA(ether6) },
{ ROT_CNCTRK, ROT_BACKEND_CNCTRK, ROT_FUNCNAMA(cnctrk) },
{ ROT_PROSISTEL, ROT_BACKEND_PROSISTEL, ROT_FUNCNAMA(prosistel) },
{ 0, NULL }, /* end */
int be_num;
const char *be_name;
int (*be_init)(void *);
rot_model_t (*be_probe)(hamlib_port_t *);
} rot_backend_list[ROT_BACKEND_MAX] = {
{ ROT_DUMMY, ROT_BACKEND_DUMMY, ROT_FUNCNAMA(dummy) },
{ ROT_EASYCOMM, ROT_BACKEND_EASYCOMM, ROT_FUNCNAMA(easycomm) },
{ ROT_FODTRACK, ROT_BACKEND_FODTRACK, ROT_FUNCNAMA(fodtrack) },
{ ROT_ROTOREZ, ROT_BACKEND_ROTOREZ, ROT_FUNCNAMA(rotorez) },
{ ROT_SARTEK, ROT_BACKEND_SARTEK, ROT_FUNCNAMA(sartek) },
{ ROT_GS232A, ROT_BACKEND_GS232A, ROT_FUNCNAMA(gs232a) },
{ ROT_KIT, ROT_BACKEND_KIT, ROT_FUNCNAMA(kit) },
{ ROT_HEATHKIT, ROT_BACKEND_HEATHKIT, ROT_FUNCNAMA(heathkit) },
{ ROT_SPID, ROT_BACKEND_SPID, ROT_FUNCNAMA(spid) },
{ ROT_M2, ROT_BACKEND_M2, ROT_FUNCNAMA(m2) },
{ ROT_ARS, ROT_BACKEND_ARS, ROT_FUNCNAMA(ars) },
{ ROT_AMSAT, ROT_BACKEND_AMSAT, ROT_FUNCNAMA(amsat) },
{ ROT_TS7400, ROT_BACKEND_TS7400, ROT_FUNCNAMA(ts7400) },
{ ROT_CELESTRON, ROT_BACKEND_CELESTRON, ROT_FUNCNAMA(celestron) },
{ ROT_ETHER6, ROT_BACKEND_ETHER6, ROT_FUNCNAMA(ether6) },
{ ROT_CNCTRK, ROT_BACKEND_CNCTRK, ROT_FUNCNAMA(cnctrk) },
{ ROT_PROSISTEL, ROT_BACKEND_PROSISTEL, ROT_FUNCNAMA(prosistel) },
{ 0, NULL }, /* end */
};
// Apparently, no rotator can be probed.
/*
* ROT_BACKEND_LIST is here, please keep it up to data,
* ie. each time you give birth to a new backend
* Also, it should be possible to register "external" backend,
* that is backend that were not known by Hamlib at compile time.
* Maybe, rotlist.h should reserve some numbers for them? --SF
* ROT_BACKEND_LIST is here, please keep it up to date,
* i.e. each time you implement a new backend.
*/
@ -129,69 +132,81 @@ static struct {
* It is chained, and used in a hash table, see below.
*/
struct rot_list {
const struct rot_caps *caps;
struct rot_list *next;
const struct rot_caps *caps;
struct rot_list *next;
};
#define ROTLSTHASHSZ 16
#define HASH_FUNC(a) ((a)%ROTLSTHASHSZ)
/*
* The rot_hash_table is a hash table pointing to a list of next==NULL
* terminated caps.
* terminated caps.
*/
static struct rot_list *rot_hash_table[ROTLSTHASHSZ] = { NULL, };
static int rot_lookup_backend(rot_model_t rot_model);
/*
* Basically, this is a hash insert function that doesn't check for dup!
*/
int HAMLIB_API rot_register(const struct rot_caps *caps)
{
int hval;
struct rot_list *p;
int hval;
struct rot_list *p;
if (!caps)
return -RIG_EINVAL;
if (!caps) {
return -RIG_EINVAL;
}
rot_debug(RIG_DEBUG_VERBOSE, "rot_register (%d)\n",caps->rot_model);
rot_debug(RIG_DEBUG_VERBOSE, "rot_register (%d)\n", caps->rot_model);
#ifndef DONT_WANT_DUP_CHECK
if (rot_get_caps(caps->rot_model)!=NULL)
return -RIG_EINVAL;
if (rot_get_caps(caps->rot_model) != NULL) {
return -RIG_EINVAL;
}
#endif
p = (struct rot_list*)malloc(sizeof(struct rot_list));
if (!p)
return -RIG_ENOMEM;
p = (struct rot_list *)malloc(sizeof(struct rot_list));
hval = HASH_FUNC(caps->rot_model);
p->caps = caps;
// p->handle = NULL;
p->next = rot_hash_table[hval];
rot_hash_table[hval] = p;
if (!p) {
return -RIG_ENOMEM;
}
return RIG_OK;
hval = HASH_FUNC(caps->rot_model);
p->caps = caps;
// p->handle = NULL;
p->next = rot_hash_table[hval];
rot_hash_table[hval] = p;
return RIG_OK;
}
/*
* Get rot capabilities.
* ie. rot_hash_table lookup
* i.e. rot_hash_table lookup
*/
const struct rot_caps * HAMLIB_API rot_get_caps(rot_model_t rot_model)
{
struct rot_list *p;
struct rot_list *p;
for (p = rot_hash_table[HASH_FUNC(rot_model)]; p; p=p->next) {
if (p->caps->rot_model == rot_model)
return p->caps;
}
return NULL; /* sorry, caps not registered! */
for (p = rot_hash_table[HASH_FUNC(rot_model)]; p; p = p->next) {
if (p->caps->rot_model == rot_model) {
return p->caps;
}
}
return NULL; /* sorry, caps not registered! */
}
/*
* lookup for backend index in rot_backend_list table,
* according to BACKEND_NUM
@ -199,16 +214,19 @@ const struct rot_caps * HAMLIB_API rot_get_caps(rot_model_t rot_model)
*/
static int rot_lookup_backend(rot_model_t rot_model)
{
int i;
int i;
for (i=0; i<ROT_BACKEND_MAX && rot_backend_list[i].be_name; i++) {
if (ROT_BACKEND_NUM(rot_model) ==
rot_backend_list[i].be_num)
return i;
}
return -1;
for (i = 0; i < ROT_BACKEND_MAX && rot_backend_list[i].be_name; i++) {
if (ROT_BACKEND_NUM(rot_model) ==
rot_backend_list[i].be_num) {
return i;
}
}
return -1;
}
/*
* rot_check_backend
* check the backend declaring this model has been loaded
@ -217,128 +235,148 @@ static int rot_lookup_backend(rot_model_t rot_model)
*/
int HAMLIB_API rot_check_backend(rot_model_t rot_model)
{
const struct rot_caps *caps;
int be_idx;
int retval;
const struct rot_caps *caps;
int be_idx;
int retval;
/* already loaded ? */
caps = rot_get_caps(rot_model);
if (caps)
return RIG_OK;
/* already loaded ? */
caps = rot_get_caps(rot_model);
be_idx = rot_lookup_backend(rot_model);
if (caps) {
return RIG_OK;
}
/*
* Never heard about this backend family!
*/
if (be_idx == -1) {
rot_debug(RIG_DEBUG_VERBOSE, "rot_check_backend: unsupported "
"backend %d for model %d\n",
ROT_BACKEND_NUM(rot_model), rot_model);
return -RIG_ENAVAIL;
}
be_idx = rot_lookup_backend(rot_model);
retval = rot_load_backend(rot_backend_list[be_idx].be_name);
/*
* Never heard about this backend family!
*/
if (be_idx == -1) {
rot_debug(RIG_DEBUG_VERBOSE,
"%s: unsupported backend %d for model %d\n",
__func__,
ROT_BACKEND_NUM(rot_model), rot_model);
return retval;
return -RIG_ENAVAIL;
}
retval = rot_load_backend(rot_backend_list[be_idx].be_name);
return retval;
}
int HAMLIB_API rot_unregister(rot_model_t rot_model)
{
int hval;
struct rot_list *p,*q;
int hval;
struct rot_list *p, *q;
hval = HASH_FUNC(rot_model);
q = NULL;
for (p = rot_hash_table[hval]; p; p=p->next) {
if (p->caps->rot_model == rot_model) {
if (q == NULL)
rot_hash_table[hval] = p->next;
else
q->next = p->next;
free(p);
return RIG_OK;
}
q = p;
}
return -RIG_EINVAL; /* sorry, caps not registered! */
hval = HASH_FUNC(rot_model);
q = NULL;
for (p = rot_hash_table[hval]; p; p = p->next) {
if (p->caps->rot_model == rot_model) {
if (q == NULL) {
rot_hash_table[hval] = p->next;
} else {
q->next = p->next;
}
free(p);
return RIG_OK;
}
q = p;
}
return -RIG_EINVAL; /* sorry, caps not registered! */
}
/*
* rot_list_foreach
* executes cfunc on all the elements stored in the rot hash list
*/
int HAMLIB_API rot_list_foreach(int (*cfunc)(const struct rot_caps*, rig_ptr_t),rig_ptr_t data)
int HAMLIB_API rot_list_foreach(int (*cfunc)(const struct rot_caps *, rig_ptr_t),
rig_ptr_t data)
{
struct rot_list *p;
int i;
struct rot_list *p;
int i;
if (!cfunc)
return -RIG_EINVAL;
if (!cfunc) {
return -RIG_EINVAL;
}
for (i=0; i<ROTLSTHASHSZ; i++) {
for (p=rot_hash_table[i]; p; p=p->next)
if ((*cfunc)(p->caps,data) == 0)
return RIG_OK;
}
return RIG_OK;
for (i = 0; i < ROTLSTHASHSZ; i++) {
for (p = rot_hash_table[i]; p; p = p->next)
if ((*cfunc)(p->caps, data) == 0) {
return RIG_OK;
}
}
return RIG_OK;
}
/*
* rot_probe_all
* called straight by rot_probe
*/
rot_model_t HAMLIB_API rot_probe_all(hamlib_port_t *p)
{
int i;
rot_model_t rot_model;
int i;
rot_model_t rot_model;
for (i=0; i<ROT_BACKEND_MAX && rot_backend_list[i].be_name; i++) {
if (rot_backend_list[i].be_probe) {
rot_model = (*rot_backend_list[i].be_probe)(p);
if (rot_model != ROT_MODEL_NONE)
return rot_model;
}
}
return ROT_MODEL_NONE;
for (i = 0; i < ROT_BACKEND_MAX && rot_backend_list[i].be_name; i++) {
if (rot_backend_list[i].be_probe) {
rot_model = (*rot_backend_list[i].be_probe)(p);
if (rot_model != ROT_MODEL_NONE) {
return rot_model;
}
}
}
return ROT_MODEL_NONE;
}
int rot_load_all_backends()
{
int i;
int i;
for (i=0; i<ROT_BACKEND_MAX && rot_backend_list[i].be_name; i++) {
rot_load_backend(rot_backend_list[i].be_name);
}
return RIG_OK;
for (i = 0; i < ROT_BACKEND_MAX && rot_backend_list[i].be_name; i++) {
rot_load_backend(rot_backend_list[i].be_name);
}
return RIG_OK;
}
/*
* rot_load_backend
* Dynamically load a rot backend through dlopen mechanism
*/
int HAMLIB_API rot_load_backend(const char *be_name)
{
int status;
int (*be_init)(rig_ptr_t);
int i;
int status;
int (*be_init)(rig_ptr_t);
int i;
for (i=0; i<ROT_BACKEND_MAX && rot_backend_list[i].be_name; i++) {
if (!strcmp(be_name, rot_backend_list[i].be_name)) {
be_init = rot_backend_list[i].be_init;
if( be_init == NULL )
{
printf("Null\n");
return -EINVAL;
}
status = (*be_init)(NULL);
return status;
}
}
for (i = 0; i < ROT_BACKEND_MAX && rot_backend_list[i].be_name; i++) {
if (!strcmp(be_name, rot_backend_list[i].be_name)) {
be_init = rot_backend_list[i].be_init;
return -EINVAL;
if (be_init == NULL) {
printf("Null\n");
return -EINVAL;
}
status = (*be_init)(NULL);
return status;
}
}
return -EINVAL;
}

692
src/rotator.c
Wyświetl plik

@ -54,7 +54,7 @@
#include <fcntl.h>
#include "hamlib/rotator.h"
#include <hamlib/rotator.h>
#include "serial.h"
#include "parallel.h"
#include "usb_port.h"
@ -85,56 +85,66 @@
#define CHECK_ROT_ARG(r) (!(r) || !(r)->caps || !(r)->state.comm_state)
/*
* Data structure to track the opened rot (by rot_open)
*/
struct opened_rot_l {
ROT *rot;
struct opened_rot_l *next;
ROT *rot;
struct opened_rot_l *next;
};
static struct opened_rot_l *opened_rot_list = { NULL };
/*
* track which rot is opened (with rot_open)
* needed at least for transceive mode
*/
static int add_opened_rot(ROT *rot)
{
struct opened_rot_l *p;
p = (struct opened_rot_l *)malloc(sizeof(struct opened_rot_l));
if (!p)
return -RIG_ENOMEM;
p->rot = rot;
p->next = opened_rot_list;
opened_rot_list = p;
return RIG_OK;
struct opened_rot_l *p;
p = (struct opened_rot_l *)malloc(sizeof(struct opened_rot_l));
if (!p) {
return -RIG_ENOMEM;
}
p->rot = rot;
p->next = opened_rot_list;
opened_rot_list = p;
return RIG_OK;
}
static int remove_opened_rot(ROT *rot)
{
struct opened_rot_l *p,*q;
q = NULL;
struct opened_rot_l *p, *q;
q = NULL;
for (p=opened_rot_list; p; p=p->next) {
if (p->rot == rot) {
if (q == NULL) {
opened_rot_list = opened_rot_list->next;
} else {
q->next = p->next;
}
free(p);
return RIG_OK;
}
q = p;
}
return -RIG_EINVAL; /* Not found in list ! */
for (p = opened_rot_list; p; p = p->next) {
if (p->rot == rot) {
if (q == NULL) {
opened_rot_list = opened_rot_list->next;
} else {
q->next = p->next;
}
free(p);
return RIG_OK;
}
q = p;
}
return -RIG_EINVAL; /* Not found in list ! */
}
#endif /* !DOC_HIDDEN */
/**
* \brief execs cfunc() on each opened rot
* \param cfunc The function to be executed on each rot
* \param data Data pointer to be passed to cfunc()
* \param cfunc The function to be executed on each rot
* \param data Data pointer to be passed to cfunc()
*
* Calls cfunc() function for each opened rot.
* The contents of the opened rot table
@ -149,21 +159,25 @@ static int remove_opened_rot(ROT *rot)
*
* \return always RIG_OK.
*/
int foreach_opened_rot(int (*cfunc)(ROT *, rig_ptr_t), rig_ptr_t data)
{
struct opened_rot_l *p;
struct opened_rot_l *p;
for (p=opened_rot_list; p; p=p->next) {
if ((*cfunc)(p->rot,data) == 0)
return RIG_OK;
}
return RIG_OK;
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
for (p = opened_rot_list; p; p = p->next) {
if ((*cfunc)(p->rot, data) == 0) {
return RIG_OK;
}
}
return RIG_OK;
}
/**
* \brief allocate a new #ROT handle
* \param rot_model The rot model for this new handle
* \param rot_model The rot model for this new handle
*
* Allocates a new #ROT handle and initializes the associated data
* for \a rot_model.
@ -173,105 +187,110 @@ int foreach_opened_rot(int (*cfunc)(ROT *, rig_ptr_t), rig_ptr_t data)
*
* \sa rot_cleanup(), rot_open()
*/
ROT * HAMLIB_API rot_init(rot_model_t rot_model)
ROT *HAMLIB_API rot_init(rot_model_t rot_model)
{
ROT *rot;
const struct rot_caps *caps;
struct rot_state *rs;
int retcode;
ROT *rot;
const struct rot_caps *caps;
struct rot_state *rs;
int retcode;
rot_debug(RIG_DEBUG_VERBOSE,"rot:rot_init called \n");
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
rot_check_backend(rot_model);
rot_check_backend(rot_model);
caps = rot_get_caps(rot_model);
if (!caps)
return NULL;
caps = rot_get_caps(rot_model);
/*
* okay, we've found it. Allocate some memory and set it to zeros,
* and especially the initialize the callbacks
*/
rot = calloc(1, sizeof(ROT));
if (rot == NULL) {
/*
* FIXME: how can the caller know it's a memory shortage,
* and not "rot not found" ?
*/
return NULL;
}
if (!caps) {
return NULL;
}
/* caps is const, so we need to tell compiler
that we now what we are doing */
rot->caps = (struct rot_caps *) caps;
/*
* okay, we've found it. Allocate some memory and set it to zeros,
* and especially the initialize the callbacks
*/
rot = calloc(1, sizeof(ROT));
/*
* populate the rot->state
* TODO: read the Preferences here!
*/
if (rot == NULL) {
/*
* FIXME: how can the caller know it's a memory shortage,
* and not "rot not found" ?
*/
return NULL;
}
rs = &rot->state;
/* caps is const, so we need to tell compiler
that we know what we are doing */
rot->caps = (struct rot_caps *) caps;
rs->comm_state = 0;
rs->rotport.type.rig = caps->port_type; /* default from caps */
/*
* populate the rot->state
* TODO: read the Preferences here!
*/
rs = &rot->state;
rs->rotport.write_delay = caps->write_delay;
rs->rotport.post_write_delay = caps->post_write_delay;
rs->rotport.timeout = caps->timeout;
rs->rotport.retry = caps->retry;
rs->comm_state = 0;
rs->rotport.type.rig = caps->port_type; /* default from caps */
switch (caps->port_type) {
case RIG_PORT_SERIAL:
strncpy(rs->rotport.pathname, DEFAULT_SERIAL_PORT, FILPATHLEN - 1);
rs->rotport.parm.serial.rate = caps->serial_rate_max; /* fastest ! */
rs->rotport.parm.serial.data_bits = caps->serial_data_bits;
rs->rotport.parm.serial.stop_bits = caps->serial_stop_bits;
rs->rotport.parm.serial.parity = caps->serial_parity;
rs->rotport.parm.serial.handshake = caps->serial_handshake;
break;
rs->rotport.write_delay = caps->write_delay;
rs->rotport.post_write_delay = caps->post_write_delay;
rs->rotport.timeout = caps->timeout;
rs->rotport.retry = caps->retry;
case RIG_PORT_PARALLEL:
strncpy(rs->rotport.pathname, DEFAULT_PARALLEL_PORT, FILPATHLEN - 1);
break;
switch (caps->port_type) {
case RIG_PORT_SERIAL:
strncpy(rs->rotport.pathname, DEFAULT_SERIAL_PORT, FILPATHLEN - 1);
rs->rotport.parm.serial.rate = caps->serial_rate_max; /* fastest ! */
rs->rotport.parm.serial.data_bits = caps->serial_data_bits;
rs->rotport.parm.serial.stop_bits = caps->serial_stop_bits;
rs->rotport.parm.serial.parity = caps->serial_parity;
rs->rotport.parm.serial.handshake = caps->serial_handshake;
break;
case RIG_PORT_NETWORK:
case RIG_PORT_UDP_NETWORK:
strncpy(rs->rotport.pathname, "127.0.0.1:4533", FILPATHLEN - 1);
break;
case RIG_PORT_PARALLEL:
strncpy(rs->rotport.pathname, DEFAULT_PARALLEL_PORT, FILPATHLEN - 1);
break;
default:
strncpy(rs->rotport.pathname, "", FILPATHLEN - 1);
}
case RIG_PORT_NETWORK:
case RIG_PORT_UDP_NETWORK:
strncpy(rs->rotport.pathname, "127.0.0.1:4533", FILPATHLEN - 1);
break;
rs->min_el = caps->min_el;
rs->max_el = caps->max_el;
rs->min_az = caps->min_az;
rs->max_az = caps->max_az;
default:
strncpy(rs->rotport.pathname, "", FILPATHLEN - 1);
}
rs->rotport.fd = -1;
rs->min_el = caps->min_el;
rs->max_el = caps->max_el;
rs->min_az = caps->min_az;
rs->max_az = caps->max_az;
/*
* let the backend a chance to setup his private data
* This must be done only once defaults are setup,
* so the backend init can override rot_state.
*/
if (caps->rot_init != NULL) {
retcode = caps->rot_init(rot);
if (retcode != RIG_OK) {
rot_debug(RIG_DEBUG_VERBOSE,"rot:backend_init failed!\n");
/* cleanup and exit */
free(rot);
return NULL;
}
}
rs->rotport.fd = -1;
return rot;
/*
* let the backend a chance to setup his private data
* This must be done only once defaults are setup,
* so the backend init can override rot_state.
*/
if (caps->rot_init != NULL) {
retcode = caps->rot_init(rot);
if (retcode != RIG_OK) {
rot_debug(RIG_DEBUG_VERBOSE,
"%s: backend_init failed!\n",
__func__);
/* cleanup and exit */
free(rot);
return NULL;
}
}
return rot;
}
/**
* \brief open the communication to the rot
* \param rot The #ROT handle of the rotator to be opened
* \param rot The #ROT handle of the rotator to be opened
*
* Opens communication to a rotator which \a ROT handle has been passed
* by argument.
@ -280,95 +299,113 @@ ROT * HAMLIB_API rot_init(rot_model_t rot_model)
* a negative value if an error occured (in which case, cause is
* set appropriately).
*
* \retval RIG_EINVAL \a rot is NULL or unconsistent.
* \retval RIG_ENIMPL port type communication is not implemented yet.
* \retval RIG_EINVAL \a rot is NULL or unconsistent.
* \retval RIG_ENIMPL port type communication is not implemented yet.
*
* \sa rot_init(), rot_close()
*/
int HAMLIB_API rot_open(ROT *rot)
{
const struct rot_caps *caps;
struct rot_state *rs;
int status;
const struct rot_caps *caps;
struct rot_state *rs;
int status;
rot_debug(RIG_DEBUG_VERBOSE,"rot:rot_open called \n");
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
if (!rot || !rot->caps)
return -RIG_EINVAL;
if (!rot || !rot->caps) {
return -RIG_EINVAL;
}
caps = rot->caps;
rs = &rot->state;
caps = rot->caps;
rs = &rot->state;
if (rs->comm_state)
return -RIG_EINVAL;
if (rs->comm_state) {
return -RIG_EINVAL;
}
rs->rotport.fd = -1;
rs->rotport.fd = -1;
switch(rs->rotport.type.rig) {
case RIG_PORT_SERIAL:
status = serial_open(&rs->rotport);
if (status != 0)
return status;
break;
switch (rs->rotport.type.rig) {
case RIG_PORT_SERIAL:
status = serial_open(&rs->rotport);
case RIG_PORT_PARALLEL:
status = par_open(&rs->rotport);
if (status < 0)
return status;
break;
if (status != 0) {
return status;
}
case RIG_PORT_DEVICE:
status = open(rs->rotport.pathname, O_RDWR, 0);
if (status < 0)
return -RIG_EIO;
rs->rotport.fd = status;
break;
break;
case RIG_PORT_USB:
status = usb_port_open(&rs->rotport);
if (status < 0)
return status;
break;
case RIG_PORT_PARALLEL:
status = par_open(&rs->rotport);
case RIG_PORT_NONE:
case RIG_PORT_RPC:
break; /* ez :) */
if (status < 0) {
return status;
}
case RIG_PORT_NETWORK:
case RIG_PORT_UDP_NETWORK:
break;
case RIG_PORT_DEVICE:
status = open(rs->rotport.pathname, O_RDWR, 0);
if (status < 0) {
return -RIG_EIO;
}
rs->rotport.fd = status;
break;
case RIG_PORT_USB:
status = usb_port_open(&rs->rotport);
if (status < 0) {
return status;
}
break;
case RIG_PORT_NONE:
case RIG_PORT_RPC:
break; /* ez :) */
case RIG_PORT_NETWORK:
case RIG_PORT_UDP_NETWORK:
/* FIXME: default port */
status = network_open(&rs->rotport, 4533);
if (status < 0)
return status;
break;
status = network_open(&rs->rotport, 4533);
default:
return -RIG_EINVAL;
}
if (status < 0) {
return status;
}
break;
default:
return -RIG_EINVAL;
}
add_opened_rot(rot);
add_opened_rot(rot);
rs->comm_state = 1;
rs->comm_state = 1;
/*
* Maybe the backend has something to initialize
* In case of failure, just close down and report error code.
*/
if (caps->rot_open != NULL) {
status = caps->rot_open(rot);
if (status != RIG_OK) {
return status;
}
}
/*
* Maybe the backend has something to initialize
* In case of failure, just close down and report error code.
*/
if (caps->rot_open != NULL) {
status = caps->rot_open(rot);
return RIG_OK;
if (status != RIG_OK) {
return status;
}
}
return RIG_OK;
}
/**
* \brief close the communication to the rot
* \param rot The #ROT handle of the rotator to be closed
* \param rot The #ROT handle of the rotator to be closed
*
* Closes communication to a rotator which \a ROT handle has been passed
* by argument that was previously open with rot_open().
@ -379,62 +416,70 @@ int HAMLIB_API rot_open(ROT *rot)
*
* \sa rot_cleanup(), rot_open()
*/
int HAMLIB_API rot_close(ROT *rot)
{
const struct rot_caps *caps;
struct rot_state *rs;
const struct rot_caps *caps;
struct rot_state *rs;
rot_debug(RIG_DEBUG_VERBOSE,"rot:rot_close called \n");
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
if (!rot || !rot->caps)
return -RIG_EINVAL;
if (!rot || !rot->caps) {
return -RIG_EINVAL;
}
caps = rot->caps;
rs = &rot->state;
caps = rot->caps;
rs = &rot->state;
if (!rs->comm_state)
return -RIG_EINVAL;
if (!rs->comm_state) {
return -RIG_EINVAL;
}
/*
* Let the backend say 73s to the rot.
* and ignore the return code.
*/
if (caps->rot_close)
caps->rot_close(rot);
/*
* Let the backend say 73s to the rot.
* and ignore the return code.
*/
if (caps->rot_close) {
caps->rot_close(rot);
}
if (rs->rotport.fd != -1) {
switch(rs->rotport.type.rig) {
case RIG_PORT_SERIAL:
ser_close(&rs->rotport);
break;
case RIG_PORT_PARALLEL:
par_close(&rs->rotport);
break;
case RIG_PORT_USB:
usb_port_close(&rs->rotport);
break;
case RIG_PORT_NETWORK:
case RIG_PORT_UDP_NETWORK:
network_close(&rs->rotport);
break;
default:
close(rs->rotport.fd);
}
rs->rotport.fd = -1;
}
if (rs->rotport.fd != -1) {
switch (rs->rotport.type.rig) {
case RIG_PORT_SERIAL:
ser_close(&rs->rotport);
break;
remove_opened_rot(rot);
case RIG_PORT_PARALLEL:
par_close(&rs->rotport);
break;
rs->comm_state = 0;
case RIG_PORT_USB:
usb_port_close(&rs->rotport);
break;
return RIG_OK;
case RIG_PORT_NETWORK:
case RIG_PORT_UDP_NETWORK:
network_close(&rs->rotport);
break;
default:
close(rs->rotport.fd);
}
rs->rotport.fd = -1;
}
remove_opened_rot(rot);
rs->comm_state = 0;
return RIG_OK;
}
/**
* \brief release a rot handle and free associated memory
* \param rot The #ROT handle of the radio to be closed
* \param rot The #ROT handle of the radio to be closed
*
* Releases a rot struct which port has eventualy been closed already
* with rot_close().
@ -445,36 +490,39 @@ int HAMLIB_API rot_close(ROT *rot)
*
* \sa rot_init(), rot_close()
*/
int HAMLIB_API rot_cleanup(ROT *rot)
{
rot_debug(RIG_DEBUG_VERBOSE,"rot:rot_cleanup called \n");
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
if (!rot || !rot->caps)
return -RIG_EINVAL;
if (!rot || !rot->caps) {
return -RIG_EINVAL;
}
/*
* check if they forgot to close the rot
*/
if (rot->state.comm_state)
rot_close(rot);
/*
* check if they forgot to close the rot
*/
if (rot->state.comm_state) {
rot_close(rot);
}
/*
* basically free up the priv struct
*/
if (rot->caps->rot_cleanup)
rot->caps->rot_cleanup(rot);
/*
* basically free up the priv struct
*/
if (rot->caps->rot_cleanup) {
rot->caps->rot_cleanup(rot);
}
free(rot);
free(rot);
return RIG_OK;
return RIG_OK;
}
/**
* \brief set the azimuth and elevation of the rotator
* \param rot The rot handle
* \param azimuth The azimuth to set to
* \param elevation The elevation to set to
* \param rot The rot handle
* \param azimuth The azimuth to set to
* \param elevation The elevation to set to
*
* Sets the azimuth and elevation of the rotator.
*
@ -484,33 +532,41 @@ int HAMLIB_API rot_cleanup(ROT *rot)
*
* \sa rot_get_position()
*/
int HAMLIB_API rot_set_position (ROT *rot, azimuth_t azimuth, elevation_t elevation)
int HAMLIB_API rot_set_position(ROT *rot, azimuth_t azimuth,
elevation_t elevation)
{
const struct rot_caps *caps;
const struct rot_state *rs;
const struct rot_caps *caps;
const struct rot_state *rs;
if (CHECK_ROT_ARG(rot))
return -RIG_EINVAL;
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
caps = rot->caps;
rs = &rot->state;
if (CHECK_ROT_ARG(rot)) {
return -RIG_EINVAL;
}
if (azimuth < rs->min_az || azimuth > rs->max_az ||
elevation < rs->min_el || elevation > rs->max_el)
return -RIG_EINVAL;
caps = rot->caps;
rs = &rot->state;
if (caps->set_position == NULL)
return -RIG_ENAVAIL;
if (azimuth < rs->min_az
|| azimuth > rs->max_az
|| elevation < rs->min_el
|| elevation > rs->max_el) {
return -RIG_EINVAL;
}
return caps->set_position(rot, azimuth, elevation);
if (caps->set_position == NULL) {
return -RIG_ENAVAIL;
}
return caps->set_position(rot, azimuth, elevation);
}
/**
* \brief get the azimuth and elevation of the rotator
* \param rot The rot handle
* \param azimuth The location where to store the current azimuth
* \param elevation The location where to store the current elevation
* \param rot The rot handle
* \param azimuth The location where to store the current azimuth
* \param elevation The location where to store the current elevation
*
* Retrieves the current azimuth and elevation of the rotator.
*
@ -520,25 +576,30 @@ int HAMLIB_API rot_set_position (ROT *rot, azimuth_t azimuth, elevation_t elevat
*
* \sa rot_set_position()
*/
int HAMLIB_API rot_get_position (ROT *rot, azimuth_t *azimuth, elevation_t *elevation)
int HAMLIB_API rot_get_position(ROT *rot, azimuth_t *azimuth,
elevation_t *elevation)
{
const struct rot_caps *caps;
const struct rot_caps *caps;
if (CHECK_ROT_ARG(rot) || !azimuth || !elevation)
return -RIG_EINVAL;
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
caps = rot->caps;
if (CHECK_ROT_ARG(rot) || !azimuth || !elevation) {
return -RIG_EINVAL;
}
if (caps->get_position == NULL)
return -RIG_ENAVAIL;
caps = rot->caps;
return caps->get_position(rot, azimuth, elevation);
if (caps->get_position == NULL) {
return -RIG_ENAVAIL;
}
return caps->get_position(rot, azimuth, elevation);
}
/**
* \brief park the antenna
* \param rot The rot handle
* \param rot The rot handle
*
* Park the antenna.
*
@ -547,25 +608,29 @@ int HAMLIB_API rot_get_position (ROT *rot, azimuth_t *azimuth, elevation_t *elev
* set appropriately).
*
*/
int HAMLIB_API rot_park (ROT *rot)
int HAMLIB_API rot_park(ROT *rot)
{
const struct rot_caps *caps;
const struct rot_caps *caps;
if (CHECK_ROT_ARG(rot))
return -RIG_EINVAL;
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
caps = rot->caps;
if (CHECK_ROT_ARG(rot)) {
return -RIG_EINVAL;
}
if (caps->park == NULL)
return -RIG_ENAVAIL;
caps = rot->caps;
return caps->park(rot);
if (caps->park == NULL) {
return -RIG_ENAVAIL;
}
return caps->park(rot);
}
/**
* \brief stop the rotator
* \param rot The rot handle
* \param rot The rot handle
*
* Stop the rotator.
*
@ -574,25 +639,29 @@ int HAMLIB_API rot_park (ROT *rot)
* set appropriately).
*
*/
int HAMLIB_API rot_stop (ROT *rot)
int HAMLIB_API rot_stop(ROT *rot)
{
const struct rot_caps *caps;
const struct rot_caps *caps;
if (CHECK_ROT_ARG(rot))
return -RIG_EINVAL;
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
caps = rot->caps;
if (CHECK_ROT_ARG(rot)) {
return -RIG_EINVAL;
}
if (caps->stop == NULL)
return -RIG_ENAVAIL;
caps = rot->caps;
return caps->stop(rot);
if (caps->stop == NULL) {
return -RIG_ENAVAIL;
}
return caps->stop(rot);
}
/**
* \brief reset the rotator
* \param rot The rot handle
* \param rot The rot handle
* \param reset The reset operation to perform
*
* Resets the rotator.
@ -602,22 +671,26 @@ int HAMLIB_API rot_stop (ROT *rot)
* set appropriately).
*
*/
int HAMLIB_API rot_reset (ROT *rot, rot_reset_t reset)
int HAMLIB_API rot_reset(ROT *rot, rot_reset_t reset)
{
const struct rot_caps *caps;
const struct rot_caps *caps;
if (CHECK_ROT_ARG(rot))
return -RIG_EINVAL;
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
caps = rot->caps;
if (CHECK_ROT_ARG(rot)) {
return -RIG_EINVAL;
}
if (caps->reset == NULL)
return -RIG_ENAVAIL;
caps = rot->caps;
return caps->reset(rot, reset);
if (caps->reset == NULL) {
return -RIG_ENAVAIL;
}
return caps->reset(rot, reset);
}
/**
* \brief move the rotator in the specified direction
* \param rot The rot handle
@ -627,24 +700,29 @@ int HAMLIB_API rot_reset (ROT *rot, rot_reset_t reset)
* Move the rotator in the specified direction. The speed is a value
* between 1 and 100.
*/
int HAMLIB_API rot_move (ROT *rot, int direction, int speed)
int HAMLIB_API rot_move(ROT *rot, int direction, int speed)
{
const struct rot_caps *caps;
const struct rot_caps *caps;
if (CHECK_ROT_ARG(rot))
return -RIG_EINVAL;
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
caps = rot->caps;
if (CHECK_ROT_ARG(rot)) {
return -RIG_EINVAL;
}
if (caps->move == NULL)
return -RIG_ENAVAIL;
caps = rot->caps;
return caps->move(rot, direction, speed);
if (caps->move == NULL) {
return -RIG_ENAVAIL;
}
return caps->move(rot, direction, speed);
}
/**
* \brief get general information from the rotator
* \param rot The rot handle
* \param rot The rot handle
*
* Retrieves some general information from the rotator.
* This can include firmware revision, exact model name, or just nothing.
@ -653,15 +731,19 @@ int HAMLIB_API rot_move (ROT *rot, int direction, int speed)
* if the operation has been sucessful, otherwise NULL if an error occured
* or get_info not part of capabilities.
*/
const char* HAMLIB_API rot_get_info(ROT *rot)
const char *HAMLIB_API rot_get_info(ROT *rot)
{
if (CHECK_ROT_ARG(rot))
return NULL;
rot_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
if (rot->caps->get_info == NULL)
return NULL;
if (CHECK_ROT_ARG(rot)) {
return NULL;
}
return rot->caps->get_info(rot);
if (rot->caps->get_info == NULL) {
return NULL;
}
return rot->caps->get_info(rot);
}
/*! @} */

707
src/serial.c
Wyświetl plik

@ -58,7 +58,7 @@
#else
#ifdef HAVE_TERMIO_H
#include <termio.h>
#else /* sgtty */
#else /* sgtty */
#ifdef HAVE_SGTTY_H
#include <sgtty.h>
#endif
@ -67,7 +67,7 @@
#if defined(WIN32) && !defined(HAVE_TERMIOS_H)
#include "win32termios.h"
#define HAVE_TERMIOS_H 1 /* we have replacement */
#define HAVE_TERMIOS_H 1 /* we have replacement */
#else
#define OPEN open
#define CLOSE close
@ -82,44 +82,52 @@
#include <sys/ioccom.h>
#endif
/**
* \brief Open serial port using rig.state data
* \param rp port data structure (must spec port id eg /dev/ttyS1)
* \return RIG_OK or < 0 if error
*/
int HAMLIB_API serial_open(hamlib_port_t *rp) {
int HAMLIB_API serial_open(hamlib_port_t *rp)
{
int fd; /* File descriptor for the port */
int err;
int fd; /* File descriptor for the port */
int err;
if (!rp)
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
/*
* Open in Non-blocking mode. Watch for EAGAIN errors!
*/
fd = OPEN(rp->pathname, O_RDWR | O_NOCTTY | O_NDELAY);
if (!rp) {
return -RIG_EINVAL;
}
if (fd == -1) {
/*
* Open in Non-blocking mode. Watch for EAGAIN errors!
*/
fd = OPEN(rp->pathname, O_RDWR | O_NOCTTY | O_NDELAY);
/* Could not open the port. */
if (fd == -1) {
/* Could not open the port. */
rig_debug(RIG_DEBUG_ERR,
"%s: Unable to open %s - %s\n",
__func__,
rp->pathname,
strerror(errno));
return -RIG_EIO;
}
rig_debug(RIG_DEBUG_ERR, "%s: Unable to open %s - %s\n",
__func__, rp->pathname, strerror(errno));
return -RIG_EIO;
}
rp->fd = fd;
rp->fd = fd;
err = serial_setup(rp);
err = serial_setup(rp);
if (err != RIG_OK) {
CLOSE(fd);
return err;
}
if (err != RIG_OK) {
CLOSE(fd);
return err;
}
return RIG_OK;
return RIG_OK;
}
/**
* \brief Set up Serial port according to requests in port
* \param rp
@ -127,265 +135,308 @@ int HAMLIB_API serial_open(hamlib_port_t *rp) {
*/
int HAMLIB_API serial_setup(hamlib_port_t *rp)
{
int fd;
/* There's a lib replacement for termios under Mingw */
int fd;
/* There's a lib replacement for termios under Mingw */
#if defined(HAVE_TERMIOS_H)
speed_t speed; /* serial comm speed */
struct termios options;
speed_t speed; /* serial comm speed */
struct termios options;
#elif defined(HAVE_TERMIO_H)
struct termio options;
struct termio options;
#elif defined(HAVE_SGTTY_H)
struct sgttyb sg;
struct sgttyb sg;
#else
#error "No term control supported!"
#endif
if (!rp)
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
fd = rp->fd;
if (!rp) {
return -RIG_EINVAL;
}
/*
* Get the current options for the port...
*/
fd = rp->fd;
/*
* Get the current options for the port...
*/
#if defined(HAVE_TERMIOS_H)
tcgetattr(fd, &options);
tcgetattr(fd, &options);
#elif defined(HAVE_TERMIO_H)
IOCTL (fd, TCGETA, &options);
#else /* sgtty */
IOCTL (fd, TIOCGETP, &sg);
IOCTL(fd, TCGETA, &options);
#else /* sgtty */
IOCTL(fd, TIOCGETP, &sg);
#endif
#ifdef HAVE_CFMAKERAW
cfmakeraw(&options); /* Set serial port to RAW mode by default. */
/* Set serial port to RAW mode by default. */
cfmakeraw(&options);
#endif
/*
* Set the baud rates to requested values
*/
/*
* Set the baud rates to requested values
*/
switch (rp->parm.serial.rate) {
case 150:
speed = B150; /* yikes... */
break;
switch(rp->parm.serial.rate) {
case 150:
speed = B150; /* yikes... */
break;
case 300:
speed = B300; /* yikes... */
break;
case 600:
case 300:
speed = B300; /* yikes... */
break;
case 600:
speed = B600;
break;
case 1200:
speed = B1200;
break;
case 2400:
speed = B2400;
break;
case 4800:
speed = B4800;
break;
case 9600:
speed = B9600;
break;
case 19200:
speed = B19200;
break;
case 38400:
speed = B38400;
break;
case 57600:
speed = B57600; /* cool.. */
break;
case 115200:
speed = B115200; /* awsome! */
break;
default:
rig_debug(RIG_DEBUG_ERR, "%s: unsupported rate specified: %d\n",
__func__, rp->parm.serial.rate);
CLOSE(fd);
return -RIG_ECONF;
}
/* TODO */
cfsetispeed(&options, speed);
cfsetospeed(&options, speed);
break;
/*
* Enable the receiver and set local mode...
*/
case 1200:
speed = B1200;
break;
options.c_cflag |= (CLOCAL | CREAD);
case 2400:
speed = B2400;
break;
/*
* close doesn't change modem signals
*/
options.c_cflag &= ~HUPCL;
case 4800:
speed = B4800;
break;
/*
* Set data to requested values.
*
*/
case 9600:
speed = B9600;
break;
switch(rp->parm.serial.data_bits) {
case 7:
options.c_cflag &= ~CSIZE;
options.c_cflag |= CS7;
break;
case 8:
options.c_cflag &= ~CSIZE;
options.c_cflag |= CS8;
break;
default:
rig_debug(RIG_DEBUG_ERR, "%s: unsupported serial_data_bits "
"specified: %d\n", __func__, rp->parm.serial.data_bits);
CLOSE(fd);
return -RIG_ECONF;
break;
}
case 19200:
speed = B19200;
break;
/*
* Set stop bits to requested values.
*
*/
case 38400:
speed = B38400;
break;
switch(rp->parm.serial.stop_bits) {
case 1:
options.c_cflag &= ~CSTOPB;
break;
case 2:
options.c_cflag |= CSTOPB;
break;
case 57600:
speed = B57600; /* cool.. */
break;
default:
rig_debug(RIG_DEBUG_ERR, "%s: unsupported serial_stop_bits "
"specified: %d\n", __func__,
rp->parm.serial.stop_bits);
CLOSE(fd);
return -RIG_ECONF;
break;
}
case 115200:
speed = B115200; /* awesome! */
break;
/*
* Set parity to requested values.
*
*/
default:
rig_debug(RIG_DEBUG_ERR,
"%s: unsupported rate specified: %d\n",
__func__,
rp->parm.serial.rate);
CLOSE(fd);
switch(rp->parm.serial.parity) {
case RIG_PARITY_NONE:
options.c_cflag &= ~PARENB;
break;
case RIG_PARITY_EVEN:
options.c_cflag |= PARENB;
options.c_cflag &= ~PARODD;
break;
case RIG_PARITY_ODD:
options.c_cflag |= PARENB;
options.c_cflag |= PARODD;
break;
/* CMSPAR is not POSIX */
return -RIG_ECONF;
}
/* TODO */
cfsetispeed(&options, speed);
cfsetospeed(&options, speed);
/*
* Enable the receiver and set local mode...
*/
options.c_cflag |= (CLOCAL | CREAD);
/*
* close doesn't change modem signals
*/
options.c_cflag &= ~HUPCL;
/*
* Set data to requested values.
*
*/
switch (rp->parm.serial.data_bits) {
case 7:
options.c_cflag &= ~CSIZE;
options.c_cflag |= CS7;
break;
case 8:
options.c_cflag &= ~CSIZE;
options.c_cflag |= CS8;
break;
default:
rig_debug(RIG_DEBUG_ERR,
"%s: unsupported serial_data_bits specified: %d\n",
__func__,
rp->parm.serial.data_bits);
CLOSE(fd);
return -RIG_ECONF;
break;
}
/*
* Set stop bits to requested values.
*
*/
switch (rp->parm.serial.stop_bits) {
case 1:
options.c_cflag &= ~CSTOPB;
break;
case 2:
options.c_cflag |= CSTOPB;
break;
default:
rig_debug(RIG_DEBUG_ERR,
"%s: unsupported serial_stop_bits specified: %d\n",
__func__,
rp->parm.serial.stop_bits);
CLOSE(fd);
return -RIG_ECONF;
break;
}
/*
* Set parity to requested values.
*
*/
switch (rp->parm.serial.parity) {
case RIG_PARITY_NONE:
options.c_cflag &= ~PARENB;
break;
case RIG_PARITY_EVEN:
options.c_cflag |= PARENB;
options.c_cflag &= ~PARODD;
break;
case RIG_PARITY_ODD:
options.c_cflag |= PARENB;
options.c_cflag |= PARODD;
break;
/* CMSPAR is not POSIX */
#ifdef CMSPAR
case RIG_PARITY_MARK:
options.c_cflag |= PARENB | CMSPAR;
options.c_cflag |= PARODD;
break;
case RIG_PARITY_SPACE:
options.c_cflag |= PARENB | CMSPAR;
options.c_cflag &= ~PARODD;
break;
case RIG_PARITY_MARK:
options.c_cflag |= PARENB | CMSPAR;
options.c_cflag |= PARODD;
break;
case RIG_PARITY_SPACE:
options.c_cflag |= PARENB | CMSPAR;
options.c_cflag &= ~PARODD;
break;
#endif
default:
rig_debug(RIG_DEBUG_ERR, "%s: unsupported serial_parity "
"specified: %d\n", __func__,
rp->parm.serial.parity);
CLOSE(fd);
return -RIG_ECONF;
break;
}
default:
rig_debug(RIG_DEBUG_ERR,
"%s: unsupported serial_parity specified: %d\n",
__func__,
rp->parm.serial.parity);
CLOSE(fd);
return -RIG_ECONF;
break;
}
/*
* Set flow control to requested mode
*
*/
/*
* Set flow control to requested mode
*
*/
switch (rp->parm.serial.handshake) {
case RIG_HANDSHAKE_NONE:
options.c_cflag &= ~CRTSCTS;
options.c_iflag &= ~IXON;
break;
switch(rp->parm.serial.handshake) {
case RIG_HANDSHAKE_NONE:
options.c_cflag &= ~CRTSCTS;
options.c_iflag &= ~IXON;
break;
case RIG_HANDSHAKE_XONXOFF:
options.c_cflag &= ~CRTSCTS;
options.c_iflag |= IXON; /* Enable Xon/Xoff software handshaking */
break;
case RIG_HANDSHAKE_HARDWARE:
options.c_cflag |= CRTSCTS; /* Enable Hardware handshaking */
options.c_iflag &= ~IXON;
break;
default:
rig_debug(RIG_DEBUG_ERR, "%s: unsupported flow_control "
"specified: %d\n", __func__,
rp->parm.serial.handshake);
CLOSE(fd);
return -RIG_ECONF;
break;
}
case RIG_HANDSHAKE_XONXOFF:
options.c_cflag &= ~CRTSCTS;
options.c_iflag |= IXON; /* Enable Xon/Xoff software handshaking */
break;
/*
* Choose raw input, no preprocessing please ..
*/
case RIG_HANDSHAKE_HARDWARE:
options.c_cflag |= CRTSCTS; /* Enable Hardware handshaking */
options.c_iflag &= ~IXON;
break;
default:
rig_debug(RIG_DEBUG_ERR,
"%s: unsupported flow_control specified: %d\n",
__func__,
rp->parm.serial.handshake);
CLOSE(fd);
return -RIG_ECONF;
break;
}
/*
* Choose raw input, no preprocessing please ..
*/
#if defined(HAVE_TERMIOS_H) || defined(HAVE_TERMIO_H)
options.c_lflag &= ~(ICANON | ECHO | ECHOE | ISIG);
options.c_lflag &= ~(ICANON | ECHO | ECHOE | ISIG);
/*
* Choose raw output, no preprocessing please ..
*/
/*
* Choose raw output, no preprocessing please ..
*/
options.c_oflag &= ~OPOST;
options.c_oflag &= ~OPOST;
#else /* sgtty */
sg.sg_flags = RAW;
#else /* sgtty */
sg.sg_flags = RAW;
#endif
/*
* VTIME in deciseconds, rp->timeout in miliseconds
*/
options.c_cc[VTIME] = (rp->timeout + 99) / 100;
options.c_cc[VMIN] = 1;
/*
* VTIME in deciseconds, rp->timeout in miliseconds
*/
options.c_cc[VTIME] = (rp->timeout + 99) / 100;
options.c_cc[VMIN] = 1;
/*
* Flush serial port
*/
tcflush(fd, TCIFLUSH);
/*
* Finally, set the new options for the port...
*/
/*
* Flush serial port
*/
tcflush(fd, TCIFLUSH);
/*
* Finally, set the new options for the port...
*/
#if defined(HAVE_TERMIOS_H)
if (tcsetattr(fd, TCSANOW, &options) == -1) {
rig_debug(RIG_DEBUG_ERR, "%s: tcsetattr failed: %s\n",
__func__, strerror(errno));
CLOSE(fd);
return -RIG_ECONF; /* arg, so close! */
}
if (tcsetattr(fd, TCSANOW, &options) == -1) {
rig_debug(RIG_DEBUG_ERR,
"%s: tcsetattr failed: %s\n",
__func__,
strerror(errno));
CLOSE(fd);
return -RIG_ECONF; /* arg, so close! */
}
#elif defined(HAVE_TERMIO_H)
if (IOCTL(fd, TCSETA, &options) == -1) {
rig_debug(RIG_DEBUG_ERR, "%s: ioctl(TCSETA) failed: %s\n",
__func__, strerror(errno));
CLOSE(fd);
return -RIG_ECONF; /* arg, so close! */
}
#else /* sgtty */
if (IOCTL(fd, TIOCSETP, &sg) == -1) {
rig_debug(RIG_DEBUG_ERR, "%s: ioctl(TIOCSETP) failed: %s\n",
__func__, strerror(errno));
CLOSE(fd);
return -RIG_ECONF; /* arg, so close! */
}
if (IOCTL(fd, TCSETA, &options) == -1) {
rig_debug(RIG_DEBUG_ERR,
"%s: ioctl(TCSETA) failed: %s\n",
__func__,
strerror(errno));
CLOSE(fd);
return -RIG_ECONF; /* arg, so close! */
}
#else
/* sgtty */
if (IOCTL(fd, TIOCSETP, &sg) == -1) {
rig_debug(RIG_DEBUG_ERR,
"%s: ioctl(TIOCSETP) failed: %s\n",
__func__,
strerror(errno));
CLOSE(fd);
return -RIG_ECONF; /* arg, so close! */
}
#endif
return RIG_OK;
return RIG_OK;
}
@ -394,13 +445,16 @@ int HAMLIB_API serial_setup(hamlib_port_t *rp)
* \param p
* \return RIG_OK
*/
int HAMLIB_API serial_flush(hamlib_port_t *p )
int HAMLIB_API serial_flush(hamlib_port_t *p)
{
tcflush(p->fd, TCIFLUSH);
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
return RIG_OK;
tcflush(p->fd, TCIFLUSH);
return RIG_OK;
}
/**
* \brief Open serial port
* \param p
@ -408,9 +462,12 @@ int HAMLIB_API serial_flush(hamlib_port_t *p )
*/
int ser_open(hamlib_port_t *p)
{
return (p->fd = OPEN(p->pathname, O_RDWR | O_NOCTTY | O_NDELAY));
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
return (p->fd = OPEN(p->pathname, O_RDWR | O_NOCTTY | O_NDELAY));
}
/**
* \brief Close serial port
* \param p fd
@ -418,11 +475,14 @@ int ser_open(hamlib_port_t *p)
*/
int ser_close(hamlib_port_t *p)
{
int rc = CLOSE(p->fd);
p->fd = -1;
return rc;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
int rc = CLOSE(p->fd);
p->fd = -1;
return rc;
}
/**
* \brief Set Request to Send (RTS) bit
* \param p
@ -431,32 +491,42 @@ int ser_close(hamlib_port_t *p)
*/
int HAMLIB_API ser_set_rts(hamlib_port_t *p, int state)
{
unsigned int y = TIOCM_RTS;
int rc;
unsigned int y = TIOCM_RTS;
int rc;
rig_debug(RIG_DEBUG_VERBOSE, "%s: RTS=%d\n", __func__, state);
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
rig_debug(RIG_DEBUG_VERBOSE, "%s: RTS=%d\n", __func__, state);
#if defined(TIOCMBIS) && defined(TIOCMBIC)
rc = IOCTL(p->fd, state ? TIOCMBIS : TIOCMBIC, &y);
rc = IOCTL(p->fd, state ? TIOCMBIS : TIOCMBIC, &y);
#else
rc = IOCTL(p->fd, TIOCMGET, &y);
if (rc >= 0)
{
if (state)
y |= TIOCM_RTS;
else
y &= ~TIOCM_RTS;
rc = IOCTL(p->fd, TIOCMSET, &y);
rc = IOCTL(p->fd, TIOCMGET, &y);
if (rc >= 0) {
if (state) {
y |= TIOCM_RTS;
} else {
y &= ~TIOCM_RTS;
}
rc = IOCTL(p->fd, TIOCMSET, &y);
}
#endif
if (rc < 0)
{
rig_debug(RIG_DEBUG_ERR, "%s: Cannot change RTS - %s\n", __func__, strerror(errno));
return -RIG_EIO;
if (rc < 0) {
rig_debug(RIG_DEBUG_ERR,
"%s: Cannot change RTS - %s\n",
__func__,
strerror(errno));
return -RIG_EIO;
}
return RIG_OK;
return RIG_OK;
}
/**
* \brief Get RTS bit
* \param p supposed to be &rig->state.rigport
@ -464,15 +534,18 @@ int HAMLIB_API ser_set_rts(hamlib_port_t *p, int state)
*/
int HAMLIB_API ser_get_rts(hamlib_port_t *p, int *state)
{
int retcode;
unsigned int y;
int retcode;
unsigned int y;
retcode = IOCTL(p->fd, TIOCMGET, &y);
*state = (y & TIOCM_RTS) == TIOCM_RTS;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
return retcode < 0 ? -RIG_EIO : RIG_OK;
retcode = IOCTL(p->fd, TIOCMGET, &y);
*state = (y & TIOCM_RTS) == TIOCM_RTS;
return retcode < 0 ? -RIG_EIO : RIG_OK;
}
/**
* \brief Set Data Terminal Ready (DTR) bit
* \param p
@ -481,32 +554,42 @@ int HAMLIB_API ser_get_rts(hamlib_port_t *p, int *state)
*/
int HAMLIB_API ser_set_dtr(hamlib_port_t *p, int state)
{
unsigned int y = TIOCM_DTR;
int rc;
unsigned int y = TIOCM_DTR;
int rc;
rig_debug(RIG_DEBUG_VERBOSE, "%s: DTR=%d\n", __func__, state);
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
rig_debug(RIG_DEBUG_VERBOSE, "%s: DTR=%d\n", __func__, state);
#if defined(TIOCMBIS) && defined(TIOCMBIC)
rc = IOCTL(p->fd, state ? TIOCMBIS : TIOCMBIC, &y);
rc = IOCTL(p->fd, state ? TIOCMBIS : TIOCMBIC, &y);
#else
rc = IOCTL(p->fd, TIOCMGET, &y);
if (rc >= 0)
{
if (state)
y |= TIOCM_DTR;
else
y &= ~TIOCM_DTR;
rc = IOCTL(p->fd, TIOCMSET, &y);
rc = IOCTL(p->fd, TIOCMGET, &y);
if (rc >= 0) {
if (state) {
y |= TIOCM_DTR;
} else {
y &= ~TIOCM_DTR;
}
rc = IOCTL(p->fd, TIOCMSET, &y);
}
#endif
if (rc < 0)
{
rig_debug(RIG_DEBUG_ERR, "%s: Cannot change DTR - %s\n", __func__, strerror(errno));
return -RIG_EIO;
if (rc < 0) {
rig_debug(RIG_DEBUG_ERR,
"%s: Cannot change DTR - %s\n",
__func__,
strerror(errno));
return -RIG_EIO;
}
return RIG_OK;
return RIG_OK;
}
/**
* \brief Get DTR bit
* \param p supposed to be &rig->state.rigport
@ -514,15 +597,18 @@ int HAMLIB_API ser_set_dtr(hamlib_port_t *p, int state)
*/
int HAMLIB_API ser_get_dtr(hamlib_port_t *p, int *state)
{
int retcode;
unsigned int y;
int retcode;
unsigned int y;
retcode = IOCTL(p->fd, TIOCMGET, &y);
*state = (y & TIOCM_DTR) == TIOCM_DTR;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
return retcode < 0 ? -RIG_EIO : RIG_OK;
retcode = IOCTL(p->fd, TIOCMGET, &y);
*state = (y & TIOCM_DTR) == TIOCM_DTR;
return retcode < 0 ? -RIG_EIO : RIG_OK;
}
/**
* \brief Set Break
* \param p
@ -531,14 +617,17 @@ int HAMLIB_API ser_get_dtr(hamlib_port_t *p, int *state)
*/
int HAMLIB_API ser_set_brk(hamlib_port_t *p, int state)
{
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
#if defined(TIOCSBRK) && defined(TIOCCBRK)
return IOCTL(p->fd, state ? TIOCSBRK : TIOCCBRK, 0 ) < 0 ?
-RIG_EIO : RIG_OK;
return IOCTL(p->fd, state ? TIOCSBRK : TIOCCBRK, 0) < 0 ?
-RIG_EIO : RIG_OK;
#else
return -RIG_ENIMPL;
return -RIG_ENIMPL;
#endif
}
/**
* \brief Get Carrier (CI?) bit
* \param p supposed to be &rig->state.rigport
@ -546,15 +635,18 @@ int HAMLIB_API ser_set_brk(hamlib_port_t *p, int state)
*/
int HAMLIB_API ser_get_car(hamlib_port_t *p, int *state)
{
int retcode;
unsigned int y;
int retcode;
unsigned int y;
retcode = IOCTL(p->fd, TIOCMGET, &y);
*state = (y & TIOCM_CAR) == TIOCM_CAR;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
return retcode < 0 ? -RIG_EIO : RIG_OK;
retcode = IOCTL(p->fd, TIOCMGET, &y);
*state = (y & TIOCM_CAR) == TIOCM_CAR;
return retcode < 0 ? -RIG_EIO : RIG_OK;
}
/**
* \brief Get Clear to Send (CTS) bit
* \param p supposed to be &rig->state.rigport
@ -562,15 +654,18 @@ int HAMLIB_API ser_get_car(hamlib_port_t *p, int *state)
*/
int HAMLIB_API ser_get_cts(hamlib_port_t *p, int *state)
{
int retcode;
unsigned int y;
int retcode;
unsigned int y;
retcode = IOCTL(p->fd, TIOCMGET, &y);
*state = (y & TIOCM_CTS) == TIOCM_CTS;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
return retcode < 0 ? -RIG_EIO : RIG_OK;
retcode = IOCTL(p->fd, TIOCMGET, &y);
*state = (y & TIOCM_CTS) == TIOCM_CTS;
return retcode < 0 ? -RIG_EIO : RIG_OK;
}
/**
* \brief Get Data Set Ready (DSR) bit
* \param p supposed to be &rig->state.rigport
@ -578,13 +673,15 @@ int HAMLIB_API ser_get_cts(hamlib_port_t *p, int *state)
*/
int HAMLIB_API ser_get_dsr(hamlib_port_t *p, int *state)
{
int retcode;
unsigned int y;
int retcode;
unsigned int y;
retcode = IOCTL(p->fd, TIOCMGET, &y);
*state = (y & TIOCM_DSR) == TIOCM_DSR;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
return retcode < 0 ? -RIG_EIO : RIG_OK;
retcode = IOCTL(p->fd, TIOCMGET, &y);
*state = (y & TIOCM_DSR) == TIOCM_DSR;
return retcode < 0 ? -RIG_EIO : RIG_OK;
}
/** @} */

608
src/settings.c
Wyświetl plik

@ -45,7 +45,7 @@
#include <sys/stat.h>
#include <fcntl.h>
#include "hamlib/rig.h"
#include <hamlib/rig.h>
#include "cal.h"
@ -58,10 +58,10 @@
/**
* \brief set a radio level setting
* \param rig The rig handle
* \param vfo The target VFO
* \param level The level setting
* \param val The value to set the level setting to
* \param rig The rig handle
* \param vfo The target VFO
* \param level The level setting
* \param val The value to set the level setting to
*
* Sets the level of a setting.
* The level value \a val can be a float or an integer. See #value_t
@ -75,51 +75,62 @@
*/
int HAMLIB_API rig_set_level(RIG *rig, vfo_t vfo, setting_t level, value_t val)
{
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
if (CHECK_RIG_ARG(rig))
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
caps = rig->caps;
if (CHECK_RIG_ARG(rig)) {
return -RIG_EINVAL;
}
if (caps->set_level == NULL || !rig_has_set_level(rig,level))
return -RIG_ENAVAIL;
caps = rig->caps;
if ((caps->targetable_vfo&RIG_TARGETABLE_PURE) ||
vfo == RIG_VFO_CURR || vfo == rig->state.current_vfo)
return caps->set_level(rig, vfo, level, val);
if (caps->set_level == NULL || !rig_has_set_level(rig, level)) {
return -RIG_ENAVAIL;
}
if (!caps->set_vfo)
return -RIG_ENTARGET;
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK)
return retcode;
if ((caps->targetable_vfo & RIG_TARGETABLE_PURE)
|| vfo == RIG_VFO_CURR
|| vfo == rig->state.current_vfo) {
return caps->set_level(rig, vfo, level, val);
}
retcode = caps->set_level(rig, vfo, level, val);
caps->set_vfo(rig, curr_vfo);
return retcode;
if (!caps->set_vfo) {
return -RIG_ENTARGET;
}
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK) {
return retcode;
}
retcode = caps->set_level(rig, vfo, level, val);
caps->set_vfo(rig, curr_vfo);
return retcode;
}
/**
* \brief get the value of a level
* \param rig The rig handle
* \param vfo The target VFO
* \param level The level setting
* \param val The location where to store the value of \a level
* \param rig The rig handle
* \param vfo The target VFO
* \param level The level setting
* \param val The location where to store the value of \a level
*
* Retrieves the value of a \a level.
* The level value \a val can be a float or an integer. See #value_t
* for more information.
*
* RIG_LEVEL_STRENGTH: \a val is an integer, representing the S Meter
* level in dB relative to S9, according to the ideal S Meter scale.
* The ideal S Meter scale is as follow: S0=-54, S1=-48, S2=-42, S3=-36,
* S4=-30, S5=-24, S6=-18, S7=-12, S8=-6, S9=0, +10=10, +20=20,
* +30=30, +40=40, +50=50 and +60=60. This is the responsability
* of the backend to return values calibrated for this scale.
* RIG_LEVEL_STRENGTH: \a val is an integer, representing the S Meter
* level in dB relative to S9, according to the ideal S Meter scale.
* The ideal S Meter scale is as follow: S0=-54, S1=-48, S2=-42, S3=-36,
* S4=-30, S5=-24, S6=-18, S7=-12, S8=-6, S9=0, +10=10, +20=20,
* +30=30, +40=40, +50=50 and +60=60. This is the responsability
* of the backend to return values calibrated for this scale.
*
* \return RIG_OK if the operation has been sucessful, otherwise
* a negative value if an error occured (in which case, cause is
@ -129,57 +140,72 @@ int HAMLIB_API rig_set_level(RIG *rig, vfo_t vfo, setting_t level, value_t val)
*/
int HAMLIB_API rig_get_level(RIG *rig, vfo_t vfo, setting_t level, value_t *val)
{
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
if (CHECK_RIG_ARG(rig) || !val)
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
caps = rig->caps;
if (CHECK_RIG_ARG(rig) || !val) {
return -RIG_EINVAL;
}
if (caps->get_level == NULL || !rig_has_get_level(rig,level))
return -RIG_ENAVAIL;
caps = rig->caps;
/*
* Special case(frontend emulation): calibrated S-meter reading
*/
if (level == RIG_LEVEL_STRENGTH &&
(caps->has_get_level & RIG_LEVEL_STRENGTH) == 0 &&
rig_has_get_level(rig,RIG_LEVEL_RAWSTR) &&
rig->state.str_cal.size) {
if (caps->get_level == NULL || !rig_has_get_level(rig, level)) {
return -RIG_ENAVAIL;
}
value_t rawstr;
/*
* Special case(frontend emulation): calibrated S-meter reading
*/
if (level == RIG_LEVEL_STRENGTH
&& (caps->has_get_level & RIG_LEVEL_STRENGTH) == 0
&& rig_has_get_level(rig, RIG_LEVEL_RAWSTR)
&& rig->state.str_cal.size) {
retcode = rig_get_level(rig, vfo, RIG_LEVEL_RAWSTR, &rawstr);
if (retcode != RIG_OK)
return retcode;
val->i = (int)rig_raw2val(rawstr.i, &rig->state.str_cal);
return RIG_OK;
}
value_t rawstr;
retcode = rig_get_level(rig, vfo, RIG_LEVEL_RAWSTR, &rawstr);
if (retcode != RIG_OK) {
return retcode;
}
val->i = (int)rig_raw2val(rawstr.i, &rig->state.str_cal);
return RIG_OK;
}
if ((caps->targetable_vfo&RIG_TARGETABLE_PURE) ||
vfo == RIG_VFO_CURR || vfo == rig->state.current_vfo)
return caps->get_level(rig, vfo, level, val);
if ((caps->targetable_vfo & RIG_TARGETABLE_PURE)
|| vfo == RIG_VFO_CURR
|| vfo == rig->state.current_vfo) {
if (!caps->set_vfo)
return -RIG_ENTARGET;
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK)
return retcode;
return caps->get_level(rig, vfo, level, val);
}
retcode = caps->get_level(rig, vfo, level, val);
caps->set_vfo(rig, curr_vfo);
return retcode;
if (!caps->set_vfo) {
return -RIG_ENTARGET;
}
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK) {
return retcode;
}
retcode = caps->get_level(rig, vfo, level, val);
caps->set_vfo(rig, curr_vfo);
return retcode;
}
/**
* \brief set a radio parameter
* \param rig The rig handle
* \param parm The parameter
* \param val The value to set the parameter
* \param rig The rig handle
* \param parm The parameter
* \param val The value to set the parameter
*
* Sets a parameter.
* The parameter value \a val can be a float or an integer. See #value_t
@ -193,20 +219,25 @@ int HAMLIB_API rig_get_level(RIG *rig, vfo_t vfo, setting_t level, value_t *val)
*/
int HAMLIB_API rig_set_parm(RIG *rig, setting_t parm, value_t val)
{
if (CHECK_RIG_ARG(rig))
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
if (rig->caps->set_parm == NULL || !rig_has_set_parm(rig,parm))
return -RIG_ENAVAIL;
if (CHECK_RIG_ARG(rig)) {
return -RIG_EINVAL;
}
return rig->caps->set_parm(rig, parm, val);
if (rig->caps->set_parm == NULL || !rig_has_set_parm(rig, parm)) {
return -RIG_ENAVAIL;
}
return rig->caps->set_parm(rig, parm, val);
}
/**
* \brief get the value of a parameter
* \param rig The rig handle
* \param parm The parameter
* \param val The location where to store the value of \a parm
* \param rig The rig handle
* \param parm The parameter
* \param val The location where to store the value of \a parm
*
* Retrieves the value of a \a parm.
* The parameter value \a val can be a float or an integer. See #value_t
@ -220,25 +251,30 @@ int HAMLIB_API rig_set_parm(RIG *rig, setting_t parm, value_t val)
*/
int HAMLIB_API rig_get_parm(RIG *rig, setting_t parm, value_t *val)
{
if (CHECK_RIG_ARG(rig) || !val)
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
if (rig->caps->get_parm == NULL || !rig_has_get_parm(rig,parm))
return -RIG_ENAVAIL;
if (CHECK_RIG_ARG(rig) || !val) {
return -RIG_EINVAL;
}
return rig->caps->get_parm(rig, parm, val);
if (rig->caps->get_parm == NULL || !rig_has_get_parm(rig, parm)) {
return -RIG_ENAVAIL;
}
return rig->caps->get_parm(rig, parm, val);
}
/**
* \brief check retrieval ability of level settings
* \param rig The rig handle
* \param level The level settings
* \param rig The rig handle
* \param level The level settings
*
* Checks if a rig is capable of *getting* a level setting.
* Since the \a level is an OR'ed bitwise argument, more than
* one level can be checked at the same time.
*
* EXAMPLE: if (rig_has_get_level(my_rig, RIG_LVL_STRENGTH)) disp_Smeter();
* EXAMPLE: if (rig_has_get_level(my_rig, RIG_LVL_STRENGTH)) disp_Smeter();
*
* \return a bit map of supported level settings that can be retrieved,
* otherwise 0 if none supported.
@ -247,23 +283,26 @@ int HAMLIB_API rig_get_parm(RIG *rig, setting_t parm, value_t *val)
*/
setting_t HAMLIB_API rig_has_get_level(RIG *rig, setting_t level)
{
if (!rig || !rig->caps)
return 0;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
return (rig->state.has_get_level & level);
if (!rig || !rig->caps) {
return 0;
}
return (rig->state.has_get_level & level);
}
/**
* \brief check settable ability of level settings
* \param rig The rig handle
* \param level The level settings
* \param rig The rig handle
* \param level The level settings
*
* Checks if a rig can *set* a level setting.
* Since the \a level is an OR'ed bitwise argument, more than
* one level can be check at the same time.
*
* EXAMPLE: if (rig_has_set_level(my_rig, RIG_LVL_RFPOWER)) crank_tx();
* EXAMPLE: if (rig_has_set_level(my_rig, RIG_LVL_RFPOWER)) crank_tx();
*
* \return a bit map of supported level settings that can be set,
* otherwise 0 if none supported.
@ -272,22 +311,26 @@ setting_t HAMLIB_API rig_has_get_level(RIG *rig, setting_t level)
*/
setting_t HAMLIB_API rig_has_set_level(RIG *rig, setting_t level)
{
if (!rig || !rig->caps)
return 0;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
return (rig->state.has_set_level & level);
if (!rig || !rig->caps) {
return 0;
}
return (rig->state.has_set_level & level);
}
/**
* \brief check retrieval ability of parameter settings
* \param rig The rig handle
* \param parm The parameter settings
* \param rig The rig handle
* \param parm The parameter settings
*
* Checks if a rig is capable of *getting* a parm setting.
* Since the \a parm is an OR'ed bitwise argument, more than
* one parameter can be checked at the same time.
*
* EXAMPLE: if (rig_has_get_parm(my_rig, RIG_PARM_ANN)) good4you();
* EXAMPLE: if (rig_has_get_parm(my_rig, RIG_PARM_ANN)) good4you();
*
* \return a bit map of supported parameter settings that can be retrieved,
* otherwise 0 if none supported.
@ -296,23 +339,26 @@ setting_t HAMLIB_API rig_has_set_level(RIG *rig, setting_t level)
*/
setting_t HAMLIB_API rig_has_get_parm(RIG *rig, setting_t parm)
{
if (!rig || !rig->caps)
return 0;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
return (rig->state.has_get_parm & parm);
if (!rig || !rig->caps) {
return 0;
}
return (rig->state.has_get_parm & parm);
}
/**
* \brief check settable ability of parameter settings
* \param rig The rig handle
* \param parm The parameter settings
* \param rig The rig handle
* \param parm The parameter settings
*
* Checks if a rig can *set* a parameter setting.
* Since the \a parm is an OR'ed bitwise argument, more than
* one parameter can be check at the same time.
*
* EXAMPLE: if (rig_has_set_parm(my_rig, RIG_PARM_ANN)) announce_all();
* EXAMPLE: if (rig_has_set_parm(my_rig, RIG_PARM_ANN)) announce_all();
*
* \return a bit map of supported parameter settings that can be set,
* otherwise 0 if none supported.
@ -321,22 +367,26 @@ setting_t HAMLIB_API rig_has_get_parm(RIG *rig, setting_t parm)
*/
setting_t HAMLIB_API rig_has_set_parm(RIG *rig, setting_t parm)
{
if (!rig || !rig->caps)
return 0;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
return (rig->state.has_set_parm & parm);
if (!rig || !rig->caps) {
return 0;
}
return (rig->state.has_set_parm & parm);
}
/**
* \brief check ability of radio functions
* \param rig The rig handle
* \param func The functions
* \param rig The rig handle
* \param func The functions
*
* Checks if a rig supports a set of functions.
* Since the \a func is an OR'ed bitwise argument, more than
* one function can be checked at the same time.
*
* EXAMPLE: if (rig_has_get_func(my_rig,RIG_FUNC_FAGC)) disp_fagc_button();
* EXAMPLE: if (rig_has_get_func(my_rig,RIG_FUNC_FAGC)) disp_fagc_button();
*
* \return a bit map of supported functions,
* otherwise 0 if none supported.
@ -345,22 +395,26 @@ setting_t HAMLIB_API rig_has_set_parm(RIG *rig, setting_t parm)
*/
setting_t HAMLIB_API rig_has_get_func(RIG *rig, setting_t func)
{
if (!rig || !rig->caps)
return 0;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
return (rig->state.has_get_func & func);
if (!rig || !rig->caps) {
return 0;
}
return (rig->state.has_get_func & func);
}
/**
* \brief check ability of radio functions
* \param rig The rig handle
* \param func The functions
* \param rig The rig handle
* \param func The functions
*
* Checks if a rig supports a set of functions.
* Since the \a func is an OR'ed bitwise argument, more than
* one function can be checked at the same time.
*
* EXAMPLE: if (rig_has_set_func(my_rig,RIG_FUNC_FAGC)) disp_fagc_button();
* EXAMPLE: if (rig_has_set_func(my_rig,RIG_FUNC_FAGC)) disp_fagc_button();
*
* \return a bit map of supported functions,
* otherwise 0 if none supported.
@ -369,18 +423,22 @@ setting_t HAMLIB_API rig_has_get_func(RIG *rig, setting_t func)
*/
setting_t HAMLIB_API rig_has_set_func(RIG *rig, setting_t func)
{
if (!rig || !rig->caps)
return 0;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
return (rig->state.has_set_func & func);
if (!rig || !rig->caps) {
return 0;
}
return (rig->state.has_set_func & func);
}
/**
* \brief activate/de-activate functions of radio
* \param rig The rig handle
* \param vfo The target VFO
* \param func The functions to activate
* \param status The status (on or off) to set to
* \param rig The rig handle
* \param vfo The target VFO
* \param func The functions to activate
* \param status The status (on or off) to set to
*
* Activate/de-activate a function of the radio.
*
@ -393,43 +451,54 @@ setting_t HAMLIB_API rig_has_set_func(RIG *rig, setting_t func)
*
* \sa rig_get_func()
*/
int HAMLIB_API rig_set_func(RIG *rig, vfo_t vfo, setting_t func, int status)
{
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
if (CHECK_RIG_ARG(rig))
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
caps = rig->caps;
if (CHECK_RIG_ARG(rig)) {
return -RIG_EINVAL;
}
if (caps->set_func == NULL || !rig_has_set_func(rig,func))
return -RIG_ENAVAIL;
caps = rig->caps;
if ((caps->targetable_vfo&RIG_TARGETABLE_FUNC) ||
vfo == RIG_VFO_CURR || vfo == rig->state.current_vfo)
return caps->set_func(rig, vfo, func, status);
if (caps->set_func == NULL || !rig_has_set_func(rig, func)) {
return -RIG_ENAVAIL;
}
if (!caps->set_vfo)
return -RIG_ENTARGET;
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK)
return retcode;
if ((caps->targetable_vfo & RIG_TARGETABLE_FUNC)
|| vfo == RIG_VFO_CURR
|| vfo == rig->state.current_vfo) {
retcode = caps->set_func(rig, vfo, func, status);
caps->set_vfo(rig, curr_vfo);
return retcode;
return caps->set_func(rig, vfo, func, status);
}
if (!caps->set_vfo) {
return -RIG_ENTARGET;
}
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK) {
return retcode;
}
retcode = caps->set_func(rig, vfo, func, status);
caps->set_vfo(rig, curr_vfo);
return retcode;
}
/**
* \brief get the status of functions of the radio
* \param rig The rig handle
* \param vfo The target VFO
* \param func The functions to get the status
* \param status The location where to store the function status
* \param rig The rig handle
* \param vfo The target VFO
* \param func The functions to get the status
* \param status The location where to store the function status
*
* Retrieves the status (on/off) of a function of the radio.
* Upon return, \a status will hold the status of the function,
@ -445,40 +514,53 @@ int HAMLIB_API rig_set_func(RIG *rig, vfo_t vfo, setting_t func, int status)
*/
int HAMLIB_API rig_get_func(RIG *rig, vfo_t vfo, setting_t func, int *status)
{
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
if (CHECK_RIG_ARG(rig) || !func)
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
caps = rig->caps;
if (CHECK_RIG_ARG(rig) || !func) {
return -RIG_EINVAL;
}
if (caps->get_func == NULL || !rig_has_get_func(rig,func))
return -RIG_ENAVAIL;
caps = rig->caps;
if ((caps->targetable_vfo&RIG_TARGETABLE_FUNC) ||
vfo == RIG_VFO_CURR || vfo == rig->state.current_vfo)
return caps->get_func(rig, vfo, func, status);
if (caps->get_func == NULL || !rig_has_get_func(rig, func)) {
return -RIG_ENAVAIL;
}
if (!caps->set_vfo)
return -RIG_ENTARGET;
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK)
return retcode;
if ((caps->targetable_vfo & RIG_TARGETABLE_FUNC)
|| vfo == RIG_VFO_CURR
|| vfo == rig->state.current_vfo) {
retcode = caps->get_func(rig, vfo, func, status);
caps->set_vfo(rig, curr_vfo);
return retcode;
return caps->get_func(rig, vfo, func, status);
}
if (!caps->set_vfo) {
return -RIG_ENTARGET;
}
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK) {
return retcode;
}
retcode = caps->get_func(rig, vfo, func, status);
caps->set_vfo(rig, curr_vfo);
return retcode;
}
/**
* \brief set a radio level extra parameter
* \param rig The rig handle
* \param vfo The target VFO
* \param token The parameter
* \param val The value to set the parameter to
* \param rig The rig handle
* \param vfo The target VFO
* \param token The parameter
* \param val The value to set the parameter to
*
* Sets an level extra parameter.
*
@ -488,42 +570,56 @@ int HAMLIB_API rig_get_func(RIG *rig, vfo_t vfo, setting_t func, int *status)
*
* \sa rig_get_ext_level()
*/
int HAMLIB_API rig_set_ext_level(RIG *rig, vfo_t vfo, token_t token, value_t val)
int HAMLIB_API rig_set_ext_level(RIG *rig, vfo_t vfo, token_t token,
value_t val)
{
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
if (CHECK_RIG_ARG(rig))
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
caps = rig->caps;
if (CHECK_RIG_ARG(rig)) {
return -RIG_EINVAL;
}
if (caps->set_ext_level == NULL)
return -RIG_ENAVAIL;
caps = rig->caps;
if ((caps->targetable_vfo&RIG_TARGETABLE_PURE) ||
vfo == RIG_VFO_CURR || vfo == rig->state.current_vfo)
return caps->set_ext_level(rig, vfo, token, val);
if (caps->set_ext_level == NULL) {
return -RIG_ENAVAIL;
}
if (!caps->set_vfo)
return -RIG_ENTARGET;
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK)
return retcode;
if ((caps->targetable_vfo & RIG_TARGETABLE_PURE)
|| vfo == RIG_VFO_CURR
|| vfo == rig->state.current_vfo) {
retcode = caps->set_ext_level(rig, vfo, token, val);
caps->set_vfo(rig, curr_vfo);
return retcode;
return caps->set_ext_level(rig, vfo, token, val);
}
if (!caps->set_vfo) {
return -RIG_ENTARGET;
}
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK) {
return retcode;
}
retcode = caps->set_ext_level(rig, vfo, token, val);
caps->set_vfo(rig, curr_vfo);
return retcode;
}
/**
* \brief get the value of a level extra parameter
* \param rig The rig handle
* \param vfo The target VFO
* \param token The parameter
* \param val The location where to store the value of \a token
* \param rig The rig handle
* \param vfo The target VFO
* \param token The parameter
* \param val The location where to store the value of \a token
*
* Retrieves the value of a level extra parameter associated with \a token.
*
@ -533,41 +629,55 @@ int HAMLIB_API rig_set_ext_level(RIG *rig, vfo_t vfo, token_t token, value_t val
*
* \sa rig_set_ext_level()
*/
int HAMLIB_API rig_get_ext_level(RIG *rig, vfo_t vfo, token_t token, value_t *val)
int HAMLIB_API rig_get_ext_level(RIG *rig, vfo_t vfo, token_t token,
value_t *val)
{
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
if (CHECK_RIG_ARG(rig) || !val)
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
caps = rig->caps;
if (CHECK_RIG_ARG(rig) || !val) {
return -RIG_EINVAL;
}
if (caps->get_ext_level == NULL)
return -RIG_ENAVAIL;
caps = rig->caps;
if ((caps->targetable_vfo&RIG_TARGETABLE_PURE) ||
vfo == RIG_VFO_CURR || vfo == rig->state.current_vfo)
return caps->get_ext_level(rig, vfo, token, val);
if (caps->get_ext_level == NULL) {
return -RIG_ENAVAIL;
}
if (!caps->set_vfo)
return -RIG_ENTARGET;
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK)
return retcode;
if ((caps->targetable_vfo & RIG_TARGETABLE_PURE)
|| vfo == RIG_VFO_CURR
|| vfo == rig->state.current_vfo) {
retcode = caps->get_ext_level(rig, vfo, token, val);
caps->set_vfo(rig, curr_vfo);
return retcode;
return caps->get_ext_level(rig, vfo, token, val);
}
if (!caps->set_vfo) {
return -RIG_ENTARGET;
}
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK) {
return retcode;
}
retcode = caps->get_ext_level(rig, vfo, token, val);
caps->set_vfo(rig, curr_vfo);
return retcode;
}
/**
* \brief set a radio parm extra parameter
* \param rig The rig handle
* \param token The parameter
* \param val The value to set the parameter to
* \param rig The rig handle
* \param token The parameter
* \param val The value to set the parameter to
*
* Sets an parm extra parameter.
*
@ -579,20 +689,25 @@ int HAMLIB_API rig_get_ext_level(RIG *rig, vfo_t vfo, token_t token, value_t *va
*/
int HAMLIB_API rig_set_ext_parm(RIG *rig, token_t token, value_t val)
{
if (CHECK_RIG_ARG(rig))
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
if (rig->caps->set_ext_parm == NULL)
return -RIG_ENAVAIL;
if (CHECK_RIG_ARG(rig)) {
return -RIG_EINVAL;
}
return rig->caps->set_ext_parm(rig, token, val);
if (rig->caps->set_ext_parm == NULL) {
return -RIG_ENAVAIL;
}
return rig->caps->set_ext_parm(rig, token, val);
}
/**
* \brief get the value of a parm extra parameter
* \param rig The rig handle
* \param token The parameter
* \param val The location where to store the value of \a token
* \param rig The rig handle
* \param token The parameter
* \param val The location where to store the value of \a token
*
* Retrieves the value of a parm extra parameter associated with \a token.
*
@ -604,19 +719,23 @@ int HAMLIB_API rig_set_ext_parm(RIG *rig, token_t token, value_t val)
*/
int HAMLIB_API rig_get_ext_parm(RIG *rig, token_t token, value_t *val)
{
if (CHECK_RIG_ARG(rig) || !val)
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
if (rig->caps->get_ext_parm == NULL)
return -RIG_ENAVAIL;
if (CHECK_RIG_ARG(rig) || !val) {
return -RIG_EINVAL;
}
return rig->caps->get_ext_parm(rig, token, val);
if (rig->caps->get_ext_parm == NULL) {
return -RIG_ENAVAIL;
}
return rig->caps->get_ext_parm(rig, token, val);
}
/**
* \brief basically convert setting_t expressed 2^n to n
* \param s The setting to convert to
* \param s The setting to convert to
*
* Converts a setting_t value expressed by 2^n to the value of n.
*
@ -625,14 +744,17 @@ int HAMLIB_API rig_get_ext_parm(RIG *rig, token_t token, value_t *val)
*/
int HAMLIB_API rig_setting2idx(setting_t s)
{
int i;
int i;
for (i = 0; i<RIG_SETTING_MAX; i++) {
if (s & rig_idx2setting(i))
return i;
}
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
return 0;
for (i = 0; i < RIG_SETTING_MAX; i++) {
if (s & rig_idx2setting(i)) {
return i;
}
}
return 0;
}
/*! @} */

50
src/token.h
Wyświetl plik

@ -44,9 +44,9 @@
#define IS_TOKEN_FRONTEND(t) ((t)&(1<<30))
/** \brief Null frontend token */
#define TOK_FRONTEND_NONE TOKEN_FRONTEND(0)
#define TOK_FRONTEND_NONE TOKEN_FRONTEND(0)
/** \brief Null backend token */
#define TOK_BACKEND_NONE TOKEN_BACKEND(0)
#define TOK_BACKEND_NONE TOKEN_BACKEND(0)
/*
* tokens shared among rig and rotator,
@ -54,37 +54,37 @@
*/
/** \brief Pathname is device for rig control, e.g. /dev/ttyS0 */
#define TOK_PATHNAME TOKEN_FRONTEND(10)
#define TOK_PATHNAME TOKEN_FRONTEND(10)
/** \brief Delay before serial output (units?) */
#define TOK_WRITE_DELAY TOKEN_FRONTEND(12)
#define TOK_WRITE_DELAY TOKEN_FRONTEND(12)
/** \brief Delay after serial output (units?) */
#define TOK_POST_WRITE_DELAY TOKEN_FRONTEND(13)
#define TOK_POST_WRITE_DELAY TOKEN_FRONTEND(13)
/** \brief Timeout delay (units?) */
#define TOK_TIMEOUT TOKEN_FRONTEND(14)
#define TOK_TIMEOUT TOKEN_FRONTEND(14)
/** \brief Number of retries permitted */
#define TOK_RETRY TOKEN_FRONTEND(15)
#define TOK_RETRY TOKEN_FRONTEND(15)
/** \brief Serial speed - "baud rate" */
#define TOK_SERIAL_SPEED TOKEN_FRONTEND(20)
#define TOK_SERIAL_SPEED TOKEN_FRONTEND(20)
/** \brief No. data bits per serial character */
#define TOK_DATA_BITS TOKEN_FRONTEND(21)
#define TOK_DATA_BITS TOKEN_FRONTEND(21)
/** \brief No. stop bits per serial character */
#define TOK_STOP_BITS TOKEN_FRONTEND(22)
#define TOK_STOP_BITS TOKEN_FRONTEND(22)
/** \brief Serial parity (format?) */
#define TOK_PARITY TOKEN_FRONTEND(23)
#define TOK_PARITY TOKEN_FRONTEND(23)
/** \brief Serial Handshake (format?) */
#define TOK_HANDSHAKE TOKEN_FRONTEND(24)
#define TOK_HANDSHAKE TOKEN_FRONTEND(24)
/** \brief Serial Req. To Send status */
#define TOK_RTS_STATE TOKEN_FRONTEND(25)
#define TOK_RTS_STATE TOKEN_FRONTEND(25)
/** \brief Serial Data Terminal Ready status */
#define TOK_DTR_STATE TOKEN_FRONTEND(26)
#define TOK_DTR_STATE TOKEN_FRONTEND(26)
/** \brief PTT type override */
#define TOK_PTT_TYPE TOKEN_FRONTEND(30)
#define TOK_PTT_TYPE TOKEN_FRONTEND(30)
/** \brief PTT pathname override */
#define TOK_PTT_PATHNAME TOKEN_FRONTEND(31)
#define TOK_PTT_PATHNAME TOKEN_FRONTEND(31)
/** \brief DCD type override */
#define TOK_DCD_TYPE TOKEN_FRONTEND(32)
#define TOK_DCD_TYPE TOKEN_FRONTEND(32)
/** \brief DCD pathname override */
#define TOK_DCD_PATHNAME TOKEN_FRONTEND(33)
#define TOK_DCD_PATHNAME TOKEN_FRONTEND(33)
/** \brief CM108 GPIO bit number for PTT */
#define TOK_PTT_BITNUM TOKEN_FRONTEND(34)
/*
@ -93,23 +93,23 @@
/* rx_range_list/tx_range_list, filters, announces, has(func,lvl,..) */
/** \brief rig: ?? */
#define TOK_VFO_COMP TOKEN_FRONTEND(110)
#define TOK_VFO_COMP TOKEN_FRONTEND(110)
/** \brief rig: polling interval (units?) */
#define TOK_POLL_INTERVAL TOKEN_FRONTEND(111)
#define TOK_POLL_INTERVAL TOKEN_FRONTEND(111)
/** \brief rig: International Telecommunications Union region no. */
#define TOK_ITU_REGION TOKEN_FRONTEND(120)
#define TOK_ITU_REGION TOKEN_FRONTEND(120)
/*
* rotator specific tokens
* (strictly, should be documented as rotator_internal)
*/
/** \brief rot: Minimum Azimuth */
#define TOK_MIN_AZ TOKEN_FRONTEND(110)
#define TOK_MIN_AZ TOKEN_FRONTEND(110)
/** \brief rot: Maximum Azimuth */
#define TOK_MAX_AZ TOKEN_FRONTEND(111)
#define TOK_MAX_AZ TOKEN_FRONTEND(111)
/** \brief rot: Minimum Elevation */
#define TOK_MIN_EL TOKEN_FRONTEND(112)
#define TOK_MIN_EL TOKEN_FRONTEND(112)
/** \brief rot: Maximum Elevation */
#define TOK_MAX_EL TOKEN_FRONTEND(113)
#define TOK_MAX_EL TOKEN_FRONTEND(113)
#endif /* _TOKEN_H */

476
src/tones.c
Wyświetl plik

@ -36,7 +36,7 @@
#include <stdlib.h>
#include "hamlib/rig.h"
#include <hamlib/rig.h>
#include "tones.h"
#if !defined(_WIN32) && !defined(__CYGWIN__)
@ -77,9 +77,9 @@ const tone_t full_dcs_list[] = { FULL_DCS_LIST };
/**
* \brief set CTCSS sub-tone frequency
* \param rig The rig handle
* \param vfo The target VFO
* \param tone The tone to set to
* \param rig The rig handle
* \param vfo The target VFO
* \param tone The tone to set to
*
* Sets the current Continuous Tone Controlled Squelch System (CTCSS)
* sub-audible tone frequency.
@ -97,42 +97,54 @@ const tone_t full_dcs_list[] = { FULL_DCS_LIST };
*
* \sa rig_get_ctcss_tone(), rig_set_ctcss_sql()
*/
int HAMLIB_API rig_set_ctcss_tone(RIG *rig, vfo_t vfo, tone_t tone)
{
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
if (CHECK_RIG_ARG(rig))
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
caps = rig->caps;
if (CHECK_RIG_ARG(rig)) {
return -RIG_EINVAL;
}
if (caps->set_ctcss_tone == NULL)
return -RIG_ENAVAIL;
caps = rig->caps;
if ((caps->targetable_vfo&RIG_TARGETABLE_TONE) ||
vfo == RIG_VFO_CURR || vfo == rig->state.current_vfo)
return caps->set_ctcss_tone(rig, vfo, tone);
if (caps->set_ctcss_tone == NULL) {
return -RIG_ENAVAIL;
}
if (!caps->set_vfo)
return -RIG_ENTARGET;
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK)
return retcode;
if ((caps->targetable_vfo & RIG_TARGETABLE_TONE)
|| vfo == RIG_VFO_CURR
|| vfo == rig->state.current_vfo) {
retcode = caps->set_ctcss_tone(rig, vfo, tone);
caps->set_vfo(rig, curr_vfo);
return retcode;
return caps->set_ctcss_tone(rig, vfo, tone);
}
if (!caps->set_vfo) {
return -RIG_ENTARGET;
}
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK) {
return retcode;
}
retcode = caps->set_ctcss_tone(rig, vfo, tone);
caps->set_vfo(rig, curr_vfo);
return retcode;
}
/**
* \brief get the current CTCSS sub-tone frequency
* \param rig The rig handle
* \param vfo The target VFO
* \param tone The location where to store the current tone
* \param rig The rig handle
* \param vfo The target VFO
* \param tone The location where to store the current tone
*
* Retrieves the current Continuous Tone Controlled Squelch System (CTCSS)
* sub-audible tone frequency.
@ -149,39 +161,52 @@ int HAMLIB_API rig_set_ctcss_tone(RIG *rig, vfo_t vfo, tone_t tone)
*/
int HAMLIB_API rig_get_ctcss_tone(RIG *rig, vfo_t vfo, tone_t *tone)
{
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
if (CHECK_RIG_ARG(rig) || !tone)
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
caps = rig->caps;
if (CHECK_RIG_ARG(rig) || !tone) {
return -RIG_EINVAL;
}
if (caps->get_ctcss_tone == NULL)
return -RIG_ENAVAIL;
caps = rig->caps;
if ((caps->targetable_vfo&RIG_TARGETABLE_TONE) ||
vfo == RIG_VFO_CURR || vfo == rig->state.current_vfo)
return caps->get_ctcss_tone(rig, vfo, tone);
if (caps->get_ctcss_tone == NULL) {
return -RIG_ENAVAIL;
}
if (!caps->set_vfo)
return -RIG_ENTARGET;
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK)
return retcode;
if ((caps->targetable_vfo & RIG_TARGETABLE_TONE)
|| vfo == RIG_VFO_CURR
|| vfo == rig->state.current_vfo) {
retcode = caps->get_ctcss_tone(rig, vfo, tone);
caps->set_vfo(rig, curr_vfo);
return retcode;
return caps->get_ctcss_tone(rig, vfo, tone);
}
if (!caps->set_vfo) {
return -RIG_ENTARGET;
}
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK) {
return retcode;
}
retcode = caps->get_ctcss_tone(rig, vfo, tone);
caps->set_vfo(rig, curr_vfo);
return retcode;
}
/**
* \brief set the current encoding DCS code
* \param rig The rig handle
* \param vfo The target VFO
* \param code The tone to set to
* \param rig The rig handle
* \param vfo The target VFO
* \param code The tone to set to
*
* Sets the current encoding Digitally-Coded Squelch code.
*
@ -194,39 +219,52 @@ int HAMLIB_API rig_get_ctcss_tone(RIG *rig, vfo_t vfo, tone_t *tone)
int HAMLIB_API rig_set_dcs_code(RIG *rig, vfo_t vfo, tone_t code)
{
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
if (CHECK_RIG_ARG(rig))
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
caps = rig->caps;
if (CHECK_RIG_ARG(rig)) {
return -RIG_EINVAL;
}
if (caps->set_dcs_code == NULL)
return -RIG_ENAVAIL;
caps = rig->caps;
if ((caps->targetable_vfo&RIG_TARGETABLE_TONE) ||
vfo == RIG_VFO_CURR || vfo == rig->state.current_vfo)
return caps->set_dcs_code(rig, vfo, code);
if (caps->set_dcs_code == NULL) {
return -RIG_ENAVAIL;
}
if (!caps->set_vfo)
return -RIG_ENTARGET;
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK)
return retcode;
if ((caps->targetable_vfo & RIG_TARGETABLE_TONE)
|| vfo == RIG_VFO_CURR
|| vfo == rig->state.current_vfo) {
retcode = caps->set_dcs_code(rig, vfo, code);
caps->set_vfo(rig, curr_vfo);
return retcode;
return caps->set_dcs_code(rig, vfo, code);
}
if (!caps->set_vfo) {
return -RIG_ENTARGET;
}
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK) {
return retcode;
}
retcode = caps->set_dcs_code(rig, vfo, code);
caps->set_vfo(rig, curr_vfo);
return retcode;
}
/**
* \brief get the current encoding DCS code
* \param rig The rig handle
* \param vfo The target VFO
* \param code The location where to store the current tone
* \param rig The rig handle
* \param vfo The target VFO
* \param code The location where to store the current tone
*
* Retrieves the current encoding Digitally-Coded Squelch code.
*
@ -238,39 +276,52 @@ int HAMLIB_API rig_set_dcs_code(RIG *rig, vfo_t vfo, tone_t code)
*/
int HAMLIB_API rig_get_dcs_code(RIG *rig, vfo_t vfo, tone_t *code)
{
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
if (CHECK_RIG_ARG(rig) || !code)
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
caps = rig->caps;
if (CHECK_RIG_ARG(rig) || !code) {
return -RIG_EINVAL;
}
if (caps->get_dcs_code == NULL)
return -RIG_ENAVAIL;
caps = rig->caps;
if ((caps->targetable_vfo&RIG_TARGETABLE_TONE) ||
vfo == RIG_VFO_CURR || vfo == rig->state.current_vfo)
return caps->get_dcs_code(rig, vfo, code);
if (caps->get_dcs_code == NULL) {
return -RIG_ENAVAIL;
}
if (!caps->set_vfo)
return -RIG_ENTARGET;
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK)
return retcode;
if ((caps->targetable_vfo & RIG_TARGETABLE_TONE)
|| vfo == RIG_VFO_CURR
|| vfo == rig->state.current_vfo) {
retcode = caps->get_dcs_code(rig, vfo, code);
caps->set_vfo(rig, curr_vfo);
return retcode;
return caps->get_dcs_code(rig, vfo, code);
}
if (!caps->set_vfo) {
return -RIG_ENTARGET;
}
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK) {
return retcode;
}
retcode = caps->get_dcs_code(rig, vfo, code);
caps->set_vfo(rig, curr_vfo);
return retcode;
}
/**
* \brief set CTCSS squelch
* \param rig The rig handle
* \param vfo The target VFO
* \param tone The PL tone to set the squelch to
* \param rig The rig handle
* \param vfo The target VFO
* \param tone The PL tone to set the squelch to
*
* Sets the current Continuous Tone Controlled Squelch System (CTCSS)
* sub-audible *squelch* tone.
@ -288,42 +339,54 @@ int HAMLIB_API rig_get_dcs_code(RIG *rig, vfo_t vfo, tone_t *code)
*
* \sa rig_get_ctcss_sql(), rig_set_ctcss_tone()
*/
int HAMLIB_API rig_set_ctcss_sql(RIG *rig, vfo_t vfo, tone_t tone)
{
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
if (CHECK_RIG_ARG(rig))
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
caps = rig->caps;
if (CHECK_RIG_ARG(rig)) {
return -RIG_EINVAL;
}
if (caps->set_ctcss_sql == NULL)
return -RIG_ENAVAIL;
caps = rig->caps;
if ((caps->targetable_vfo&RIG_TARGETABLE_TONE) ||
vfo == RIG_VFO_CURR || vfo == rig->state.current_vfo)
return caps->set_ctcss_sql(rig, vfo, tone);
if (caps->set_ctcss_sql == NULL) {
return -RIG_ENAVAIL;
}
if (!caps->set_vfo)
return -RIG_ENTARGET;
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK)
return retcode;
if ((caps->targetable_vfo & RIG_TARGETABLE_TONE)
|| vfo == RIG_VFO_CURR
|| vfo == rig->state.current_vfo) {
retcode = caps->set_ctcss_sql(rig, vfo, tone);
caps->set_vfo(rig, curr_vfo);
return retcode;
return caps->set_ctcss_sql(rig, vfo, tone);
}
if (!caps->set_vfo) {
return -RIG_ENTARGET;
}
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK) {
return retcode;
}
retcode = caps->set_ctcss_sql(rig, vfo, tone);
caps->set_vfo(rig, curr_vfo);
return retcode;
}
/**
* \brief get the current CTCSS squelch
* \param rig The rig handle
* \param vfo The target VFO
* \param tone The location where to store the current tone
* \param rig The rig handle
* \param vfo The target VFO
* \param tone The location where to store the current tone
*
* Retrieves the current Continuous Tone Controlled Squelch System (CTCSS)
* sub-audible *squelch* tone.
@ -340,39 +403,52 @@ int HAMLIB_API rig_set_ctcss_sql(RIG *rig, vfo_t vfo, tone_t tone)
*/
int HAMLIB_API rig_get_ctcss_sql(RIG *rig, vfo_t vfo, tone_t *tone)
{
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
if (CHECK_RIG_ARG(rig) || !tone)
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
caps = rig->caps;
if (CHECK_RIG_ARG(rig) || !tone) {
return -RIG_EINVAL;
}
if (caps->get_ctcss_sql == NULL)
return -RIG_ENAVAIL;
caps = rig->caps;
if ((caps->targetable_vfo&RIG_TARGETABLE_TONE) ||
vfo == RIG_VFO_CURR || vfo == rig->state.current_vfo)
return caps->get_ctcss_sql(rig, vfo, tone);
if (caps->get_ctcss_sql == NULL) {
return -RIG_ENAVAIL;
}
if (!caps->set_vfo)
return -RIG_ENTARGET;
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK)
return retcode;
if ((caps->targetable_vfo & RIG_TARGETABLE_TONE)
|| vfo == RIG_VFO_CURR
|| vfo == rig->state.current_vfo) {
retcode = caps->get_ctcss_sql(rig, vfo, tone);
caps->set_vfo(rig, curr_vfo);
return retcode;
return caps->get_ctcss_sql(rig, vfo, tone);
}
if (!caps->set_vfo) {
return -RIG_ENTARGET;
}
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK) {
return retcode;
}
retcode = caps->get_ctcss_sql(rig, vfo, tone);
caps->set_vfo(rig, curr_vfo);
return retcode;
}
/**
* \brief set the current DCS code
* \param rig The rig handle
* \param vfo The target VFO
* \param code The tone to set to
* \param rig The rig handle
* \param vfo The target VFO
* \param code The tone to set to
*
* Sets the current Digitally-Coded *Squelch* code.
*
@ -382,42 +458,54 @@ int HAMLIB_API rig_get_ctcss_sql(RIG *rig, vfo_t vfo, tone_t *tone)
*
* \sa rig_get_dcs_sql(), rig_set_dcs_code()
*/
int HAMLIB_API rig_set_dcs_sql(RIG *rig, vfo_t vfo, tone_t code)
{
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
if (CHECK_RIG_ARG(rig))
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
caps = rig->caps;
if (CHECK_RIG_ARG(rig)) {
return -RIG_EINVAL;
}
if (caps->set_dcs_sql == NULL)
return -RIG_ENAVAIL;
caps = rig->caps;
if ((caps->targetable_vfo&RIG_TARGETABLE_TONE) ||
vfo == RIG_VFO_CURR || vfo == rig->state.current_vfo)
return caps->set_dcs_sql(rig, vfo, code);
if (caps->set_dcs_sql == NULL) {
return -RIG_ENAVAIL;
}
if (!caps->set_vfo)
return -RIG_ENTARGET;
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK)
return retcode;
if ((caps->targetable_vfo & RIG_TARGETABLE_TONE)
|| vfo == RIG_VFO_CURR
|| vfo == rig->state.current_vfo) {
retcode = caps->set_dcs_sql(rig, vfo, code);
caps->set_vfo(rig, curr_vfo);
return retcode;
return caps->set_dcs_sql(rig, vfo, code);
}
if (!caps->set_vfo) {
return -RIG_ENTARGET;
}
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK) {
return retcode;
}
retcode = caps->set_dcs_sql(rig, vfo, code);
caps->set_vfo(rig, curr_vfo);
return retcode;
}
/**
* \brief get the current DCS code
* \param rig The rig handle
* \param vfo The target VFO
* \param code The location where to store the current tone
* \param rig The rig handle
* \param vfo The target VFO
* \param code The location where to store the current tone
*
* Retrieves the current Digitally-Coded *Squelch* code.
*
@ -429,32 +517,44 @@ int HAMLIB_API rig_set_dcs_sql(RIG *rig, vfo_t vfo, tone_t code)
*/
int HAMLIB_API rig_get_dcs_sql(RIG *rig, vfo_t vfo, tone_t *code)
{
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
const struct rig_caps *caps;
int retcode;
vfo_t curr_vfo;
if (CHECK_RIG_ARG(rig) || !code)
return -RIG_EINVAL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
caps = rig->caps;
if (CHECK_RIG_ARG(rig) || !code) {
return -RIG_EINVAL;
}
if (caps->get_dcs_sql == NULL)
return -RIG_ENAVAIL;
caps = rig->caps;
if ((caps->targetable_vfo&RIG_TARGETABLE_TONE) ||
vfo == RIG_VFO_CURR || vfo == rig->state.current_vfo)
return caps->get_dcs_sql(rig, vfo, code);
if (caps->get_dcs_sql == NULL) {
return -RIG_ENAVAIL;
}
if (!caps->set_vfo)
return -RIG_ENTARGET;
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK)
return retcode;
if ((caps->targetable_vfo & RIG_TARGETABLE_TONE)
|| vfo == RIG_VFO_CURR
|| vfo == rig->state.current_vfo) {
retcode = caps->get_dcs_sql(rig, vfo, code);
caps->set_vfo(rig, curr_vfo);
return retcode;
return caps->get_dcs_sql(rig, vfo, code);
}
if (!caps->set_vfo) {
return -RIG_ENTARGET;
}
curr_vfo = rig->state.current_vfo;
retcode = caps->set_vfo(rig, vfo);
if (retcode != RIG_OK) {
return retcode;
}
retcode = caps->get_dcs_sql(rig, vfo, code);
caps->set_vfo(rig, curr_vfo);
return retcode;
}
/*! @} */

78
src/tones.h
Wyświetl plik

@ -23,24 +23,25 @@
#define _TONES_H 1
#include "hamlib/rig.h" /* and implicitly rig_dll.h */
#include <hamlib/rig.h> /* and implicitly rig_dll.h */
/*
* 52 CTCSS sub-audible tones
*/
#define FULL_CTCSS_LIST \
600, 670, 693, 719, 744, 770, 797, 825, 854, 885, 915, \
948, 974, 1000, 1035, 1072, 1109, 1148, 1188, 1200, 1230, 1273, \
1318, 1365, 1413, 1462, 1514, 1567, 1598, 1622, 1655, 1679, \
1713, 1738, 1773, 1799, 1835, 1862, 1899, 1928, 1966, 1995, \
2035, 2065, 2107, 2181, 2257, 2291, 2336, 2418, 2503, 2541, \
0,
600, 670, 693, 719, 744, 770, 797, 825, 854, 885, 915, \
948, 974, 1000, 1035, 1072, 1109, 1148, 1188, 1200, 1230, 1273, \
1318, 1365, 1413, 1462, 1514, 1567, 1598, 1622, 1655, 1679, \
1713, 1738, 1773, 1799, 1835, 1862, 1899, 1928, 1966, 1995, \
2035, 2065, 2107, 2181, 2257, 2291, 2336, 2418, 2503, 2541, \
0,
static const tone_t static_full_ctcss_list[] = {
FULL_CTCSS_LIST
FULL_CTCSS_LIST
};
/*
* 50 CTCSS sub-audible tones, from 67.0Hz to 254.1Hz
*
@ -49,55 +50,58 @@ static const tone_t static_full_ctcss_list[] = {
* own caps. --SF
*/
#define COMMON_CTCSS_LIST \
670, 693, 719, 744, 770, 797, 825, 854, 885, 915, \
948, 974, 1000, 1035, 1072, 1109, 1148, 1188, 1230, 1273, \
1318, 1365, 1413, 1462, 1514, 1567, 1598, 1622, 1655, 1679, \
1713, 1738, 1773, 1799, 1835, 1862, 1899, 1928, 1966, 1995, \
2035, 2065, 2107, 2181, 2257, 2291, 2336, 2418, 2503, 2541, \
0,
670, 693, 719, 744, 770, 797, 825, 854, 885, 915, \
948, 974, 1000, 1035, 1072, 1109, 1148, 1188, 1230, 1273, \
1318, 1365, 1413, 1462, 1514, 1567, 1598, 1622, 1655, 1679, \
1713, 1738, 1773, 1799, 1835, 1862, 1899, 1928, 1966, 1995, \
2035, 2065, 2107, 2181, 2257, 2291, 2336, 2418, 2503, 2541, \
0,
static const tone_t static_common_ctcss_list[] = {
COMMON_CTCSS_LIST
COMMON_CTCSS_LIST
};
/*
* 104 DCS codes
*/
#define COMMON_DCS_LIST \
23, 25, 26, 31, 32, 36, 43, 47, 51, 53, \
54, 65, 71, 72, 73, 74, 114, 115, 116, 122, 125, 131, \
132, 134, 143, 145, 152, 155, 156, 162, 165, 172, 174, 205, \
212, 223, 225, 226, 243, 244, 245, 246, 251, 252, 255, 261, \
263, 265, 266, 271, 274, 306, 311, 315, 325, 331, 332, 343, \
346, 351, 356, 364, 365, 371, 411, 412, 413, 423, 431, 432, \
445, 446, 452, 454, 455, 462, 464, 465, 466, 503, 506, 516, \
523, 526, 532, 546, 565, 606, 612, 624, 627, 631, 632, 654, \
662, 664, 703, 712, 723, 731, 732, 734, 743, 754, \
0,
23, 25, 26, 31, 32, 36, 43, 47, 51, 53, \
54, 65, 71, 72, 73, 74, 114, 115, 116, 122, 125, 131, \
132, 134, 143, 145, 152, 155, 156, 162, 165, 172, 174, 205, \
212, 223, 225, 226, 243, 244, 245, 246, 251, 252, 255, 261, \
263, 265, 266, 271, 274, 306, 311, 315, 325, 331, 332, 343, \
346, 351, 356, 364, 365, 371, 411, 412, 413, 423, 431, 432, \
445, 446, 452, 454, 455, 462, 464, 465, 466, 503, 506, 516, \
523, 526, 532, 546, 565, 606, 612, 624, 627, 631, 632, 654, \
662, 664, 703, 712, 723, 731, 732, 734, 743, 754, \
0,
static const tone_t static_common_dcs_list[] = {
COMMON_DCS_LIST
COMMON_DCS_LIST
};
/*
* 106 DCS codes
*/
#define FULL_DCS_LIST \
17, 23, 25, 26, 31, 32, 36, 43, 47, 50, 51, 53, \
54, 65, 71, 72, 73, 74, 114, 115, 116, 122, 125, 131, \
132, 134, 143, 145, 152, 155, 156, 162, 165, 172, 174, 205, \
212, 223, 225, 226, 243, 244, 245, 246, 251, 252, 255, 261, \
263, 265, 266, 271, 274, 306, 311, 315, 325, 331, 332, 343, \
346, 351, 356, 364, 365, 371, 411, 412, 413, 423, 431, 432, \
445, 446, 452, 454, 455, 462, 464, 465, 466, 503, 506, 516, \
523, 526, 532, 546, 565, 606, 612, 624, 627, 631, 632, 654, \
662, 664, 703, 712, 723, 731, 732, 734, 743, 754, \
0,
17, 23, 25, 26, 31, 32, 36, 43, 47, 50, 51, 53, \
54, 65, 71, 72, 73, 74, 114, 115, 116, 122, 125, 131, \
132, 134, 143, 145, 152, 155, 156, 162, 165, 172, 174, 205, \
212, 223, 225, 226, 243, 244, 245, 246, 251, 252, 255, 261, \
263, 265, 266, 271, 274, 306, 311, 315, 325, 331, 332, 343, \
346, 351, 356, 364, 365, 371, 411, 412, 413, 423, 431, 432, \
445, 446, 452, 454, 455, 462, 464, 465, 466, 503, 506, 516, \
523, 526, 532, 546, 565, 606, 612, 624, 627, 631, 632, 654, \
662, 664, 703, 712, 723, 731, 732, 734, 743, 754, \
0,
static const tone_t static_full_dcs_list[] = {
FULL_DCS_LIST
FULL_DCS_LIST
};
/*
* These arrays cannot be shared on Win32 systems,
* because DLL's vars don't have constant address.

400
src/usb_port.c
Wyświetl plik

@ -35,7 +35,7 @@
#include "config.h"
#endif
#include "hamlib/rig.h"
#include <hamlib/rig.h>
/*
* Compile only if libusb is available
@ -60,110 +60,146 @@
#include "usb_port.h"
/**
* \brief Find and open USB device
* \param port
* \return usb_handle
*/
static libusb_device_handle *find_and_open_device(const hamlib_port_t *port)
static libusb_device_handle * find_and_open_device(const hamlib_port_t *port)
{
libusb_device_handle *udh = NULL;
libusb_device *dev, **devs;
struct libusb_device_descriptor desc;
char string[256];
int i, r;
libusb_device_handle *udh = NULL;
libusb_device *dev, **devs;
struct libusb_device_descriptor desc;
char string[256];
int i, r;
rig_debug(RIG_DEBUG_VERBOSE, "%s: looking for device %04x:%04x...",
__func__, port->parm.usb.vid, port->parm.usb.pid);
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
r = libusb_get_device_list(NULL, &devs);
rig_debug(RIG_DEBUG_VERBOSE,
"%s: looking for device %04x:%04x...",
__func__,
port->parm.usb.vid,
port->parm.usb.pid);
if (r < 0) {
rig_debug(RIG_DEBUG_ERR, "%s: failed getting usb device list: %s",
__func__, libusb_error_name(r));
return NULL;
}
r = libusb_get_device_list(NULL, &devs);
for (i = 0; (dev = devs[i]) != NULL; i++) {
if (r < 0) {
rig_debug(RIG_DEBUG_ERR,
"%s: failed getting usb device list: %s",
__func__,
libusb_error_name(r));
libusb_get_device_descriptor(dev, &desc);
return NULL;
}
rig_debug(RIG_DEBUG_VERBOSE, " %04x:%04x,",
desc.idVendor, desc.idProduct);
for (i = 0; (dev = devs[i]) != NULL; i++) {
if (desc.idVendor == port->parm.usb.vid &&
desc.idProduct == port->parm.usb.pid) {
libusb_get_device_descriptor(dev, &desc);
/* we need to open the device in order to query strings */
r = libusb_open(dev, &udh);
rig_debug(RIG_DEBUG_VERBOSE,
" %04x:%04x,",
desc.idVendor,
desc.idProduct);
if (r < 0) {
rig_debug(RIG_DEBUG_WARN, "%s: Warning: Cannot open USB device: %s\n",
__func__, libusb_error_name(r));
continue;
}
if (desc.idVendor == port->parm.usb.vid
&& desc.idProduct == port->parm.usb.pid) {
/* now check whether the names match: */
if (port->parm.usb.vendor_name) {
/* we need to open the device in order to query strings */
r = libusb_open(dev, &udh);
string[0] = '\0';
r = libusb_get_string_descriptor_ascii(udh, desc.iManufacturer, (unsigned char *)string, sizeof(string));
if (r < 0) {
rig_debug(RIG_DEBUG_WARN,
"%s: Warning: Cannot open USB device: %s\n",
__func__,
libusb_error_name(r));
if (r < 0) {
rig_debug(RIG_DEBUG_WARN, "Warning: cannot query manufacturer for USB device: %s\n", libusb_error_name(r));
libusb_close(udh);
continue;
}
continue;
}
rig_debug(RIG_DEBUG_VERBOSE, " vendor >%s<", string);
/* now check whether the names match: */
if (port->parm.usb.vendor_name) {
if (strcmp(string, port->parm.usb.vendor_name) != 0) {
rig_debug(RIG_DEBUG_WARN, "%s: Warning: Vendor name string mismatch!\n", __func__);
libusb_close(udh);
continue;
}
}
string[0] = '\0';
r = libusb_get_string_descriptor_ascii(udh,
desc.iManufacturer,
(unsigned char *)string,
sizeof(string));
if (port->parm.usb.product) {
if (r < 0) {
rig_debug(RIG_DEBUG_WARN,
"Warning: cannot query manufacturer for USB device: %s\n",
libusb_error_name(r));
string[0] = '\0';
r = libusb_get_string_descriptor_ascii(udh, desc.iProduct, (unsigned char *)string, sizeof(string));
libusb_close(udh);
continue;
}
if (r < 0) {
rig_debug(RIG_DEBUG_WARN, "Warning: cannot query product for USB device: %s\n", libusb_error_name(r));
libusb_close(udh);
continue;
}
rig_debug(RIG_DEBUG_VERBOSE, " vendor >%s<", string);
rig_debug(RIG_DEBUG_VERBOSE, " product >%s<", string);
if (strcmp(string, port->parm.usb.vendor_name) != 0) {
rig_debug(RIG_DEBUG_WARN,
"%s: Warning: Vendor name string mismatch!\n",
__func__);
if (strcmp(string, port->parm.usb.product) != 0) {
/* Now testing with strncasecmp() for case insensitive
* match. Updating firmware on FUNcube Dongle to v18f resulted
* in product string changing from "FunCube Dongle" to
* "FUNcube Dongle". As new dongles are shipped with
* older firmware, both product strings are valid. Sigh...
*/
if (strncasecmp(string, port->parm.usb.product, sizeof(port->parm.usb.product - 1)) != 0) {
rig_debug(RIG_DEBUG_WARN, "%s: Warning: Product string mismatch!\n", __func__);
libusb_close(udh);
continue;
}
}
}
libusb_close(udh);
continue;
}
}
libusb_free_device_list(devs, 1);
if (port->parm.usb.product) {
rig_debug(RIG_DEBUG_VERBOSE, " -> found\n");
return udh;
}
}
string[0] = '\0';
r = libusb_get_string_descriptor_ascii(udh,
desc.iProduct,
(unsigned char *)string,
sizeof(string));
libusb_free_device_list(devs, 1);
if (r < 0) {
rig_debug(RIG_DEBUG_WARN,
"Warning: cannot query product for USB device: %s\n",
libusb_error_name(r));
rig_debug(RIG_DEBUG_VERBOSE, " -> not found\n");
return NULL; /* not found */
libusb_close(udh);
continue;
}
rig_debug(RIG_DEBUG_VERBOSE, " product >%s<", string);
if (strcmp(string, port->parm.usb.product) != 0) {
/* Now testing with strncasecmp() for case insensitive
* match. Updating firmware on FUNcube Dongle to v18f resulted
* in product string changing from "FunCube Dongle" to
* "FUNcube Dongle". As new dongles are shipped with
* older firmware, both product strings are valid. Sigh...
*/
if (strncasecmp(string,
port->parm.usb.product,
sizeof(port->parm.usb.product - 1)) != 0) {
rig_debug(RIG_DEBUG_WARN,
"%s: Warning: Product string mismatch!\n",
__func__);
libusb_close(udh);
continue;
}
}
}
libusb_free_device_list(devs, 1);
rig_debug(RIG_DEBUG_VERBOSE, " -> found\n");
return udh;
}
}
libusb_free_device_list(devs, 1);
rig_debug(RIG_DEBUG_VERBOSE, " -> not found\n");
return NULL; /* not found */
}
@ -174,119 +210,144 @@ static libusb_device_handle *find_and_open_device(const hamlib_port_t *port)
*/
int usb_port_open(hamlib_port_t *port)
{
static char pathname[FILPATHLEN];
libusb_device_handle *udh;
char *p, *q;
int r;
static char pathname[FILPATHLEN];
libusb_device_handle *udh;
char *p, *q;
int r;
/* init defaut libusb-1.0 library contexte, if needed */
r = libusb_init(NULL);
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
if (r < 0) {
rig_debug(RIG_DEBUG_ERR, "%s: libusb_init failed: %s\n",
__func__, libusb_error_name(r));
return -RIG_EIO;
}
/* init defaut libusb-1.0 library contexte, if needed */
r = libusb_init(NULL);
//libusb_set_debug(NULL, 1);
if (r < 0) {
rig_debug(RIG_DEBUG_ERR,
"%s: libusb_init failed: %s\n",
__func__,
libusb_error_name(r));
/* Extract VID/PID/Vendor/Product name from pathname. */
/* Duplicate the string since we may modify it. */
strncpy(pathname, port->pathname, sizeof pathname);
pathname[FILPATHLEN - 1] = '\0';
return -RIG_EIO;
}
p = pathname;
q = strchr(p, ':');
//libusb_set_debug(NULL, 1);
if (q) {
++q;
port->parm.usb.vid = strtol(q, NULL, 16);
p = q;
q = strchr(p, ':');
/* Extract VID/PID/Vendor/Product name from pathname. */
/* Duplicate the string since we may modify it. */
strncpy(pathname, port->pathname, sizeof pathname);
pathname[FILPATHLEN - 1] = '\0';
if (q) {
++q;
port->parm.usb.pid = strtol(q, NULL, 16);
p = q;
q = strchr(p, ':');
p = pathname;
q = strchr(p, ':');
if (q) {
++q;
port->parm.usb.vendor_name = q;
p = q;
q = strchr(p, ':');
if (q) {
++q;
port->parm.usb.vid = strtol(q, NULL, 16);
p = q;
q = strchr(p, ':');
if (q) {
*q++ = '\0';
port->parm.usb.product = q;
}
}
}
}
if (q) {
++q;
port->parm.usb.pid = strtol(q, NULL, 16);
p = q;
q = strchr(p, ':');
udh = find_and_open_device(port);
if (q) {
++q;
port->parm.usb.vendor_name = q;
p = q;
q = strchr(p, ':');
if (udh == 0) {
libusb_exit(NULL);
return -RIG_EIO;
}
if (q) {
*q++ = '\0';
port->parm.usb.product = q;
}
}
}
}
/* Try to detach ftdi_sio kernel module.
* This should be performed only for devices using
* USB-serial converters (like FTDI chips), for other
* devices this may cause problems, so do not do it.
*/
(void)libusb_set_auto_detach_kernel_driver(udh, port->parm.usb.iface);
udh = find_and_open_device(port);
if (port->parm.usb.iface >= 0) {
if (udh == 0) {
libusb_exit(NULL);
return -RIG_EIO;
}
/* Try to detach ftdi_sio kernel module.
* This should be performed only for devices using
* USB-serial converters (like FTDI chips), for other
* devices this may cause problems, so do not do it.
*/
(void)libusb_set_auto_detach_kernel_driver(udh, port->parm.usb.iface);
if (port->parm.usb.iface >= 0) {
#ifdef _WIN32
/* Is it still needed with libusb-1.0 ? */
if (port->parm.usb.conf >= 0 &&
(r = libusb_set_configuration(udh, port->parm.usb.conf)) < 0) {
rig_debug(RIG_DEBUG_ERR, "%s: libusb_set_configuration: failed conf %d: %s\n",
__func__, port->parm.usb.conf, libusb_error_name(r));
libusb_close(udh);
libusb_exit(NULL);
return -RIG_EIO;
}
/* Is it still needed with libusb-1.0 ? */
if (port->parm.usb.conf >= 0
&& (r = libusb_set_configuration(udh, port->parm.usb.conf)) < 0) {
rig_debug(RIG_DEBUG_ERR,
"%s: libusb_set_configuration: failed conf %d: %s\n",
__func__,
port->parm.usb.conf,
libusb_error_name(r));
libusb_close(udh);
libusb_exit(NULL);
return -RIG_EIO;
}
#endif
rig_debug(RIG_DEBUG_VERBOSE, "%s: claiming %d\n", __func__, port->parm.usb.iface);
rig_debug(RIG_DEBUG_VERBOSE,
"%s: claiming %d\n",
__func__,
port->parm.usb.iface);
r = libusb_claim_interface(udh, port->parm.usb.iface);
r = libusb_claim_interface(udh, port->parm.usb.iface);
if (r < 0) {
rig_debug(RIG_DEBUG_ERR, "%s:libusb_claim_interface: failed interface %d: %s\n",
__func__, port->parm.usb.iface, libusb_error_name(r));
libusb_close(udh);
libusb_exit(NULL);
return -RIG_EIO;
}
if (r < 0) {
rig_debug(RIG_DEBUG_ERR,
"%s:libusb_claim_interface: failed interface %d: %s\n",
__func__,
port->parm.usb.iface,
libusb_error_name(r));
libusb_close(udh);
libusb_exit(NULL);
return -RIG_EIO;
}
#if 0
r = libusb_set_interface_alt_setting(udh, port->parm.usb.iface, port->parm.usb.alt);
r = libusb_set_interface_alt_setting(udh, port->parm.usb.iface,
port->parm.usb.alt);
if (r < 0) {
fprintf(stderr, "%s:usb_set_alt_interface: failed: %s\n", __func__,
libusb_error_name(r));
libusb_release_interface(udh, port->parm.usb.iface);
libusb_close(udh);
libusb_exit(NULL);
return -RIG_EIO;
}
if (r < 0) {
fprintf(stderr,
"%s:usb_set_alt_interface: failed: %s\n",
__func__,
libusb_error_name(r));
libusb_release_interface(udh, port->parm.usb.iface);
libusb_close(udh);
libusb_exit(NULL);
return -RIG_EIO;
}
#endif
}
}
port->handle = (void *) udh;
port->handle = (void *) udh;
return RIG_OK;
return RIG_OK;
}
/**
* \brief Close hamlib_port of USB device
* \param port
@ -294,29 +355,36 @@ int usb_port_open(hamlib_port_t *port)
*/
int usb_port_close(hamlib_port_t *port)
{
libusb_device_handle *udh = port->handle;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
libusb_release_interface(udh, port->parm.usb.iface);
libusb_device_handle *udh = port->handle;
libusb_close(udh);
libusb_release_interface(udh, port->parm.usb.iface);
libusb_exit(NULL);
libusb_close(udh);
return RIG_OK;
libusb_exit(NULL);
return RIG_OK;
}
#else
int usb_port_open(hamlib_port_t *port)
{
return -RIG_ENAVAIL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
return -RIG_ENAVAIL;
}
int usb_port_close(hamlib_port_t *port)
{
return -RIG_ENAVAIL;
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
return -RIG_ENAVAIL;
}
#endif /* defined(HAVE_LIBUSB) && defined(HAVE_LIBUSB_H) */
#endif /* defined(HAVE_LIBUSB) && defined(HAVE_LIBUSB_H) */
/** @} */