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

2085 wiersze
47 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
*
*/
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif
#include <stdlib.h>
#include <stdio.h>
#include <math.h>
#include <string.h> /* String function definitions */
#include <unistd.h> /* UNIX standard 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;
size_t async_len=128;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
retval = kenwood_transaction(rig, NULL, 0, asyncbuf, &async_len);
if (retval != RIG_OK)
return retval;
rig_debug(RIG_DEBUG_TRACE, "%s: Decoding message\n", __func__);
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: %d\n", func, 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\n", __func__);
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 (abs(freq5-freq)<abs(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;
sprintf(buf, "FQ %011"PRIll",%X", (int64_t) freq_sent, step);
return kenwood_cmd(rig, 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), 17);
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];
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);
if (priv->mode_table) {
kmode = rmode2kenwood(mode, priv->mode_table);
if (kmode == -1) {
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 %d\n", __func__, mode);
return -RIG_EINVAL;
}
}
sprintf(mdbuf, "MD %c", kmode);
retval = kenwood_cmd(rig, mdbuf);
if (retval != RIG_OK)
return retval;
return RIG_OK;
}
/*
* 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), 5);
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)
{
const char *cmd;
int retval;
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:
cmd = "BC 0";
break;
case RIG_VFO_B:
case RIG_VFO_SUB:
cmd = "BC 1";
break;
default:
return kenwood_wrong_vfo(__func__, vfo);
}
retval = kenwood_simple_transaction(rig, cmd, 5);
if (retval != RIG_OK)
return retval;
}
/* No "VMC" cmd on THD72A */
if (rig->caps->rig_model == RIG_MODEL_THD72A)
return RIG_OK;
/* set vfo */
switch (vfo) {
case RIG_VFO_A:
case RIG_VFO_VFO:
case RIG_VFO_MAIN:
cmd = "VMC 0,0";
break;
case RIG_VFO_B:
case RIG_VFO_SUB:
cmd = "VMC 1,0";
break;
case RIG_VFO_MEM:
if (rig->caps->rig_model == RIG_MODEL_THF7E ||
rig->caps->rig_model == RIG_MODEL_THF6A)
cmd = "VMC 0,1";
else
cmd = "VMC 0,2";
break;
default:
return kenwood_wrong_vfo(__func__, vfo);
}
return kenwood_cmd(rig, cmd);
}
int
th_get_vfo_char(RIG *rig, vfo_t *vfo, char *vfoch)
{
char cmdbuf[10], buf[10], vfoc;
size_t buf_size=10;
int retval;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
/* Get VFO band */
retval = kenwood_transaction(rig, "BC", 2, buf, &buf_size);
if (retval != RIG_OK)
return retval;
switch (buf_size) {
case 5: /*original case BC 0*/
vfoc = buf[3];
break;
case 7: /*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 '%c'\n", __func__, buf_size);
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 */
if (rig->caps->rig_model == RIG_MODEL_THD72A) {
*vfoch = '0'; /* FIXME: fake */
return RIG_OK;
}
/* Get mode of the VFO band */
sprintf(cmdbuf, "VMC %c", vfoc);
retval = kenwood_safe_transaction(rig, cmdbuf, buf, 10, 8);
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 vfobuf[16], ackbuf[16];
int vfonum, txvfonum, vfomode=0;
int retval;
size_t ack_len;
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 */
sprintf(vfobuf, "BC");
ack_len=16;
retval = kenwood_transaction(rig, vfobuf, strlen(vfobuf), ackbuf, &ack_len);
if (retval != RIG_OK)
return retval;
txvfonum = vfonum = ackbuf[3]-'0';
vfomode = 2;
break;
default:
rig_debug(RIG_DEBUG_ERR, "%s: Unsupported VFO %d\n", __func__, vfo);
return -RIG_EVFO;
}
sprintf(vfobuf, "VMC %d,%d", vfonum, vfomode);
retval = kenwood_cmd(rig, vfobuf);
if (retval != RIG_OK)
return retval;
if (vfo == RIG_VFO_MEM)
return RIG_OK;
sprintf(vfobuf, "BC %d,%d", vfonum, txvfonum);
retval = kenwood_cmd(rig, vfobuf);
if (retval != RIG_OK)
return retval;
return RIG_OK;
}
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? */
sprintf(vfobuf, "VMC %d,0", vfonum);
retval = kenwood_cmd(rig, vfobuf);
if (retval != RIG_OK)
return retval;
sprintf(vfobuf, "BC %d,%d", vfonum, txvfonum);
retval = kenwood_cmd(rig, vfobuf);
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, 5);
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)
{
return kenwood_cmd(rig, (trn == RIG_TRN_RIG) ? "AI 1" : "AI 0");
}
/*
* th_get_trn
* Assumes rig!=NULL
*/
int
th_get_trn(RIG *rig, int *trn)
{
char buf[ACKBUF_LEN];
int retval;
size_t ack_len=ACKBUF_LEN;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
retval = kenwood_transaction(rig, "AI", 3, buf, &ack_len);
if (retval != RIG_OK)
return retval;
if (ack_len < 4 ) {
rig_debug(RIG_DEBUG_ERR, "%s: Unexpected reply '%s'\n", __func__, buf);
return -RIG_ERJCTED;
}
*trn = (buf[3] != '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 + 3;
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 (0x%04x)\n", __func__, 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 %#x\n",
__func__, func);
return -RIG_EINVAL;
}
}
static int th_tburst(RIG *rig, vfo_t vfo, int status)
{
return kenwood_cmd(rig, (status == 1) ? "TT" : "RX");
}
/*
* 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_cmd(rig, buf);
}
/*
* 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 (0x%04x)\n", __func__, 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 %#x\n", __func__, 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 (0x%04x)\n", __func__, 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), 6);
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), 5);
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 %#x\n", __func__, 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_cmd(rig, "APO 2");
else if (val.i > 0)
return kenwood_cmd(rig, "APO 1");
else
return kenwood_cmd(rig, "APO 0");
default:
rig_debug(RIG_DEBUG_ERR, "%s: Unsupported parm %#x\n", __func__, 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, l;
size_t ack_len = sizeof(ackbuf);
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:
sprintf(buf, "SM %c", vch);
// XXX use kenwood_safe_transaction
retval = kenwood_transaction(rig, buf, strlen(buf), ackbuf, &ack_len);
if (retval != RIG_OK)
return retval;
retval = sscanf(ackbuf, "SM %d,%d", &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:
sprintf(buf, "SQ %c", vch);
retval = kenwood_safe_transaction(rig, buf, ackbuf, 10, 8);
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:
sprintf(buf, "AG %c", vch);
retval = kenwood_transaction(rig, buf, strlen(buf), ackbuf, &ack_len);
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:
sprintf(buf, "PC %c",vch);
retval = kenwood_transaction(rig, buf, strlen(buf), ackbuf, &ack_len);
if (retval != RIG_OK)
return retval;
retval = sscanf(ackbuf, "PC %d,%d", &v, &l);
if (retval != 2 || l < 0 || 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, 6);
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, 6);
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, 6);
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 %d\n", __func__, 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 :
sprintf(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_cmd(rig, buf);
case RIG_LEVEL_SQL :
sprintf(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_cmd(rig, buf);
case RIG_LEVEL_AF :
sprintf(buf, "AG %c,%02x", vch, (int)(val.f * 32.0));
return kenwood_cmd(rig, buf);
case RIG_LEVEL_ATT :
sprintf(buf, "ATT %c", val.i ? '1' : '0');
return kenwood_cmd(rig, buf);
case RIG_LEVEL_BALANCE :
sprintf(buf, "BAL %c", '4' - (int) (val.f * ('4'-'0')));
return kenwood_cmd(rig, buf);
case RIG_LEVEL_VOXGAIN:
sprintf(buf, "VXG %d", (int) (val.f * 9));
return kenwood_cmd(rig, buf);
case RIG_LEVEL_VOXDELAY: /* "VXD" */
return -RIG_ENIMPL;
default:
rig_debug(RIG_DEBUG_ERR, "%s: Unsupported Level %d\n", __func__, 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],ackbuf[ACKBUF_LEN];
int i, retval;
size_t ack_len;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
caps = rig->caps;
for (i = 0; caps->ctcss_list[i] != 0 && i < RIG_TONEMAX; 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 anomally */
sprintf(tonebuf, "TN %02d", i);
ack_len = ACKBUF_LEN;
retval = kenwood_transaction(rig, tonebuf, strlen(tonebuf), ackbuf, &ack_len);
if (retval != RIG_OK)
return retval;
return RIG_OK;
}
/*
* 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;
size_t ack_len=ACKBUF_LEN;
unsigned int tone_idx;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
caps = rig->caps;
retval = kenwood_transaction(rig, "TN", 4, buf, &ack_len);
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],ackbuf[ACKBUF_LEN];
int i, retval;
size_t ack_len;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
caps = rig->caps;
for (i = 0; caps->ctcss_list[i] != 0 && i < RIG_TONEMAX; 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 anomally */
sprintf(tonebuf, "CTN %02d", i);
ack_len = ACKBUF_LEN;
retval = kenwood_transaction(rig, tonebuf, strlen(tonebuf), ackbuf, &ack_len);
if (retval != RIG_OK)
return retval;
return RIG_OK;
}
/*
* 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;
size_t ack_len=ACKBUF_LEN;
unsigned int tone_idx;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
caps = rig->caps;
retval = kenwood_transaction(rig, "CTN", 4, buf, &ack_len);
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) {
return kenwood_simple_cmd(rig, "DCS 0");
}
for (i = 0; caps->dcs_list[i] != 0 && i < RIG_CODEMAX; i++) {
if (caps->dcs_list[i] == code)
break;
}
if (caps->dcs_list[i] != code)
return -RIG_EINVAL;
retval = kenwood_simple_cmd(rig, "DCS 1");
if (retval != RIG_OK)
return retval;
sprintf(codebuf, "DCSN %04d", (i+1)*10);
retval = kenwood_simple_cmd(rig, codebuf);
if (retval != RIG_OK)
return retval;
return RIG_OK;
}
/*
* 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;
size_t ack_len=ACKBUF_LEN;
unsigned int code_idx;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
caps = rig->caps;
retval = kenwood_transaction(rig, "DCS", 3, buf, &ack_len);
if (retval != RIG_OK)
return retval;
retval = sscanf(buf, "DCSN %u", (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;
}
ack_len=ACKBUF_LEN;
retval = kenwood_transaction(rig, "DCSN", 4, buf, &ack_len);
if (retval != RIG_OK)
return retval;
retval = sscanf(buf, "DCSN %u", (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=50;
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
memset(firmbuf, 0, sizeof(firmbuf));
retval = kenwood_transaction(rig, "ID", 3, firmbuf, &firm_len);
if (retval != RIG_OK)
return NULL;
if (firm_len < 3) {
rig_debug(RIG_DEBUG_ERR, "%s: unexpected reply '%s', len=%d\n",
__func__, firmbuf, 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], ackbuf[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);
}
retval = rig_set_vfo(rig, RIG_VFO_MEM);
if (retval != RIG_OK)
return retval;
sprintf(membuf, "MC %c,%03i", vsel, ch);
retval = kenwood_safe_transaction(rig, membuf, ackbuf, 10, 9);
if (retval != RIG_OK)
return retval;
return RIG_OK;
}
/* 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, 9);
if (retval != RIG_OK)
return retval;
buf[8] = '\0';
*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)
{
rig_debug(RIG_DEBUG_TRACE, "%s: called\n", __func__);
return kenwood_cmd(rig, (ptt == RIG_PTT_ON) ? "TX" : "RX");
}
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), 7);
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', len=%d\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_cmd(rig, "UP");
case RIG_OP_DOWN:
return kenwood_cmd(rig, "DW");
case RIG_OP_TO_VFO:
return kenwood_cmd(rig, "MSH");
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, channel_t *chan)
{
char membuf[64],ackbuf[ACKBUF_LEN];
int retval;
size_t ack_len;
freq_t freq,offset;
char req[16],scf[128];
int step, shift, rev, tone, ctcss, tonefq, ctcssfq, dcs, dcscode, mode, lockout;
const char *mr_extra;
int channel_num;
vfo_t vfo;
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;
vfo = chan->vfo;
memset(chan, 0, sizeof(channel_t));
chan->channel_num = channel_num;
chan->vfo = vfo;
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->start;
switch (chan_caps->type) {
case RIG_MTYPE_MEM:
if (chan_caps[1].type == RIG_MTYPE_PRIO) {
/* Info */
sprintf(req, "MR %s0,I-%01d",mr_extra,channel_num);
} else
sprintf(req, "MR %s0,%03d",mr_extra,channel_num);
break;
case RIG_MTYPE_EDGE:
if (chan_caps[1].type == RIG_MTYPE_EDGE) {
sprintf(req, "MR %s0,L%01d",mr_extra,channel_num);
sprintf(chan->channel_desc, "L%01d",channel_num);
} else {
sprintf(req, "MR %s0,U%01d",mr_extra,channel_num);
sprintf(chan->channel_desc, "U%01d",channel_num);
}
break;
case RIG_MTYPE_PRIO:
if (chan_caps->start == chan_caps->end) {
sprintf(req, "MR %s0,PR",mr_extra);
sprintf(chan->channel_desc, "Pr");
} else {
sprintf(req, "MR %s0,PR%01d",mr_extra,channel_num+1);
sprintf(chan->channel_desc, "Pr%01d",channel_num+1);
}
break;
case RIG_MTYPE_CALL:
sprintf(req, "CR 0,%01d",channel_num);
if (chan->channel_num==chan_caps->start) sprintf(chan->channel_desc, "Call V");
else if (chan->channel_num==chan_caps->end) sprintf(chan->channel_desc, "Call U");
else sprintf(chan->channel_desc, "Call");
break;
case RIG_MTYPE_BAND:
sprintf(req, "VR %01X",channel_num);
sprintf(chan->channel_desc, "BAND %01X",channel_num);
break;
default:
return -RIG_EINVAL;
}
sprintf(membuf, "%s",req);
ack_len=ACKBUF_LEN;
retval = kenwood_transaction(rig, membuf, strlen(membuf), ackbuf, &ack_len);
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->start == 0) ||
chan_caps->type==RIG_MTYPE_CALL)) {
/* split ? */
req[3+strlen(mr_extra)]='1';
sprintf(membuf, "%s",req);
ack_len=ACKBUF_LEN;
retval = kenwood_transaction(rig, membuf, strlen(membuf), ackbuf, &ack_len);
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') {
if (chan_caps[1].type == RIG_MTYPE_PRIO)
sprintf(membuf, "MNA %sI-%01d",mr_extra,channel_num);
else
sprintf(membuf, "MNA %s%03d",mr_extra,channel_num);
ack_len=ACKBUF_LEN;
/* Get memory name */
retval = kenwood_transaction(rig, membuf, strlen(membuf), ackbuf, &ack_len);
if (retval != RIG_OK)
return retval;
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';
}
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 < RIG_TONEMAX; i++) {
if (tone_list[i] == tone)
return i;
}
return -1;
}
/* --------------------------------------------------------------------- */
int th_set_channel(RIG *rig, const channel_t *chan)
{
char membuf[ACKBUF_LEN],ackbuf[ACKBUF_LEN];
int retval;
size_t ack_len;
char req[64];
char lockoutstr[8];
int channel_num, step, shift, rev, tone, ctcss, tonefq, ctcssfq, dcs, dcscode, mode, 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->start;
}
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 */
sprintf(req, "MW %s0,I-%01d",mr_extra,channel_num);
channel_desc = chan->channel_desc;
} else {
/* Regular */
sprintf(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) {
sprintf(req, "MW %s0,L%01d",mr_extra,channel_num);
} else {
sprintf(req, "MW %s0,U%01d",mr_extra,channel_num);
}
break;
case RIG_MTYPE_PRIO:
if (chan_caps->start == chan_caps->end) {
sprintf(req, "MW %s0,PR",mr_extra);
} else {
sprintf(req, "MW %s0,PR%01d",mr_extra,channel_num+1);
}
break;
case RIG_MTYPE_CALL:
sprintf(req, "CW 0,%01d",channel_num);
break;
case RIG_MTYPE_BAND:
sprintf(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)
sprintf(lockoutstr, ",%d", lockout);
else
strcpy(lockoutstr, "");
if (chan_caps->mem_caps.flags && chan_caps->mem_caps.dcs_sql) {
if (!priv->mode_table) {
rig_debug(RIG_DEBUG_ERR, "%s: Buggy backend, no mode_table '%d'\n",
__func__, 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__, chan->mode);
return -RIG_EINVAL;
}
/* Step can be hexa */
retval = sprintf(membuf, "%s,%011"PRIll",%X,%d,%d,%d,%d,%d,%02d,%02d,%03d,%09"PRIll",%d%s",
req, (int64_t)chan->freq, step, shift, rev, tone,
ctcss, dcs, tonefq, ctcssfq, dcscode,
(int64_t)abs(chan->rptr_offs), mode, lockoutstr
);
} else {
/* Without DCS,mode */
retval = sprintf(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)abs(chan->rptr_offs), lockoutstr
);
}
ack_len = ACKBUF_LEN;
retval = kenwood_transaction(rig, membuf, strlen(membuf), ackbuf, &ack_len);
if (retval != RIG_OK)
return retval;
/* split ? */
if (chan->tx_freq!=RIG_FREQ_NONE &&
((chan_caps->type==RIG_MTYPE_MEM && chan_caps->start == 0) ||
chan_caps->type==RIG_MTYPE_CALL)) {
req[3+strlen(mr_extra)]='1';
sprintf(membuf, "%s,%011"PRIll",%X", req,(int64_t)chan->tx_freq, step);
ack_len=ACKBUF_LEN;
retval = kenwood_transaction(rig, membuf, strlen(membuf), ackbuf, &ack_len);
if (retval != RIG_OK)
return retval;
}
if (channel_desc) {
/* Memory name */
ack_len=ACKBUF_LEN;
/* TODO: check strlen(channel_desc) < rig->caps->chan_desc_sz */
if (chan_caps[1].type == RIG_MTYPE_PRIO)
sprintf(membuf, "MNA %sI-%01d,%s",mr_extra,channel_num,channel_desc);
else
sprintf(membuf, "MNA %s%03d,%s",mr_extra,channel_num,channel_desc);
retval = kenwood_transaction(rig, membuf, strlen(membuf), ackbuf, &ack_len);
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)
{
const char *cmd;
rig_debug(RIG_DEBUG_TRACE, "%s: ant = %d\n", __func__, ant);
switch (ant) {
case RIG_ANT_1:
cmd = "ANT 0";
break;
case RIG_ANT_2:
cmd = "ANT 1";
break;
case RIG_ANT_3:
cmd = "ANT 2";
break;
default:
return -RIG_EINVAL;
}
return kenwood_cmd(rig, cmd);
}
/*
* get the aerial/antenna in use
*/
int th_get_ant(RIG * rig, vfo_t vfo, ant_t * ant)
{
char buf[8];
int retval;
rig_debug(RIG_DEBUG_TRACE, "%s\n", __func__);
retval = kenwood_safe_transaction(rig, "ANT", buf, sizeof(buf), 6);
if (retval != RIG_OK)
return retval;
if (buf[4] < '0' || buf[4] > '9')
return -RIG_EPROTO;
*ant = RIG_ANT_N(buf[4] - '0');
rig_debug(RIG_DEBUG_TRACE, "%s: ant = %d\n", __func__, *ant);
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_simple_cmd(rig, "SR 1");
case RIG_RESET_MASTER:
return kenwood_simple_cmd(rig, "SR 3");
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