kopia lustrzana https://github.com/Hamlib/Hamlib
factorised code for TH-D7 and TH-F/TH-F7 handhelds, initial release
git-svn-id: https://hamlib.svn.sourceforge.net/svnroot/hamlib/trunk@704 7ae35d74-ebe9-4afe-98af-79ac388436b8Hamlib-1.1.3
Stéphane Fillod, F8CFE
rodzic
3c0bc9a18c
commit
2d993d31ea
|
|
@ -0,0 +1,262 @@
|
|||
/*
|
||||
* Hamlib Kenwood backend - TH handheld primitives
|
||||
* Copyright (c) 2001 by Stephane Fillod
|
||||
*
|
||||
* $Id: th.c,v 1.1 2001-11-09 15:42:11 f4cfe Exp $
|
||||
*
|
||||
* This library is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU Library General Public License as
|
||||
* published by the Free Software Foundation; either version 2 of
|
||||
* the License, or (at your option) any later version.
|
||||
*
|
||||
* This program 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 Library General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU Library General Public
|
||||
* License along with this library; if not, write to the Free Software
|
||||
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
||||
*
|
||||
*/
|
||||
|
||||
#ifdef HAVE_CONFIG_H
|
||||
#include "config.h"
|
||||
#endif
|
||||
|
||||
#include <stdlib.h>
|
||||
#include <stdio.h> /* Standard input/output definitions */
|
||||
#include <string.h> /* String function definitions */
|
||||
#include <unistd.h> /* UNIX standard function definitions */
|
||||
#include <fcntl.h> /* File control definitions */
|
||||
#include <errno.h> /* Error number definitions */
|
||||
#include <termios.h> /* POSIX terminal control definitions */
|
||||
#include <sys/ioctl.h>
|
||||
|
||||
#include <hamlib/rig.h>
|
||||
#include <hamlib/riglist.h>
|
||||
#include "kenwood.h"
|
||||
#include "th.h"
|
||||
|
||||
|
||||
int th_set_vfo(RIG *rig, vfo_t vfo);
|
||||
int th_set_freq(RIG *rig, vfo_t vfo, freq_t freq);
|
||||
int th_get_freq(RIG *rig, vfo_t vfo, freq_t *freq);
|
||||
int th_set_mode(RIG *rig, vfo_t vfo, rmode_t mode, pbwidth_t width);
|
||||
int th_get_mode(RIG *rig, vfo_t vfo, rmode_t *mode, pbwidth_t *width);
|
||||
int th_set_ctcss_tone(RIG *rig, vfo_t vfo, tone_t tone);
|
||||
int th_get_ctcss_tone(RIG *rig, vfo_t vfo, tone_t *tone);
|
||||
|
||||
#define EOM "\r"
|
||||
|
||||
/*
|
||||
* modes in use by the "MD" command
|
||||
*/
|
||||
#define MD_FM '0'
|
||||
#define MD_WFM '1' /* or is it AM on the THD7? */
|
||||
#define MD_AM '2'
|
||||
#define MD_LSB '3'
|
||||
#define MD_USB '4'
|
||||
#define MD_CW '5'
|
||||
|
||||
int th_set_vfo(RIG *rig, vfo_t vfo)
|
||||
{
|
||||
unsigned char ackbuf[24];
|
||||
int ack_len, retval;
|
||||
|
||||
/*
|
||||
* FIXME: vfo==RIG_VFO_CURR
|
||||
*/
|
||||
|
||||
switch (vfo) {
|
||||
case RIG_VFO_A: /* FIXME */
|
||||
case RIG_VFO_B:
|
||||
case RIG_VFO_VFO:
|
||||
retval = kenwood_transaction (rig, "VMC0,0" EOM, 7, ackbuf, &ack_len);
|
||||
break;
|
||||
case RIG_VFO_MEM:
|
||||
retval = kenwood_transaction (rig, "VMC0,2" EOM, 7, ackbuf, &ack_len);
|
||||
break;
|
||||
default:
|
||||
rig_debug(RIG_DEBUG_ERR,"th_set_vfo: unsupported VFO %d\n",
|
||||
vfo);
|
||||
return -RIG_EINVAL;
|
||||
}
|
||||
|
||||
return retval;
|
||||
}
|
||||
|
||||
/*
|
||||
* th_set_freq
|
||||
* Assumes rig!=NULL
|
||||
*/
|
||||
int th_set_freq(RIG *rig, vfo_t vfo, freq_t freq)
|
||||
{
|
||||
unsigned char freqbuf[24], ackbuf[24];
|
||||
int freq_len, ack_len, retval;
|
||||
|
||||
freq_len = sprintf(freqbuf,"FQ %011Ld,0" EOM, freq);
|
||||
|
||||
retval = kenwood_transaction (rig, freqbuf, freq_len, ackbuf, &ack_len);
|
||||
|
||||
return retval;
|
||||
}
|
||||
|
||||
/*
|
||||
* th_get_freq
|
||||
* Assumes rig!=NULL, freq!=NULL
|
||||
*/
|
||||
int th_get_freq(RIG *rig, vfo_t vfo, freq_t *freq)
|
||||
{
|
||||
unsigned char freqbuf[24];
|
||||
int freq_len, retval;
|
||||
|
||||
retval = kenwood_transaction (rig, "FQ" EOM, 3, freqbuf, &freq_len);
|
||||
if (retval != RIG_OK)
|
||||
return retval;
|
||||
|
||||
sscanf(freqbuf+3, "%Ld", freq);
|
||||
|
||||
return RIG_OK;
|
||||
}
|
||||
|
||||
/*
|
||||
* th_set_mode
|
||||
* Assumes rig!=NULL
|
||||
*/
|
||||
int th_set_mode(RIG *rig, vfo_t vfo, rmode_t mode, pbwidth_t width)
|
||||
{
|
||||
unsigned char mdbuf[24],ackbuf[24];
|
||||
int mdbuf_len, ack_len, kmode, retval;
|
||||
|
||||
switch (mode) {
|
||||
case RIG_MODE_FM: kmode = MD_FM; break;
|
||||
case RIG_MODE_WFM: kmode = MD_WFM; break;
|
||||
case RIG_MODE_AM: kmode = MD_AM; break;
|
||||
case RIG_MODE_USB: kmode = MD_USB; break;
|
||||
case RIG_MODE_LSB: kmode = MD_LSB; break;
|
||||
case RIG_MODE_CW: kmode = MD_CW; break;
|
||||
default:
|
||||
rig_debug(RIG_DEBUG_ERR,"th_set_mode: "
|
||||
"unsupported mode %d\n", mode);
|
||||
return -RIG_EINVAL;
|
||||
}
|
||||
|
||||
mdbuf_len = sprintf(mdbuf, "MD %c" EOM, kmode);
|
||||
retval = kenwood_transaction (rig, mdbuf, mdbuf_len, ackbuf, &ack_len);
|
||||
|
||||
return retval;
|
||||
}
|
||||
|
||||
/*
|
||||
* th_get_mode
|
||||
* Assumes rig!=NULL, mode!=NULL
|
||||
*/
|
||||
int th_get_mode(RIG *rig, vfo_t vfo, rmode_t *mode, pbwidth_t *width)
|
||||
{
|
||||
int ack_len, retval;
|
||||
unsigned char ackbuf[24];
|
||||
|
||||
retval = kenwood_transaction (rig, "MD" EOM, 3, ackbuf, &ack_len);
|
||||
if (retval != RIG_OK)
|
||||
return retval;
|
||||
|
||||
if (ack_len != 5) {
|
||||
rig_debug(RIG_DEBUG_ERR,"th_get_mode: ack NG, len=%d\n",
|
||||
ack_len);
|
||||
return -RIG_ERJCTED;
|
||||
}
|
||||
|
||||
*width = RIG_PASSBAND_NORMAL; /* FIXME */
|
||||
switch (ackbuf[3]) {
|
||||
case MD_FM: *mode = RIG_MODE_FM; break;
|
||||
case MD_WFM: *mode = RIG_MODE_WFM; break;
|
||||
case MD_AM: *mode = RIG_MODE_AM; break;
|
||||
case MD_USB: *mode = RIG_MODE_USB; break;
|
||||
case MD_LSB: *mode = RIG_MODE_LSB; break;
|
||||
case MD_CW: *mode = RIG_MODE_CW; break;
|
||||
default:
|
||||
rig_debug(RIG_DEBUG_ERR,"th_get_mode: "
|
||||
"unsupported mode %d\n", ackbuf[3]);
|
||||
return -RIG_EINVAL;
|
||||
}
|
||||
|
||||
return RIG_OK;
|
||||
}
|
||||
|
||||
/*
|
||||
* th_set_ctcss_tone
|
||||
* Assumes rig!=NULL, rig->caps->ctcss_list != NULL
|
||||
*
|
||||
* Warning! This is untested stuff!
|
||||
* Please owners report to me <f4cfe@users.sourceforge.net>, thanks. --SF
|
||||
*/
|
||||
int th_set_ctcss_tone(RIG *rig, vfo_t vfo, tone_t tone)
|
||||
{
|
||||
const struct rig_caps *caps;
|
||||
unsigned char tonebuf[24], ackbuf[24];
|
||||
int tone_len, ack_len;
|
||||
int i;
|
||||
|
||||
caps = rig->caps;
|
||||
|
||||
/* TODO: replace 200 by something like RIGTONEMAX */
|
||||
for (i = 0; caps->ctcss_list[i] != 0 && i<200; i++) {
|
||||
if (caps->ctcss_list[i] == tone)
|
||||
break;
|
||||
}
|
||||
if (caps->ctcss_list[i] != tone)
|
||||
return -RIG_EINVAL;
|
||||
|
||||
/* TODO: replace menu no 57 by a define */
|
||||
tone_len = sprintf(tonebuf,"TN%02d" EOM, i+1);
|
||||
|
||||
return kenwood_transaction (rig, tonebuf, tone_len, ackbuf, &ack_len);
|
||||
}
|
||||
|
||||
/*
|
||||
* th_get_ctcss_tone
|
||||
* Assumes rig!=NULL, rig->state.priv!=NULL
|
||||
*/
|
||||
int th_get_ctcss_tone(RIG *rig, vfo_t vfo, tone_t *tone)
|
||||
{
|
||||
const struct rig_caps *caps;
|
||||
unsigned char tonebuf[24];
|
||||
int tone_len, i, retval;
|
||||
unsigned int tone_idx;
|
||||
|
||||
caps = rig->caps;
|
||||
|
||||
/* TODO: replace menu no 57 by a define */
|
||||
|
||||
retval = kenwood_transaction (rig, "TN" EOM, 3, tonebuf, &tone_len);
|
||||
if (retval != RIG_OK)
|
||||
return retval;
|
||||
|
||||
if (tone_len != 10) {
|
||||
rig_debug(RIG_DEBUG_ERR,"th_get_ctcss_tone: unexpected reply "
|
||||
"'%s', len=%d\n", tonebuf, tone_len);
|
||||
return -RIG_ERJCTED;
|
||||
}
|
||||
|
||||
sscanf(tonebuf+3, "%u", (int*)&tone_idx);
|
||||
|
||||
if (tone_idx == 0) {
|
||||
rig_debug(RIG_DEBUG_ERR,"th_get_ctcss_tone: Unexpected CTCSS "
|
||||
"no (%04d)\n", tone_idx);
|
||||
return -RIG_EPROTO;
|
||||
}
|
||||
|
||||
/* check this tone exists. That's better than nothing. */
|
||||
for (i = 0; i<tone_idx; i++) {
|
||||
if (caps->ctcss_list[i] == 0) {
|
||||
rig_debug(RIG_DEBUG_ERR,"th_get_ctcss_tone: CTCSS NG "
|
||||
"(%04d)\n", tone_idx);
|
||||
return -RIG_EPROTO;
|
||||
}
|
||||
}
|
||||
*tone = caps->ctcss_list[tone_idx-1];
|
||||
|
||||
return RIG_OK;
|
||||
}
|
||||
|
||||
|
|
@ -0,0 +1,35 @@
|
|||
/*
|
||||
* Hamlib Kenwood backend - TH handheld header
|
||||
* Copyright (c) 2001 by Stephane Fillod
|
||||
*
|
||||
* $Id: th.h,v 1.1 2001-11-09 15:42:11 f4cfe Exp $
|
||||
*
|
||||
* This library is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU Library General Public License as
|
||||
* published by the Free Software Foundation; either version 2 of
|
||||
* the License, or (at your option) any later version.
|
||||
*
|
||||
* This program 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 Library General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU Library General Public
|
||||
* License along with this library; if not, write to the Free Software
|
||||
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
||||
*
|
||||
*/
|
||||
|
||||
|
||||
#ifndef _TH_H
|
||||
#define _TH_H 1
|
||||
|
||||
int th_set_vfo(RIG *rig, vfo_t vfo);
|
||||
int th_set_freq(RIG *rig, vfo_t vfo, freq_t freq);
|
||||
int th_get_freq(RIG *rig, vfo_t vfo, freq_t *freq);
|
||||
int th_set_mode(RIG *rig, vfo_t vfo, rmode_t mode, pbwidth_t width);
|
||||
int th_get_mode(RIG *rig, vfo_t vfo, rmode_t *mode, pbwidth_t *width);
|
||||
int th_set_ctcss_tone(RIG *rig, vfo_t vfo, tone_t tone);
|
||||
int th_get_ctcss_tone(RIG *rig, vfo_t vfo, tone_t *tone);
|
||||
|
||||
#endif /* _TH_H */
|
||||
Ładowanie…
Reference in New Issue