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

2576 wiersze
58 KiB
C
Czysty Wina Historia

/*
* Hamlib Kenwood backend - TH handheld primitives
* Copyright (c) 2001-2010 by Stephane Fillod
* Copyright (C) 2010 by Alessandro Zummo
*
*
* This library is free software; you can redistribute it and/or
* modify it under the terms of the GNU Lesser General Public
* License as published by the Free Software Foundation; either
* version 2.1 of the License, or (at your option) any later version.
*
* This library is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
* Lesser General Public License for more details.
*
* You should have received a copy of the GNU Lesser General Public
* License along with this library; if not, write to the Free Software
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
*
*/
#include <hamlib/config.h>
#include <stdlib.h>
#include <stdio.h>
#include <math.h>
#include <string.h> /* String function definitions */
#include "hamlib/rig.h"
#include "kenwood.h"
#include "th.h"
#include "serial.h"
#include "misc.h"
#include "num_stdio.h"
/* Note: Currently the code assumes the command termination is a
* single character.
*/
#define ACKBUF_LEN 64
/*
* th_decode_event is called by sa_sigio, when some asynchronous
* data has been received from the rig.
*/
int
th_decode_event(RIG *rig)
{
char asyncbuf[128];
int retval;
int async_len;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
retval = kenwood_transaction(rig, NULL, asyncbuf, sizeof(asyncbuf));
if (retval != RIG_OK)
{
return retval;
}
rig_debug(RIG_DEBUG_TRACE, "%s: Decoding message\n", __func__);
async_len = strlen(asyncbuf);
if (async_len > 3 && asyncbuf[0] == 'B' && asyncbuf[1] == 'U'
&& asyncbuf[2] == 'F')
{
vfo_t vfo;
freq_t freq, offset;
int mode;
int step, shift, rev, tone, ctcss, tonefq, ctcssfq;
retval = num_sscanf(asyncbuf,
"BUF %d,%"SCNfreq",%X,%d,%d,%d,%d,,%d,,%d,%"SCNfreq",%d",
&vfo, &freq, &step, &shift, &rev, &tone,
&ctcss, &tonefq, &ctcssfq, &offset, &mode);
if (retval != 11)
{
rig_debug(RIG_DEBUG_ERR, "%s: Unexpected BUF message '%s'\n", __func__,
asyncbuf);
return -RIG_ERJCTED;
}
/* Calibration and conversions */
vfo = (vfo == 0) ? RIG_VFO_A : RIG_VFO_B;
mode = (mode == 0) ? RIG_MODE_FM : RIG_MODE_AM;
rig_debug(RIG_DEBUG_TRACE, "%s: Buffer (vfo %d, freq %"PRIfreq" Hz, mode %d)\n",
__func__, vfo, freq, mode);
/* Callback execution */
if (rig->callbacks.vfo_event)
{
rig->callbacks.vfo_event(rig, vfo, rig->callbacks.vfo_arg);
}
if (rig->callbacks.freq_event)
{
rig->callbacks.freq_event(rig, vfo, freq, rig->callbacks.freq_arg);
}
if (rig->callbacks.mode_event)
{
rig->callbacks.mode_event(rig, vfo, mode, RIG_PASSBAND_NORMAL,
rig->callbacks.mode_arg);
}
}
else if (async_len > 2 && asyncbuf[0] == 'S' && asyncbuf[1] == 'M')
{
vfo_t vfo;
int lev;
retval = sscanf(asyncbuf, "SM %d,%d", &vfo, &lev);
if (retval != 2)
{
rig_debug(RIG_DEBUG_ERR, "%s: Unexpected SM message '%s'\n", __func__,
asyncbuf);
return -RIG_ERJCTED;
}
/* Calibration and conversions */
vfo = (vfo == 0) ? RIG_VFO_A : RIG_VFO_B;
rig_debug(RIG_DEBUG_TRACE, "%s: Signal strength event - signal = %.3f\n",
__func__, (float)(lev / 5.0));
/* Callback execution */
#if STILLHAVETOADDCALLBACK
if (rig->callbacks.strength_event)
rig->callbacks.strength_event(rig, vfo, (float)(lev / 5.0),
rig->callbacks.strength_arg);
#endif
}
else if (async_len > 2 && asyncbuf[0] == 'B' && asyncbuf[1] == 'Y')
{
vfo_t vfo;
int busy;
retval = sscanf(asyncbuf, "BY %d,%d", &vfo, &busy);
if (retval != 2)
{
rig_debug(RIG_DEBUG_ERR, "%s: Unexpected BY message '%s'\n", __func__,
asyncbuf);
return -RIG_ERJCTED;
}
vfo = (vfo == 0) ? RIG_VFO_A : RIG_VFO_B;
rig_debug(RIG_DEBUG_TRACE, "%s: Busy event - status = '%s'\n",
__func__, (busy == 0) ? "OFF" : "ON");
return -RIG_ENIMPL;
/* This event does not have a callback. */
}
else if (async_len > 2 && asyncbuf[0] == 'B' && asyncbuf[1] == 'C')
{
vfo_t vfo;
retval = sscanf(asyncbuf, "BC %d", &vfo);
if (retval != 1)
{
rig_debug(RIG_DEBUG_ERR, "%s: Unexpected BC message '%s'\n", __func__,
asyncbuf);
return -RIG_ERJCTED;
}
vfo = (vfo == 0) ? RIG_VFO_A : RIG_VFO_B;
rig_debug(RIG_DEBUG_TRACE, "%s: VFO event - vfo = %d\n", __func__, vfo);
if (rig->callbacks.vfo_event)
{
rig->callbacks.vfo_event(rig, vfo, rig->callbacks.vfo_arg);
}
}
else
{
rig_debug(RIG_DEBUG_ERR, "%s: Unsupported transceive cmd '%s'\n", __func__,
asyncbuf);
return -RIG_ENIMPL;
}
return RIG_OK;
}
static int
kenwood_wrong_vfo(const char *func, vfo_t vfo)
{
rig_debug(RIG_DEBUG_ERR, "%s: Unsupported VFO: %s\n", func, rig_strvfo(vfo));
return -RIG_ENTARGET;
}
/*
* th_set_freq
* Assumes rig!=NULL
*/
int
th_set_freq(RIG *rig, vfo_t vfo, freq_t freq)
{
char buf[20];
int step;
freq_t freq5, freq625, freq_sent;
rig_debug(RIG_DEBUG_TRACE, "%s: called %s\n", __func__, rig_strvfo(vfo));
if (vfo != RIG_VFO_CURR && vfo != rig->state.current_vfo)
{
return kenwood_wrong_vfo(__func__, vfo);
}
freq5 = round(freq / 5000) * 5000;
freq625 = round(freq / 6250) * 6250;
if (fabs(freq5 - freq) < fabs(freq625 - freq))
{
step = 0;
freq_sent = freq5;
}
else
{
step = 1;
freq_sent = freq625;
}
/* Step needs to be at least 10kHz on higher band, otherwise 5 kHz */
step = freq_sent >= MHz(470) ? 4 : step;
freq_sent = freq_sent >= MHz(470) ? (round(freq_sent / 10000) * 10000) :
freq_sent;
// cppcheck-suppress *
SNPRINTF(buf, sizeof(buf), "FQ %011"PRIll",%X\r", (int64_t) freq_sent, step);
return kenwood_transaction(rig, buf, buf, strlen(buf));
}
/*
* th_get_freq
* Assumes rig!=NULL, freq!=NULL
*/
int
th_get_freq(RIG *rig, vfo_t vfo, freq_t *freq)
{
char buf[20];
int retval, step;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
if (vfo != RIG_VFO_CURR && vfo != rig->state.current_vfo)
{
return kenwood_wrong_vfo(__func__, vfo);
}
*freq = 0;
retval = kenwood_safe_transaction(rig, "FQ", buf, sizeof(buf), 16);
if (retval != RIG_OK)
{
return retval;
}
retval = num_sscanf(buf, "FQ %"SCNfreq",%x", freq, &step);
if (retval != 2)
{
rig_debug(RIG_DEBUG_ERR, "%s: Unexpected reply '%s'\n", __func__, buf);
return -RIG_ERJCTED;
}
return RIG_OK;
}
/*
* th_set_mode
* Assumes rig!=NULL
*/
int
th_set_mode(RIG *rig, vfo_t vfo, rmode_t mode, pbwidth_t width)
{
char kmode, mdbuf[8];
const struct kenwood_priv_caps *priv = (const struct kenwood_priv_caps *)
rig->caps->priv;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
if (vfo != RIG_VFO_CURR && vfo != rig->state.current_vfo)
{
return kenwood_wrong_vfo(__func__, vfo);
}
if (priv->mode_table)
{
kmode = rmode2kenwood(mode, priv->mode_table);
if (kmode < 0)
{
rig_debug(RIG_DEBUG_WARN, "%s: Unsupported Mode value '%s'\n",
__func__, rig_strrmode(mode));
return -RIG_EINVAL;
}
kmode += '0';
}
else
{
switch (mode)
{
case RIG_MODE_FM: kmode = '0'; break; /* TH-D7A(G) modes */
case RIG_MODE_AM: kmode = '1'; break;
default:
rig_debug(RIG_DEBUG_ERR, "%s: unsupported mode %s\n", __func__,
rig_strrmode(mode));
return -RIG_EINVAL;
}
}
SNPRINTF(mdbuf, sizeof(mdbuf), "MD %c", kmode);
return kenwood_transaction(rig, mdbuf, mdbuf, strlen(mdbuf));
}
/*
* th_get_mode
* Assumes rig!=NULL, mode!=NULL
*/
int
th_get_mode(RIG *rig, vfo_t vfo, rmode_t *mode, pbwidth_t *width)
{
char buf[ACKBUF_LEN];
int retval;
const struct kenwood_priv_caps *priv = (const struct kenwood_priv_caps *)
rig->caps->priv;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
if (vfo != RIG_VFO_CURR && vfo != rig->state.current_vfo)
{
return kenwood_wrong_vfo(__func__, vfo);
}
retval = kenwood_safe_transaction(rig, "MD", buf, sizeof(buf), 4);
if (retval != RIG_OK)
{
return retval;
}
if (buf[3] < '0' || buf[3] > '9')
{
rig_debug(RIG_DEBUG_ERR, "%s: Unexpected reply '%s'\n", __func__, buf);
return -RIG_ERJCTED;
}
if (priv->mode_table)
{
*mode = kenwood2rmode(buf[3] - '0', priv->mode_table);
if (*mode == RIG_MODE_NONE)
{
rig_debug(RIG_DEBUG_ERR, "%s: Unsupported Mode (table)value '%c'\n",
__func__, buf[3]);
return -RIG_EINVAL;
}
}
else
{
switch (buf[3])
{
case '0': *mode = RIG_MODE_FM; break; /* TH-D7A(G) modes */
case '1': *mode = RIG_MODE_AM; break;
default:
rig_debug(RIG_DEBUG_ERR, "%s: Unsupported Mode value '%c'\n", __func__, buf[3]);
return -RIG_EINVAL;
}
}
if (width)
{
*width = RIG_PASSBAND_NORMAL;
}
return RIG_OK;
}
/*
* th_set_vfo
* Apply to non-split models: TH-F7, TH-D7
*
* Assumes rig!=NULL
*/
int
th_set_vfo(RIG *rig, vfo_t vfo)
{
int retval;
char cmd[8];
char cmdbuf[8];
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
/* from thf7.c
* The band must be active before selecting VFO or MEM.
* The dilemma is whether MEM should be applied to Band A or Band B.
* Remember, not all bands have the same capability
* TODO: if (RIG_VFO_MEM) query current band with BC, then do appropriate VMC
*/
/* set band */
if (vfo != RIG_VFO_MEM)
{
switch (vfo)
{
case RIG_VFO_A:
case RIG_VFO_VFO:
case RIG_VFO_MAIN:
strncpy(cmd, "BC 0", sizeof(cmd));
break;
case RIG_VFO_B:
case RIG_VFO_SUB:
strncpy(cmd, "BC 1", sizeof(cmd));
break;
default:
return kenwood_wrong_vfo(__func__, vfo);
}
return kenwood_transaction(rig, cmd, cmd, strlen(cmd));
}
/* No "VMC" cmd on THD72A/THD74 */
if (rig->caps->rig_model == RIG_MODEL_THD72A
|| rig->caps->rig_model == RIG_MODEL_THD74)
{
return RIG_OK;
}
/* set vfo */
switch (vfo)
{
case RIG_VFO_A:
case RIG_VFO_VFO:
case RIG_VFO_MAIN:
strncpy(cmd, "VMC 0,0", sizeof(cmd));
break;
case RIG_VFO_B:
case RIG_VFO_SUB:
strncpy(cmd, "VMC 1,0", sizeof(cmd));
break;
case RIG_VFO_MEM:
strncpy(cmd, "BC", sizeof(cmd));
retval = kenwood_transaction(rig, cmd, cmd, 7);
if (retval != RIG_OK)
{
return retval;
}
if (rig->caps->rig_model == RIG_MODEL_THF7E ||
rig->caps->rig_model == RIG_MODEL_THF6A)
{
SNPRINTF(cmd, sizeof(cmd), "VMC %c,1", cmd[3]);
}
else
{
SNPRINTF(cmd, sizeof(cmd), "VMC %c,2", cmd[3]);
}
break;
default:
return kenwood_wrong_vfo(__func__, vfo);
}
return kenwood_transaction(rig, cmd, cmdbuf, strlen(cmd));
}
int
th_get_vfo_char(RIG *rig, vfo_t *vfo, char *vfoch)
{
char cmdbuf[10], buf[10], vfoc;
int retval;
size_t length;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
/* Get VFO band */
retval = kenwood_transaction(rig, "BC", buf, 7);
if (retval != RIG_OK)
{
return retval;
}
length = strlen(buf);
switch (length)
{
case 4: /*original case BC 0*/
vfoc = buf[3];
break;
case 6: /*intended for D700 BC 0,0*/
if ((buf[0] == 'B') && (buf[1] == 'C') && (buf[2] == ' ') && (buf[4] = ','))
{
vfoc = buf[3];
}
else
{
rig_debug(RIG_DEBUG_ERR, "%s: Unexpected answer format '%s'\n", __func__, buf);
return -RIG_EPROTO;
}
break;
default:
rig_debug(RIG_DEBUG_ERR, "%s: Unexpected answer length %d\n", __func__,
(int)length);
return -RIG_EPROTO;
break;
}
switch (vfoc)
{
case '0': *vfo = RIG_VFO_A; break;
case '1': *vfo = RIG_VFO_B; break;
default:
rig_debug(RIG_DEBUG_ERR, "%s: Unexpected VFO value '%c'\n", __func__, buf[3]);
return -RIG_EVFO;
}
/* No "VMC" on THD72A/THD74 */
if (rig->caps->rig_model == RIG_MODEL_THD72A
|| rig->caps->rig_model == RIG_MODEL_THD74)
{
*vfoch = '0'; /* FIXME: fake */
return RIG_OK;
}
/* Get mode of the VFO band */
SNPRINTF(cmdbuf, sizeof(cmdbuf), "VMC %c", vfoc);
retval = kenwood_safe_transaction(rig, cmdbuf, buf, 10, 7);
if (retval != RIG_OK)
{
return retval;
}
*vfoch = buf[6];
return RIG_OK;
}
/*
* th_get_vfo
* Assumes rig!=NULL
*/
int
th_get_vfo(RIG *rig, vfo_t *vfo)
{
char vfoch;
int retval;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
retval = th_get_vfo_char(rig, vfo, &vfoch);
if (retval != RIG_OK)
{
return retval;
}
switch (vfoch)
{
case '0' :
case '1' :
break;
case '2' :
*vfo = RIG_VFO_MEM;
break;
default:
rig_debug(RIG_DEBUG_ERR, "%s: Unexpected VFO value '%c'\n", __func__, vfoch);
return -RIG_EVFO;
}
return RIG_OK;
}
/*
* tm_set_vfo_bc2
* Apply to split-capable models (with BC command taking 2 args): TM-V7, TM-D700
*
* Assumes rig!=NULL
*/
int tm_set_vfo_bc2(RIG *rig, vfo_t vfo)
{
struct kenwood_priv_data *priv = rig->state.priv;
char cmd[16];
int vfonum, txvfonum, vfomode = 0;
int retval;
rig_debug(RIG_DEBUG_TRACE, "%s: called %s\n", __func__, rig_strvfo(vfo));
switch (vfo)
{
case RIG_VFO_A:
case RIG_VFO_VFO:
vfonum = 0;
/* put back split mode when toggling */
txvfonum = (priv->split == RIG_SPLIT_ON &&
rig->state.tx_vfo == RIG_VFO_B) ? 1 : vfonum;
break;
case RIG_VFO_B:
vfonum = 1;
/* put back split mode when toggling */
txvfonum = (priv->split == RIG_SPLIT_ON &&
rig->state.tx_vfo == RIG_VFO_A) ? 0 : vfonum;
break;
case RIG_VFO_MEM:
/* get current band */
SNPRINTF(cmd, sizeof(cmd), "BC");
retval = kenwood_transaction(rig, cmd, cmd, 7);
if (retval != RIG_OK)
{
return retval;
}
txvfonum = vfonum = cmd[3] - '0';
vfomode = 2;
break;
default:
rig_debug(RIG_DEBUG_ERR, "%s: Unsupported VFO %d\n", __func__, vfo);
return -RIG_EVFO;
}
SNPRINTF(cmd, sizeof(cmd), "VMC %d,%d", vfonum, vfomode);
retval = kenwood_transaction(rig, cmd, cmd, 8);
if (retval != RIG_OK)
{
return retval;
}
if (vfo == RIG_VFO_MEM)
{
return RIG_OK;
}
SNPRINTF(cmd, sizeof(cmd), "BC %d,%d", vfonum, txvfonum);
return kenwood_transaction(rig, cmd, cmd, 7);
}
int th_set_split_vfo(RIG *rig, vfo_t vfo, split_t split, vfo_t txvfo)
{
struct kenwood_priv_data *priv = rig->state.priv;
char vfobuf[16];
int vfonum, txvfonum;
int retval;
rig_debug(RIG_DEBUG_TRACE, "%s: called %s\n", __func__, rig_strvfo(vfo));
if (vfo == RIG_VFO_CURR)
{
retval = rig_get_vfo(rig, &vfo);
if (retval != RIG_OK)
{
return retval;
}
}
switch (vfo)
{
case RIG_VFO_A:
case RIG_VFO_VFO:
vfonum = 0;
if (split == RIG_SPLIT_ON && txvfo != RIG_VFO_B)
{
return -RIG_EINVAL;
}
txvfonum = split == RIG_SPLIT_ON ? 1 : vfonum;
break;
case RIG_VFO_B:
vfonum = 1;
if (split == RIG_SPLIT_ON && txvfo != RIG_VFO_A)
{
return -RIG_EINVAL;
}
txvfonum = split == RIG_SPLIT_ON ? 0 : vfonum;
break;
default:
return -RIG_EINVAL;
}
/* Set VFO mode. To be done for TX vfo also? */
SNPRINTF(vfobuf, sizeof(vfobuf), "VMC %d,0", vfonum);
retval = kenwood_transaction(rig, vfobuf, vfobuf, strlen(vfobuf));
if (retval != RIG_OK)
{
return retval;
}
SNPRINTF(vfobuf, sizeof(vfobuf), "BC %d,%d", vfonum, txvfonum);
retval = kenwood_transaction(rig, vfobuf, vfobuf, 7);
if (retval != RIG_OK)
{
return retval;
}
/* Remember whether split is on, for th_set_vfo */
priv->split = split;
return RIG_OK;
}
int th_get_split_vfo(RIG *rig, vfo_t vfo, split_t *split, vfo_t *txvfo)
{
struct kenwood_priv_data *priv = rig->state.priv;
char buf[10];
int retval;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
/* Get VFO band */
retval = kenwood_safe_transaction(rig, "BC", buf, 10, 6);
if (retval != RIG_OK)
{
return retval;
}
switch (buf[5])
{
case '0': *txvfo = RIG_VFO_A; break;
case '1': *txvfo = RIG_VFO_B; break;
default:
rig_debug(RIG_DEBUG_ERR, "%s: Unexpected txVFO value '%c'\n", __func__, buf[5]);
return -RIG_EPROTO;
}
*split = (buf[3] == buf[5]) ? RIG_SPLIT_OFF : RIG_SPLIT_ON;
/* Remember whether split is on, for th_set_vfo */
priv->split = *split;
return RIG_OK;
}
/*
* th_set_trn
* Assumes rig!=NULL
*/
int
th_set_trn(RIG *rig, int trn)
{
char buf[5];
SNPRINTF(buf, sizeof(buf), "AI %c", RIG_TRN_RIG == trn ? '1' : '0');
return kenwood_transaction(rig, buf, buf, strlen(buf));
}
/*
* th_get_trn
* Assumes rig!=NULL
*/
int
th_get_trn(RIG *rig, int *trn)
{
char buf[ACKBUF_LEN];
int retval;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
retval = kenwood_transaction(rig, "AI", buf, 5);
if (retval != RIG_OK)
{
return retval;
}
if (strlen(buf) != 3)
{
rig_debug(RIG_DEBUG_ERR, "%s: Unexpected reply '%s'\n", __func__, buf);
return -RIG_ERJCTED;
}
*trn = (buf[2] != '0') ? RIG_TRN_RIG : RIG_TRN_OFF;
return RIG_OK;
}
/*
* th_get_kenwood_func
* Assumes rig!=NULL, status!=NULL
*/
static int
th_get_kenwood_func(RIG *rig, const char *cmd, int *status)
{
char buf[8];
int retval, len, expected;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
len = strlen(cmd);
expected = len + 2;
retval = kenwood_safe_transaction(rig, cmd, buf, sizeof(buf), expected);
if (retval != RIG_OK)
{
return retval;
}
if (status)
{
*status = (buf[len + 1] == '0') ? 0 : 1;
}
return RIG_OK;
};
/*
* th_get_func
* Assumes rig!=NULL, status!=NULL
*
* Assumes vfo == RIG_VFO_CURR, any other value is handled by the frontend.
*/
int
th_get_func(RIG *rig, vfo_t vfo, setting_t func, int *status)
{
rig_debug(RIG_DEBUG_TRACE, "%s: called %s\n", __func__, rig_strfunc(func));
switch (func)
{
case RIG_FUNC_MUTE:
return th_get_kenwood_func(rig, "MUTE", status);
case RIG_FUNC_MON:
return th_get_kenwood_func(rig, "MON", status);
case RIG_FUNC_TONE:
return th_get_kenwood_func(rig, "TO", status);
case RIG_FUNC_TSQL:
return th_get_kenwood_func(rig, "CT", status);
case RIG_FUNC_REV:
return th_get_kenwood_func(rig, "REV", status);
case RIG_FUNC_ARO:
return th_get_kenwood_func(rig, "ARO", status);
case RIG_FUNC_AIP:
return th_get_kenwood_func(rig, "AIP", status);
case RIG_FUNC_LOCK:
return th_get_kenwood_func(rig, "LK", status);
case RIG_FUNC_BC:
return th_get_kenwood_func(rig, "BC", status);
default:
rig_debug(RIG_DEBUG_ERR, "%s: Unsupported function %s\n",
__func__, rig_strfunc(func));
return -RIG_EINVAL;
}
}
static int th_tburst(RIG *rig, vfo_t vfo, int status)
{
return kenwood_transaction(rig, (status == 1) ? "TT" : "RX", NULL, 0);
}
/*
* th_set_kenwood_func
* Assumes rig!=NULL, status!=NULL
*/
static int th_set_kenwood_func(RIG *rig, const char *cmd, int status)
{
#define BUFSZ 16
char buf[BUFSZ];
rig_debug(RIG_DEBUG_TRACE, "%s: cmd = %s, status = %d\n",
__func__, cmd, status);
strncpy(buf, cmd, BUFSZ - 2);
buf[BUFSZ - 1] = '\0';
strncat(buf, status ? " 1" : " 0", BUFSZ - 1);
return kenwood_transaction(rig, buf, NULL, 0);
}
/*
* th_get_func
* Assumes rig!=NULL, status!=NULL
*
* Assumes vfo == RIG_VFO_CURR, any other value is handled by the frontend.
*/
int
th_set_func(RIG *rig, vfo_t vfo, setting_t func, int status)
{
rig_debug(RIG_DEBUG_TRACE, "%s: called %s\n", __func__, rig_strfunc(func));
switch (func)
{
case RIG_FUNC_MUTE:
return th_set_kenwood_func(rig, "MUTE", status);
case RIG_FUNC_MON:
return th_set_kenwood_func(rig, "MON", status);
case RIG_FUNC_TONE:
return th_set_kenwood_func(rig, "TO", status);
case RIG_FUNC_TSQL:
return th_set_kenwood_func(rig, "CT", status);
case RIG_FUNC_REV:
return th_set_kenwood_func(rig, "REV", status);
case RIG_FUNC_ARO:
return th_set_kenwood_func(rig, "ARO", status);
case RIG_FUNC_AIP:
return th_set_kenwood_func(rig, "AIP", status);
case RIG_FUNC_LOCK:
return th_set_kenwood_func(rig, "LK", status);
case RIG_FUNC_BC:
return th_set_kenwood_func(rig, "NSFT", status);
case RIG_FUNC_TBURST:
return th_tburst(rig, vfo, status);
default:
rig_debug(RIG_DEBUG_ERR, "%s: Unsupported function %s\n", __func__,
rig_strfunc(func));
return -RIG_EINVAL;
}
return RIG_OK;
}
int
th_scan(RIG *rig, vfo_t vfo, scan_t scan, int ch)
{
rig_debug(RIG_DEBUG_TRACE, "%s: called (0x%04x)\n", __func__, scan);
return th_set_kenwood_func(rig, "SC", scan == RIG_SCAN_STOP ? 0 : 1);
}
/*
* th_get_parm
* Assumes rig!=NULL, status!=NULL
*/
int
th_get_parm(RIG *rig, setting_t parm, value_t *val)
{
char buf[16];
int ret, status;
rig_debug(RIG_DEBUG_TRACE, "%s: called %s\n", __func__, rig_strparm(parm));
switch (parm)
{
case RIG_PARM_BEEP:
ret = th_get_kenwood_func(rig, "BEP", &status);
if (ret != RIG_OK)
{
return ret;
}
val->i = status ? 1 : 0;
return RIG_OK;
case RIG_PARM_APO:
ret = kenwood_safe_transaction(rig, "APO", buf, sizeof(buf), 5);
if (ret != RIG_OK)
{
return ret;
}
val->i = (buf[4] - '0') * 30;
return RIG_OK;
case RIG_PARM_BACKLIGHT:
if (rig->caps->rig_model == RIG_MODEL_TMD700)
{
ret = kenwood_safe_transaction(rig, "DIM", buf, sizeof(buf), 4);
if (ret != RIG_OK)
{
return ret;
}
val->f = buf[4] == '0' ? 0 : (float)(5 - (buf[4] - '0')) / 4.;
}
else
{
ret = th_get_kenwood_func(rig, "LMP", &status);
if (ret != RIG_OK)
{
return ret;
}
val->f = status ? 1.0 : 0;
}
return RIG_OK;
default:
rig_debug(RIG_DEBUG_ERR, "%s: Unsupported parm %s\n", __func__,
rig_strparm(parm));
return -RIG_EINVAL;
}
return RIG_OK;
}
int
th_set_parm(RIG *rig, setting_t parm, value_t val)
{
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
switch (parm)
{
case RIG_PARM_BACKLIGHT:
if (rig->caps->rig_model == RIG_MODEL_TMD700)
{
return th_set_kenwood_func(rig, "DIM", (val.f > 0) ? 1 : 0); /* FIXME */
}
else
{
return th_set_kenwood_func(rig, "LMP", (val.f > 0) ? 1 : 0);
}
case RIG_PARM_BEEP:
return th_set_kenwood_func(rig, "BEP", val.i);
case RIG_PARM_APO:
if (val.i > 30)
{
return kenwood_transaction(rig, "APO 2", NULL, 0);
}
else if (val.i > 0)
{
return kenwood_transaction(rig, "APO 1", NULL, 0);
}
else
{
return kenwood_transaction(rig, "APO 0", NULL, 0);
}
default:
rig_debug(RIG_DEBUG_ERR, "%s: Unsupported parm %s\n", __func__,
rig_strparm(parm));
return -RIG_EINVAL;
}
return RIG_OK;
}
/*
* th_get_level
* Assumes rig!=NULL, val!=NULL
*/
int
th_get_level(RIG *rig, vfo_t vfo, setting_t level, value_t *val)
{
char vch, buf[10], ackbuf[20];
int retval, v;
unsigned int l;
vfo_t tvfo;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
tvfo = (vfo == RIG_VFO_CURR) ? rig->state.current_vfo : vfo;
switch (tvfo)
{
case RIG_VFO_A:
case RIG_VFO_VFO:
case RIG_VFO_MEM:
vch = '0'; break;
case RIG_VFO_B:
vch = '1'; break;
default:
return kenwood_wrong_vfo(__func__, vfo);
}
switch (level)
{
case RIG_LEVEL_RAWSTR:
SNPRINTF(buf, sizeof(buf), "SM %c", vch);
// XXX use kenwood_safe_transaction
retval = kenwood_transaction(rig, buf, ackbuf, sizeof(ackbuf));
if (retval != RIG_OK)
{
return retval;
}
retval = sscanf(ackbuf, "SM %d,%u", &v, &l);
if (retval != 2 || l < rig->caps->level_gran[LVL_RAWSTR].min.i
|| l > rig->caps->level_gran[LVL_RAWSTR].max.i)
{
rig_debug(RIG_DEBUG_ERR, "%s: Unexpected reply '%s'\n", __func__, ackbuf);
return -RIG_ERJCTED;
}
val->i = l;
break;
case RIG_LEVEL_SQL:
SNPRINTF(buf, sizeof(buf), "SQ %c", vch);
retval = kenwood_safe_transaction(rig, buf, ackbuf, 10, 7);
if (retval != RIG_OK)
{
return retval;
}
retval = sscanf(ackbuf, "SQ %d,%x", &v, &l);
if (retval != 2 || l < rig->caps->level_gran[LVL_SQL].min.i
|| l > rig->caps->level_gran[LVL_SQL].max.i)
{
rig_debug(RIG_DEBUG_ERR, "%s: Unexpected reply '%s'\n", __func__, ackbuf);
return -RIG_ERJCTED;
}
/* range [0.0 ... 1.0] */
val->f = (float)(l - rig->caps->level_gran[LVL_SQL].min.i) /
(float)(rig->caps->level_gran[LVL_SQL].max.i -
rig->caps->level_gran[LVL_SQL].min.i);
break;
case RIG_LEVEL_AF:
SNPRINTF(buf, sizeof(buf), "AG %c", vch);
retval = kenwood_transaction(rig, buf, ackbuf, sizeof(ackbuf));
if (retval != RIG_OK)
{
return retval;
}
retval = sscanf(ackbuf, "AG %d,%x", &v, &l);
if (retval != 2 || l < rig->caps->level_gran[LVL_AF].min.i
|| l > rig->caps->level_gran[LVL_AF].max.i)
{
rig_debug(RIG_DEBUG_ERR, "%s: Unexpected reply '%s'\n", __func__, ackbuf);
return -RIG_ERJCTED;
}
/* range [0.0 ... 1.0] */
val->f = (float)(l - rig->caps->level_gran[LVL_AF].min.i) /
(float)(rig->caps->level_gran[LVL_AF].max.i -
rig->caps->level_gran[LVL_AF].min.i);
break;
case RIG_LEVEL_RFPOWER:
SNPRINTF(buf, sizeof(buf), "PC %c", vch);
retval = kenwood_transaction(rig, buf, ackbuf, sizeof(ackbuf));
if (retval != RIG_OK)
{
return retval;
}
retval = sscanf(ackbuf, "PC %d,%u", &v, &l);
if ((retval != 2) || l > 3)
{
rig_debug(RIG_DEBUG_ERR, "%s: Unexpected reply '%s'\n", __func__, ackbuf);
return -RIG_ERJCTED;
}
/* range [0.0 ... 1.0] */
val->f = (float)(l - rig->caps->level_gran[LVL_RFPOWER].min.i) /
(float)(rig->caps->level_gran[LVL_RFPOWER].max.i -
rig->caps->level_gran[LVL_RFPOWER].min.i);
break;
case RIG_LEVEL_BALANCE:
retval = kenwood_safe_transaction(rig, "BAL", ackbuf, 10, 5);
if (retval != RIG_OK)
{
return retval;
}
if (ackbuf[4] < '0' || ackbuf[4] > '9')
{
return -RIG_EPROTO;
}
val->f = (float)('4' - ackbuf[4]) / ('4' - '0');
break;
case RIG_LEVEL_ATT:
retval = kenwood_safe_transaction(rig, "ATT", ackbuf, 10, 5);
if (retval != RIG_OK)
{
return retval;
}
if (ackbuf[4] < '0' || ackbuf[4] > '9')
{
return -RIG_EPROTO;
}
if (ackbuf[4] == '0')
{
val->i = 0;
}
else
{
val->i = rig->state.attenuator[ackbuf[4] - '1'];
}
break;
case RIG_LEVEL_VOXGAIN:
retval = kenwood_safe_transaction(rig, "VXG", ackbuf, 10, 5);
if (retval != RIG_OK)
{
return retval;
}
if (ackbuf[4] < '0' || ackbuf[4] > '9')
{
return -RIG_EPROTO;
}
val->f = (ackbuf[4] == '0') / 9;
break;
case RIG_LEVEL_VOXDELAY: /* "VXD" */
return -RIG_ENIMPL;
default:
rig_debug(RIG_DEBUG_ERR, "%s: unsupported level %s\n", __func__,
rig_strlevel(level));
return -RIG_EINVAL;
}
return RIG_OK;
}
int th_set_level(RIG *rig, vfo_t vfo, setting_t level, value_t val)
{
char vch, buf[12];
vfo_t tvfo;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
tvfo = (vfo == RIG_VFO_CURR) ? rig->state.current_vfo : vfo;
switch (tvfo)
{
case RIG_VFO_A:
case RIG_VFO_VFO:
case RIG_VFO_MEM:
vch = '0';
break;
case RIG_VFO_B:
vch = '1';
break;
default:
return kenwood_wrong_vfo(__func__, vfo);
}
switch (level)
{
case RIG_LEVEL_RFPOWER :
SNPRINTF(buf, sizeof(buf), "PC %c,%01d", vch,
(int)(val.f * (rig->caps->level_gran[LVL_RFPOWER].max.i -
rig->caps->level_gran[LVL_RFPOWER].min.i))
+ rig->caps->level_gran[LVL_RFPOWER].min.i);
return kenwood_transaction(rig, buf, NULL, 0);
case RIG_LEVEL_SQL :
SNPRINTF(buf, sizeof(buf), "SQ %c,%02x", vch,
(int)(val.f * (rig->caps->level_gran[LVL_SQL].max.i -
rig->caps->level_gran[LVL_SQL].min.i))
+ rig->caps->level_gran[LVL_SQL].min.i);
return kenwood_transaction(rig, buf, NULL, 0);
case RIG_LEVEL_AF :
SNPRINTF(buf, sizeof(buf), "AG %c,%02x", vch, (int)(val.f * 32.0));
return kenwood_transaction(rig, buf, NULL, 0);
case RIG_LEVEL_ATT :
SNPRINTF(buf, sizeof(buf), "ATT %c", val.i ? '1' : '0');
return kenwood_transaction(rig, buf, NULL, 0);
case RIG_LEVEL_BALANCE :
SNPRINTF(buf, sizeof(buf), "BAL %c", '4' - (int)(val.f * ('4' - '0')));
return kenwood_transaction(rig, buf, NULL, 0);
case RIG_LEVEL_VOXGAIN:
SNPRINTF(buf, sizeof(buf), "VXG %d", (int)(val.f * 9));
return kenwood_transaction(rig, buf, NULL, 0);
case RIG_LEVEL_VOXDELAY: /* "VXD" */
return -RIG_ENIMPL;
default:
rig_debug(RIG_DEBUG_ERR, "%s: unsupported level %s\n", __func__,
rig_strlevel(level));
return -RIG_EINVAL;
}
}
#ifndef RIG_TONEMAX
#define RIG_TONEMAX 38
#endif
/*
* th_set_ctcss_tone
* Assumes rig!=NULL, rig->caps->ctcss_list != NULL
*/
int
th_set_ctcss_tone(RIG *rig, vfo_t vfo, tone_t tone)
{
const struct rig_caps *caps;
char tonebuf[16];
int i;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
caps = rig->caps;
for (i = 0; caps->ctcss_list[i] != 0; i++)
{
if (caps->ctcss_list[i] == tone)
{
break;
}
}
if (caps->ctcss_list[i] != tone)
{
return -RIG_EINVAL;
}
i += (i == 0) ? 1 : 2; /* Correct for TH-D7A index anomaly */
SNPRINTF(tonebuf, sizeof(tonebuf), "TN %02d", i);
return kenwood_transaction(rig, tonebuf, tonebuf, sizeof(tonebuf));
}
/*
* th_get_ctcss_tone
* Assumes rig!=NULL, rig->caps!=NULL
*/
int
th_get_ctcss_tone(RIG *rig, vfo_t vfo, tone_t *tone)
{
struct rig_caps *caps;
char buf[ACKBUF_LEN];
int retval;
unsigned int tone_idx;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
caps = rig->caps;
retval = kenwood_transaction(rig, "TN", buf, sizeof(buf));
if (retval != RIG_OK)
{
return retval;
}
retval = sscanf(buf, "TN %d", (int *)&tone_idx);
if (retval != 1)
{
rig_debug(RIG_DEBUG_ERR,
"%s: Unexpected reply '%s'\n", __func__, buf);
return -RIG_EPROTO;
}
/* verify tone index for TH-7DA rig */
if (tone_idx == 0 || tone_idx == 2 || tone_idx > 39)
{
rig_debug(RIG_DEBUG_ERR, "%s: Unexpected CTCSS tone no (%04d)\n",
__func__, tone_idx);
return -RIG_EPROTO;
}
tone_idx -= (tone_idx == 1) ? 1 : 2; /* Correct for TH-D7A index anomaly */
*tone = caps->ctcss_list[tone_idx];
return RIG_OK;
}
/*
* th_set_ctcss_sql
* Assumes rig!=NULL, rig->caps->ctcss_list != NULL
*/
int
th_set_ctcss_sql(RIG *rig, vfo_t vfo, tone_t tone)
{
const struct rig_caps *caps;
char tonebuf[16];
int i;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
caps = rig->caps;
for (i = 0; caps->ctcss_list[i] != 0; i++)
{
if (caps->ctcss_list[i] == tone)
{
break;
}
}
if (caps->ctcss_list[i] != tone)
{
return -RIG_EINVAL;
}
i += (i == 0) ? 1 : 2; /* Correct for TH-D7A index anomaly */
SNPRINTF(tonebuf, sizeof(tonebuf), "CTN %02d", i);
return kenwood_transaction(rig, tonebuf, tonebuf, sizeof(tonebuf));
}
/*
* thd7_get_ctcss_sql
* Assumes rig!=NULL, rig->caps!=NULL
*/
int
th_get_ctcss_sql(RIG *rig, vfo_t vfo, tone_t *tone)
{
struct rig_caps *caps;
char buf[ACKBUF_LEN];
int retval;
unsigned int tone_idx;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
caps = rig->caps;
retval = kenwood_transaction(rig, "CTN", buf, sizeof(buf));
if (retval != RIG_OK)
{
return retval;
}
retval = sscanf(buf, "CTN %d", (int *)&tone_idx);
if (retval != 1)
{
rig_debug(RIG_DEBUG_ERR,
"%s: Unexpected reply '%s'\n", __func__, buf);
return -RIG_EPROTO;
}
/* verify tone index for TH-7DA rig */
if (tone_idx == 0 || tone_idx == 2 || tone_idx > 39)
{
rig_debug(RIG_DEBUG_ERR, "%s: Unexpected CTCSS no (%04d)\n",
__func__, tone_idx);
return -RIG_EPROTO;
}
tone_idx -= (tone_idx == 1) ? 1 : 2; /* Correct for TH-7DA index anomaly */
*tone = caps->ctcss_list[tone_idx];
return RIG_OK;
}
#ifndef RIG_CODEMAX
#define RIG_CODEMAX 104
#endif
/*
* th_set_dcs_sql
* Assumes rig!=NULL, rig->caps->dcs_list != NULL
*/
int
th_set_dcs_sql(RIG *rig, vfo_t vfo, tone_t code)
{
const struct rig_caps *caps;
char codebuf[16];
int i, retval;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
caps = rig->caps;
if (code == 0)
{
SNPRINTF(codebuf, sizeof(codebuf), "DCS 0");
return kenwood_transaction(rig, codebuf, codebuf, sizeof(codebuf));
}
for (i = 0; caps->dcs_list[i] != 0; i++)
{
if (caps->dcs_list[i] == code)
{
break;
}
}
if (caps->dcs_list[i] != code)
{
return -RIG_EINVAL;
}
SNPRINTF(codebuf, sizeof(codebuf), "DCS 1");
if ((retval = kenwood_transaction(rig, codebuf, codebuf,
sizeof(codebuf))) != RIG_OK)
{
return retval;
}
SNPRINTF(codebuf, sizeof(codebuf), "DCSN %04d", (i + 1) * 10);
return kenwood_transaction(rig, codebuf, codebuf, sizeof(codebuf));
}
/*
* th_get_dcs_sql
* Assumes rig!=NULL, rig->caps!=NULL
*/
int
th_get_dcs_sql(RIG *rig, vfo_t vfo, tone_t *code)
{
struct rig_caps *caps;
char buf[ACKBUF_LEN];
int retval;
unsigned int code_idx;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
caps = rig->caps;
retval = kenwood_transaction(rig, "DCS", buf, sizeof(buf));
if (retval != RIG_OK)
{
return retval;
}
retval = sscanf(buf, "DCSN %d", (int *)&code_idx);
if (retval != 1)
{
rig_debug(RIG_DEBUG_ERR,
"%s: Unexpected reply '%s'\n", __func__, buf);
return -RIG_EPROTO;
}
if (code_idx == 0)
{
*code = 0; /* disabled */
return RIG_OK;
}
retval = kenwood_transaction(rig, "DCSN", buf, sizeof(buf));
if (retval != RIG_OK)
{
return retval;
}
retval = sscanf(buf, "DCSN %d", (int *)&code_idx);
if (retval != 1)
{
rig_debug(RIG_DEBUG_ERR,
"%s: Unexpected reply '%s'\n", __func__, buf);
return -RIG_EPROTO;
}
/* verify code index for TM-D700 rig */
if (code_idx <= 10 || code_idx > 1040)
{
rig_debug(RIG_DEBUG_ERR, "%s: Unexpected DCS no (%04u)\n",
__func__, code_idx);
return -RIG_EPROTO;
}
code_idx = (code_idx / 10) - 1;
*code = caps->dcs_list[code_idx];
return RIG_OK;
}
const char *
th_get_info(RIG *rig)
{
static char firmbuf[50];
int retval;
size_t firm_len;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
retval = kenwood_transaction(rig, "ID", firmbuf, sizeof(firmbuf));
if (retval != RIG_OK)
{
return NULL;
}
firm_len = strlen(firmbuf);
if (firm_len < 3)
{
rig_debug(RIG_DEBUG_ERR, "%s: unexpected reply '%s', len=%d\n",
__func__, firmbuf, (int)firm_len);
return NULL;
}
return &firmbuf[2];
}
/*
* th_set_mem
* Assumes rig!=NULL
*/
int
th_set_mem(RIG *rig, vfo_t vfo, int ch)
{
unsigned char vsel;
char membuf[10];
int retval;
vfo_t tvfo;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
tvfo = (vfo == RIG_VFO_CURR) ? rig->state.current_vfo : vfo;
switch (tvfo)
{
case RIG_VFO_VFO:
case RIG_VFO_MEM:
case RIG_VFO_A:
vsel = '0';
break;
case RIG_VFO_B:
vsel = '1';
break;
default:
return kenwood_wrong_vfo(__func__, vfo);
}
if ((retval = rig_set_vfo(rig, RIG_VFO_MEM)) != RIG_OK)
{
return retval;
}
SNPRINTF(membuf, sizeof(membuf), "MC %c,%03i", vsel, ch);
return kenwood_transaction(rig, membuf, membuf, sizeof(membuf));
}
/* Get mem works only when the display is
* in memory mode
*/
int
th_get_mem(RIG *rig, vfo_t vfo, int *ch)
{
char *membuf, buf[10];
int retval;
vfo_t tvfo, cvfo;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
/* store current VFO */
cvfo = rig->state.current_vfo;
/* check if we should switch VFO */
if (cvfo != RIG_VFO_MEM)
{
retval = rig_set_vfo(rig, RIG_VFO_MEM);
if (retval != RIG_OK)
{
return retval;
}
}
tvfo = (vfo == RIG_VFO_CURR) ? cvfo : vfo;
switch (tvfo)
{
case RIG_VFO_VFO:
case RIG_VFO_MEM:
case RIG_VFO_A:
membuf = "MC 0";
break;
case RIG_VFO_B:
membuf = "MC 1";
break;
default:
return kenwood_wrong_vfo(__func__, vfo);
}
retval = kenwood_safe_transaction(rig, membuf, buf, 10, 8);
if (retval != RIG_OK)
{
return retval;
}
*ch = atoi(&buf[5]);
/* switch back if appropriate */
if (cvfo != RIG_VFO_MEM)
{
retval = rig_set_vfo(rig, cvfo);
if (retval != RIG_OK)
{
return retval;
}
}
return RIG_OK;
}
int
th_set_ptt(RIG *rig, vfo_t vfo, ptt_t ptt)
{
char buf[3];
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
return kenwood_transaction(rig, (ptt == RIG_PTT_ON) ? "TX" : "RX", buf,
sizeof(buf));
}
int th_get_dcd(RIG *rig, vfo_t vfo, dcd_t *dcd)
{
char *cmd, buf[8];
int retval;
if (vfo == RIG_VFO_CURR)
{
retval = th_get_vfo(rig, &vfo);
if (retval != RIG_OK)
{
return retval;
}
}
switch (vfo)
{
case RIG_VFO_VFO:
case RIG_VFO_A:
case RIG_VFO_MAIN:
cmd = "BY 0";
break;
case RIG_VFO_B:
case RIG_VFO_SUB:
cmd = "BY 1";
break;
default:
return kenwood_wrong_vfo(__func__, vfo);
}
retval = kenwood_safe_transaction(rig, cmd, buf, sizeof(buf), 6);
if (retval != RIG_OK)
{
return retval;
}
switch (buf[5])
{
case '0' :
*dcd = RIG_DCD_OFF;
return RIG_OK;
case '1' :
*dcd = RIG_DCD_ON;
return RIG_OK;
default :
rig_debug(RIG_DEBUG_ERR, "%s: unexpected reply '%s'\n",
__func__, buf);
}
return -RIG_ERJCTED;
}
int th_vfo_op(RIG *rig, vfo_t vfo, vfo_op_t op)
{
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
if (vfo != RIG_VFO_CURR && vfo != rig->state.current_vfo)
{
return kenwood_wrong_vfo(__func__, vfo);
}
switch (op)
{
case RIG_OP_UP:
return kenwood_transaction(rig, "UP", NULL, 0);
case RIG_OP_DOWN:
return kenwood_transaction(rig, "DW", NULL, 0);
case RIG_OP_TO_VFO:
return kenwood_transaction(rig, "MSH", NULL, 0);
default:
return -RIG_EINVAL;
}
}
/* get and set channel tested on thg71&thf7e */
/* must work on other th and tm kenwood rigs */
/* --------------------------------------------------------------------- */
int th_get_channel(RIG *rig, vfo_t vfo, channel_t *chan, int read_only)
{
char membuf[64], ackbuf[ACKBUF_LEN];
int retval;
freq_t freq, offset;
char req[32], scf[128];
int step, shift, rev, tone, ctcss, tonefq, ctcssfq, dcs, dcscode, mode, lockout;
const char *mr_extra;
int channel_num;
vfo_t vfotmp;
const struct kenwood_priv_caps *priv = (const struct kenwood_priv_caps *)
rig->caps->priv;
const chan_t *chan_caps;
if (chan->vfo == RIG_VFO_MEM)
{
chan_caps = rig_lookup_mem_caps(rig, chan->channel_num);
if (!chan_caps)
{
return -RIG_ECONF;
}
}
else
{
/* TODO: stuff channel_num (out of current freq) and chan_caps */
return -RIG_ENIMPL;
}
channel_num = chan->channel_num;
vfotmp = chan->vfo;
memset(chan, 0, sizeof(channel_t));
chan->channel_num = channel_num;
chan->vfo = vfotmp;
if (rig->caps->rig_model == RIG_MODEL_THF7E ||
rig->caps->rig_model == RIG_MODEL_THF6A)
{
mr_extra = "";
}
else
{
mr_extra = "0, ";
}
channel_num -= chan_caps->startc;
switch (chan_caps->type)
{
case RIG_MTYPE_MEM:
if (chan_caps[1].type == RIG_MTYPE_PRIO)
{
/* Info */
SNPRINTF(req, sizeof(req), "MR %s0,I-%01d", mr_extra, channel_num);
}
else
{
SNPRINTF(req, sizeof(req), "MR %s0,%03d", mr_extra, channel_num);
}
break;
case RIG_MTYPE_EDGE:
if (chan_caps[1].type == RIG_MTYPE_EDGE)
{
SNPRINTF(req, sizeof(req), "MR %s0,L%01d", mr_extra, channel_num);
SNPRINTF(chan->channel_desc, sizeof(chan->channel_desc), "L%01d", channel_num);
}
else
{
SNPRINTF(req, sizeof(req), "MR %s0,U%01d", mr_extra, channel_num);
SNPRINTF(chan->channel_desc, sizeof(chan->channel_desc), "U%01d", channel_num);
}
break;
case RIG_MTYPE_PRIO:
if (chan_caps->startc == chan_caps->endc)
{
SNPRINTF(req, sizeof(req), "MR %s0,PR", mr_extra);
SNPRINTF(chan->channel_desc, sizeof(chan->channel_desc), "Pr");
}
else
{
SNPRINTF(req, sizeof(req), "MR %s0,PR%01d", mr_extra, channel_num + 1);
SNPRINTF(chan->channel_desc, sizeof(chan->channel_desc), "Pr%01d",
channel_num + 1);
}
break;
case RIG_MTYPE_CALL:
SNPRINTF(req, sizeof(req), "CR 0,%01d", channel_num);
if (chan->channel_num == chan_caps->startc) { SNPRINTF(chan->channel_desc, sizeof(chan->channel_desc), "Call V"); }
else if (chan->channel_num == chan_caps->endc) { SNPRINTF(chan->channel_desc, sizeof(chan->channel_desc), "Call U"); }
else { SNPRINTF(chan->channel_desc, sizeof(chan->channel_desc), "Call"); }
break;
case RIG_MTYPE_BAND:
SNPRINTF(req, sizeof(req), "VR %01X", channel_num);
SNPRINTF(chan->channel_desc, sizeof(chan->channel_desc), "BAND %01X",
channel_num);
break;
default:
return -RIG_EINVAL;
}
SNPRINTF(membuf, sizeof(membuf), "%s", req);
retval = kenwood_transaction(rig, membuf, ackbuf, sizeof(ackbuf));
if (retval != RIG_OK)
{
return retval;
}
/*
* TODO: dcs/mode/lockout are not there on TH-G71
*/
mode = RIG_MODE_NONE;
rev = lockout = dcs = dcscode = 0;
strcpy(scf, req);
if (chan_caps->mem_caps.dcs_sql)
{
/* Step can be hexa
* Lockout is optional on some channels
*/
strcat(scf, ",%"SCNfreq",%x,%d,%d,%d,%d,%d,%d,%d,%d,%"SCNfreq",%d,%d");
retval = num_sscanf(ackbuf, scf,
&freq, &step, &shift, &rev, &tone,
&ctcss, &dcs, &tonefq, &ctcssfq, &dcscode,
&offset, &mode, &lockout);
if (retval < 12)
{
rig_debug(RIG_DEBUG_WARN, "%s: sscanf failed %d\n", __func__, retval);
return -RIG_EPROTO;
}
}
else
{
strcat(scf, ",%"SCNfreq",%x,%d,%d,%d,%d,,%d,,%d,%"SCNfreq);
retval = num_sscanf(ackbuf, scf,
&freq, &step, &shift, &rev, &tone,
&ctcss, &tonefq, &ctcssfq, &offset);
if (retval != 9)
{
rig_debug(RIG_DEBUG_WARN, "%s: sscanf failed %d\n", __func__, retval);
}
}
chan->funcs = rev ? RIG_FUNC_REV : 0;
chan->flags = lockout ? RIG_CHFLAG_SKIP : 0;
chan->freq = freq;
chan->vfo = RIG_VFO_MEM;
chan->tuning_step = rig->state.tuning_steps[step].ts;
if (priv->mode_table)
{
chan->mode = kenwood2rmode(mode, priv->mode_table);
if (chan->mode == RIG_MODE_NONE)
{
rig_debug(RIG_DEBUG_ERR, "%s: Unsupported Mode value '%d'\n",
__func__, mode);
return -RIG_EPROTO;
}
}
else
{
/* No mode info (TH-G71, TMV7,..),
* guess it from current freq
*/
chan->mode = (freq < MHz(136)) ? RIG_MODE_AM : RIG_MODE_FM;
}
chan->width = rig_passband_normal(rig, chan->mode);
switch (shift)
{
case 0 :
chan->rptr_shift = RIG_RPT_SHIFT_NONE;
break;
case 1 :
chan->rptr_shift = RIG_RPT_SHIFT_PLUS;
break;
case 2 :
chan->rptr_shift = RIG_RPT_SHIFT_MINUS;
offset = -offset;
break;
default:
rig_debug(RIG_DEBUG_ERR, "%s: not supported shift %d\n",
__func__, shift);
chan->rptr_shift = RIG_RPT_SHIFT_NONE;
}
chan->rptr_offs = offset;
/* FIXME: ctcss_list for t[fm]*.c */
//chan->ctcss_tone=rig->caps->ctcss_list[tonefq==1?0:tonefq-2];
// chan->ctcss_sql=rig->caps->ctcss_list[ctcssfq==1?0:ctcssfq-2];
if (tone)
{
chan->ctcss_tone = rig->caps->ctcss_list[tonefq];
}
else
{
chan->ctcss_tone = 0;
}
if (ctcss)
{
chan->ctcss_sql = rig->caps->ctcss_list[ctcssfq];
}
else
{
chan->ctcss_sql = 0;
}
if (dcs)
{
chan->dcs_sql = chan->dcs_code = rig->caps->dcs_list[dcscode];
}
else
{
chan->dcs_sql = chan->dcs_code = 0;
}
chan->tx_freq = RIG_FREQ_NONE;
if (shift == RIG_RPT_SHIFT_NONE &&
((chan_caps->type == RIG_MTYPE_MEM && chan_caps->startc == 0) ||
chan_caps->type == RIG_MTYPE_CALL))
{
/* split ? */
req[3 + strlen(mr_extra)] = '1';
SNPRINTF(membuf, sizeof(membuf), "%s", req);
retval = kenwood_transaction(rig, membuf, ackbuf, sizeof(ackbuf));
if (retval == RIG_OK)
{
strcpy(scf, req);
strcat(scf, ",%"SCNfreq",%x");
retval = num_sscanf(ackbuf, scf, &freq, &step);
chan->tx_freq = freq;
chan->split = RIG_SPLIT_ON;
}
}
/* If not set already by special channels.. */
if (chan->channel_desc[0] == '\0')
{
size_t ack_len;
if (chan_caps[1].type == RIG_MTYPE_PRIO)
{
SNPRINTF(membuf, sizeof(membuf), "MNA %sI-%01d", mr_extra, channel_num);
}
else
{
SNPRINTF(membuf, sizeof(membuf), "MNA %s%03d", mr_extra, channel_num);
}
/* Get memory name */
retval = kenwood_transaction(rig, membuf, ackbuf, sizeof(ackbuf));
if (retval != RIG_OK)
{
return retval;
}
ack_len = strlen(ackbuf);
if (ack_len > rig->caps->chan_desc_sz)
{
ack_len = rig->caps->chan_desc_sz;
}
strncpy(chan->channel_desc, ackbuf + strlen(membuf) + 1, ack_len);
chan->channel_desc[ack_len] = '\0';
}
if (!read_only)
{
// Set rig to channel values
rig_debug(RIG_DEBUG_ERR,
"%s: please contact hamlib mailing list to implement this\n", __func__);
rig_debug(RIG_DEBUG_ERR,
"%s: need to know if rig updates when channel read or not\n", __func__);
return -RIG_ENIMPL;
}
return RIG_OK;
}
static int find_tone_index(const tone_t *tone_list, tone_t tone)
{
int i;
for (i = 0; tone_list[i] != 0; i++)
{
if (tone_list[i] == tone)
{
return i;
}
}
return -1;
}
/* --------------------------------------------------------------------- */
int th_set_channel(RIG *rig, vfo_t vfo, const channel_t *chan)
{
char membuf[256];
int retval;
char req[64];
char lockoutstr[8];
int channel_num, step, shift, rev, tone, ctcss, tonefq, ctcssfq, dcs, dcscode,
lockout;
const char *mr_extra;
const struct kenwood_priv_caps *priv = (const struct kenwood_priv_caps *)
rig->caps->priv;
const chan_t *chan_caps;
const char *channel_desc;
channel_num = chan->channel_num;
for (step = 0; rig->state.tuning_steps[step].ts != 0; step++)
if (chan->tuning_step <= rig->state.tuning_steps[step].ts)
{
break;
}
switch (chan->rptr_shift)
{
case RIG_RPT_SHIFT_NONE :
shift = 0;
break;
case RIG_RPT_SHIFT_PLUS:
shift = 1;
break;
case RIG_RPT_SHIFT_MINUS:
shift = 2;
break;
default:
rig_debug(RIG_DEBUG_ERR, "%s: not supported shift %d\n",
__func__, chan->rptr_shift);
return -RIG_EINVAL;
}
if (chan->ctcss_tone == 0)
{
tone = 0;
tonefq = 8;
}
else
{
tone = 1;
tonefq = find_tone_index(rig->caps->ctcss_list, chan->ctcss_tone);
if (tonefq == -1)
{
return -RIG_EINVAL;
}
tonefq++;
}
if (chan->ctcss_sql == 0)
{
ctcss = 0;
ctcssfq = 8;
}
else
{
ctcss = 1;
ctcssfq = find_tone_index(rig->caps->ctcss_list, chan->ctcss_sql);
if (tonefq == -1)
{
return -RIG_EINVAL;
}
ctcssfq++;
}
if (chan->dcs_code == 0 && chan->dcs_sql == 0)
{
dcs = 0;
dcscode = 0;
}
else
{
dcs = 1;
dcscode = find_tone_index(rig->caps->dcs_list, chan->dcs_sql);
if (dcscode == -1)
{
return -RIG_EINVAL;
}
}
if (chan->vfo == RIG_VFO_MEM)
{
chan_caps = rig_lookup_mem_caps(rig, chan->channel_num);
if (!chan_caps)
{
return -RIG_ECONF;
}
channel_num -= chan_caps->startc;
}
else
{
return -RIG_ENIMPL;
}
if (rig->caps->rig_model == RIG_MODEL_THF7E ||
rig->caps->rig_model == RIG_MODEL_THF6A)
{
mr_extra = "";
}
else
{
mr_extra = "0, ";
}
channel_desc = NULL;
switch (chan_caps->type)
{
case RIG_MTYPE_MEM:
if (chan_caps[1].type == RIG_MTYPE_PRIO)
{
/* Info */
SNPRINTF(req, sizeof(req), "MW %s0,I-%01d", mr_extra, channel_num);
channel_desc = chan->channel_desc;
}
else
{
/* Regular */
SNPRINTF(req, sizeof(req), "MW %s0,%03d", mr_extra, channel_num);
channel_desc = chan->channel_desc;
}
break;
case RIG_MTYPE_EDGE:
if (chan_caps[1].type == RIG_MTYPE_EDGE)
{
SNPRINTF(req, sizeof(req), "MW %s0,L%01d", mr_extra, channel_num);
}
else
{
SNPRINTF(req, sizeof(req), "MW %s0,U%01d", mr_extra, channel_num);
}
break;
case RIG_MTYPE_PRIO:
if (chan_caps->startc == chan_caps->endc)
{
SNPRINTF(req, sizeof(req), "MW %s0,PR", mr_extra);
}
else
{
SNPRINTF(req, sizeof(req), "MW %s0,PR%01d", mr_extra, channel_num + 1);
}
break;
case RIG_MTYPE_CALL:
SNPRINTF(req, sizeof(req), "CW 0,%01d", channel_num);
break;
case RIG_MTYPE_BAND:
SNPRINTF(req, sizeof(req), "VW %01X", channel_num);
break;
default:
return -RIG_EINVAL;
}
rev = (chan->funcs & RIG_FUNC_REV) ? 1 : 0;
lockout = (chan->flags & RIG_CHFLAG_SKIP) ? 1 : 0;
if (chan_caps->mem_caps.flags)
{
SNPRINTF(lockoutstr, sizeof(lockoutstr), ",%d", lockout);
}
else
{
strcpy(lockoutstr, "");
}
if (chan_caps->mem_caps.flags && chan_caps->mem_caps.dcs_sql)
{
int mode;
if (!priv->mode_table)
{
rig_debug(RIG_DEBUG_ERR, "%s: buggy backend, no mode_table '%d'\n",
__func__, (int)chan->mode);
return -RIG_ENIMPL;
}
mode = rmode2kenwood(chan->mode, priv->mode_table);
if (mode == -1)
{
rig_debug(RIG_DEBUG_ERR, "%s: unsupported mode value '%d'\n",
__func__, (int)chan->mode);
return -RIG_EINVAL;
}
/* Step can be hexa */
SNPRINTF(membuf, sizeof(membuf),
"%8s,%011"PRIll",%X,%d,%d,%d,%d,%d,%02d,%02d,%03d,%09"PRIll",%d%10s",
req, (int64_t)chan->freq, step, shift, rev, tone,
ctcss, dcs, tonefq, ctcssfq, dcscode,
(int64_t)labs((long)(chan->rptr_offs)), mode, lockoutstr
);
}
else
{
/* Without DCS,mode */
SNPRINTF(membuf, sizeof(membuf),
"%s,%011"PRIll",%X,%d,%d,%d,%d,,%02d,,%02d,%09"PRIll"%s",
req, (int64_t)chan->freq, step, shift, rev, tone,
ctcss, tonefq, ctcssfq,
(int64_t)labs((long)(chan->rptr_offs)), lockoutstr
);
}
retval = kenwood_transaction(rig, membuf, membuf, sizeof(membuf));
if (retval != RIG_OK)
{
return retval;
}
/* split ? */
if (chan->tx_freq != RIG_FREQ_NONE &&
((chan_caps->type == RIG_MTYPE_MEM && chan_caps->startc == 0) ||
chan_caps->type == RIG_MTYPE_CALL))
{
req[3 + strlen(mr_extra)] = '1';
SNPRINTF(membuf, sizeof(membuf), "%s,%011"PRIll",%X", req,
(int64_t)chan->tx_freq, step);
retval = kenwood_transaction(rig, membuf, membuf, sizeof(membuf));
if (retval != RIG_OK)
{
return retval;
}
}
if (channel_desc)
{
/* Memory name */
/* TODO: check strlen(channel_desc) < rig->caps->chan_desc_sz */
if (chan_caps[1].type == RIG_MTYPE_PRIO)
{
SNPRINTF(membuf, sizeof(membuf), "MNA %sI-%01d,%s", mr_extra, channel_num,
channel_desc);
}
else
{
SNPRINTF(membuf, sizeof(membuf), "MNA %s%03d,%s", mr_extra, channel_num,
channel_desc);
}
retval = kenwood_transaction(rig, membuf, membuf, sizeof(membuf));
if (retval != RIG_OK)
{
return retval;
}
}
return RIG_OK;
}
/*
* set the aerial/antenna to use
*/
int th_set_ant(RIG *rig, vfo_t vfo, ant_t ant, value_t option)
{
char cmd[6];
rig_debug(RIG_DEBUG_TRACE, "%s: ant = %d\n", __func__, ant);
switch (ant)
{
case RIG_ANT_1:
strncpy(cmd, "ANT 0", sizeof(cmd));
break;
case RIG_ANT_2:
strncpy(cmd, "ANT 1", sizeof(cmd));
break;
case RIG_ANT_3:
strncpy(cmd, "ANT 2", sizeof(cmd));
break;
default:
return -RIG_EINVAL;
}
return kenwood_transaction(rig, cmd, cmd, sizeof(cmd));
}
/*
* get the aerial/antenna in use
*/
int th_get_ant(RIG *rig, vfo_t vfo, ant_t dummy, value_t *option,
ant_t *ant_curr, ant_t *ant_tx, ant_t *ant_rx)
{
char buf[8];
int retval;
rig_debug(RIG_DEBUG_TRACE, "%s\n", __func__);
retval = kenwood_safe_transaction(rig, "ANT", buf, sizeof(buf), 5);
if (retval != RIG_OK)
{
return retval;
}
if (buf[4] < '0' || buf[4] > '9')
{
return -RIG_EPROTO;
}
*ant_curr = RIG_ANT_N(buf[4] - '0');
rig_debug(RIG_DEBUG_TRACE, "%s: ant = %d\n", __func__, *ant_curr);
return RIG_OK;
}
/* TH-F7: 1 VFO, 2 Menu, 3 Full */
/* TM-D700: 1 Master! */
int th_reset(RIG *rig, reset_t reset)
{
switch (reset)
{
case RIG_RESET_VFO:
return kenwood_transaction(rig, "SR 1", NULL, 0);
case RIG_RESET_MASTER:
return kenwood_transaction(rig, "SR 3", NULL, 0);
default:
rig_debug(RIG_DEBUG_ERR, "%s: unsupported reset %d\n",
__func__, reset);
return -RIG_EINVAL;
}
}
Reference in New Issue View Git Blame Kopiuj bezpośredni odnośnik