kopia lustrzana https://github.com/Hamlib/Hamlib
425 wiersze
9.1 KiB
C
425 wiersze
9.1 KiB
C
/*
|
|
* Hamlib PRM80 backend - main file
|
|
* Copyright (c) 2010 by Stephane Fillod
|
|
*
|
|
*
|
|
* 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 <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <string.h> /* String function definitions */
|
|
#include <unistd.h> /* UNIX standard function definitions */
|
|
#include <math.h>
|
|
|
|
#include "hamlib/rig.h"
|
|
#include "serial.h"
|
|
#include "misc.h"
|
|
#include "cal.h"
|
|
#include "register.h"
|
|
#include "idx_builtin.h"
|
|
|
|
#include "prm80.h"
|
|
|
|
|
|
#define LF "\x0a"
|
|
|
|
#define PROMPT ">"
|
|
|
|
#define BUFSZ 64
|
|
|
|
/*
|
|
[0] = Reset.
|
|
[C] = Print channels list.
|
|
[D] = Set system byte.
|
|
|
|
[E] = Show system state (Mode-Chan-Chanstate-Sql-Vol-Lock-RX freq-TX
|
|
freq).
|
|
[F] = Set squelch.
|
|
[H] = Print this help page.
|
|
[K] = Set lock byte.
|
|
[N] = Set current channel.
|
|
[O] = Set volume.
|
|
[P] = Edit/Add channel.
|
|
[Q] = Set channels number.
|
|
[R] = Set synthetiser frequencies.
|
|
[T] = Set current channel state.
|
|
[V] = Print firmware version.
|
|
*/
|
|
|
|
/*
|
|
* prm80_transaction
|
|
* We assume that rig!=NULL, rig->state!= NULL, data!=NULL, data_len!=NULL
|
|
* Otherwise, you'll get a nice seg fault. You've been warned!
|
|
* TODO: error case handling
|
|
*/
|
|
static int prm80_transaction(RIG *rig, const char *cmd, int cmd_len, char *data, int *data_len)
|
|
{
|
|
int retval, i;
|
|
struct rig_state *rs;
|
|
|
|
rs = &rig->state;
|
|
|
|
serial_flush(&rs->rigport);
|
|
|
|
retval = write_block(&rs->rigport, cmd, cmd_len);
|
|
if (retval != RIG_OK)
|
|
return retval;
|
|
|
|
/* no data wanted, but flush it anyway */
|
|
if (!data || !data_len) {
|
|
char retbuf[BUFSZ+1];
|
|
|
|
retval = read_string(&rs->rigport, retbuf, BUFSZ, LF, strlen(LF));
|
|
if (retval < 0)
|
|
return retval;
|
|
|
|
retbuf[retval] = '\0';
|
|
#if 0
|
|
/*
|
|
* Does transceiver sends back ">" ?
|
|
*/
|
|
if (strstr(retbuf, PROMPT))
|
|
return RIG_OK;
|
|
else
|
|
return -RIG_ERJCTED;
|
|
#else
|
|
return RIG_OK;
|
|
#endif
|
|
}
|
|
|
|
retval = read_string(&rs->rigport, data, BUFSZ, LF, strlen(LF));
|
|
if (retval == -RIG_ETIMEOUT)
|
|
retval = 0;
|
|
if (retval < 0)
|
|
return retval;
|
|
|
|
/* Clear possible MSB, because of 7S1 */
|
|
for (i=0; i<retval; i++)
|
|
data[i] &= 0x7f;
|
|
|
|
*data_len = retval;
|
|
|
|
/* chomp CR/LF from string
|
|
*/
|
|
if (*data_len >= 2 && data[*data_len-1] == '\x0a')
|
|
*data_len -= 2;
|
|
|
|
data[*data_len] = '\0';
|
|
|
|
return RIG_OK;
|
|
}
|
|
|
|
|
|
/*
|
|
* prm80_reset
|
|
* Assumes rig!=NULL
|
|
*/
|
|
int prm80_reset(RIG *rig, reset_t reset)
|
|
{
|
|
int retval;
|
|
|
|
/*
|
|
* master reset ?
|
|
*/
|
|
retval = prm80_transaction (rig, "0", 1, NULL, NULL);
|
|
if (retval != RIG_OK)
|
|
return retval;
|
|
|
|
return RIG_OK;
|
|
}
|
|
|
|
|
|
/*
|
|
* prm80_set_freq
|
|
* Assumes rig!=NULL
|
|
*/
|
|
int prm80_set_freq(RIG *rig, vfo_t vfo, freq_t freq)
|
|
{
|
|
char freqbuf[BUFSZ];
|
|
int freq_len;
|
|
|
|
/* wild guess */
|
|
freq_len = sprintf(freqbuf, "R%04X%04X",
|
|
(unsigned)(freq / 12500.),
|
|
(unsigned)(freq / 12500.));
|
|
|
|
return prm80_transaction (rig, freqbuf, freq_len, NULL, NULL);
|
|
}
|
|
|
|
/*
|
|
* prm80_get_freq
|
|
* Assumes rig!=NULL
|
|
*/
|
|
int prm80_get_freq(RIG *rig, vfo_t vfo, freq_t *freq)
|
|
{
|
|
int ret;
|
|
channel_t chan;
|
|
|
|
memset(&chan, 0, sizeof(chan));
|
|
chan.vfo = RIG_VFO_CURR;
|
|
|
|
ret = prm80_get_channel(rig, &chan);
|
|
if (ret != RIG_OK)
|
|
return ret;
|
|
|
|
*freq = chan.freq;
|
|
|
|
return RIG_OK;
|
|
}
|
|
|
|
/*
|
|
* prm80_set_mem
|
|
* Assumes rig!=NULL
|
|
*/
|
|
int prm80_set_mem(RIG *rig, vfo_t vfo, int ch)
|
|
{
|
|
int cmd_len;
|
|
char cmdbuf[BUFSZ];
|
|
|
|
/* [N] = Set current channel. */
|
|
|
|
if (ch < 0 || ch > 99)
|
|
return -RIG_EINVAL;
|
|
|
|
cmd_len = sprintf(cmdbuf, "N%02u" , ch);
|
|
|
|
return prm80_transaction (rig, cmdbuf, cmd_len, NULL, NULL);
|
|
}
|
|
|
|
/*
|
|
* prm80_get_mem
|
|
* Assumes rig!=NULL
|
|
*/
|
|
int prm80_get_mem(RIG *rig, vfo_t vfo, int *ch)
|
|
{
|
|
int ret;
|
|
channel_t chan;
|
|
|
|
memset(&chan, 0, sizeof(chan));
|
|
chan.vfo = RIG_VFO_CURR;
|
|
|
|
ret = prm80_get_channel(rig, &chan);
|
|
if (ret != RIG_OK)
|
|
return ret;
|
|
|
|
*ch = chan.channel_num;
|
|
|
|
return RIG_OK;
|
|
}
|
|
|
|
/*
|
|
* Convert first two hexadecimal digit to integer
|
|
*/
|
|
static int hhtoi(const char *p)
|
|
{
|
|
char buf[4];
|
|
|
|
buf[0] = p[0];
|
|
buf[1] = p[1];
|
|
buf[2] = '\0';
|
|
|
|
return (int)strtol(buf, NULL, 16);
|
|
}
|
|
|
|
/*
|
|
* prm80_get_channel
|
|
* Assumes rig!=NULL
|
|
*/
|
|
int prm80_get_channel(RIG * rig, channel_t * chan)
|
|
{
|
|
char statebuf[BUFSZ];
|
|
int statebuf_len = BUFSZ;
|
|
int ret, chanstate;
|
|
|
|
if (chan->vfo == RIG_VFO_MEM) {
|
|
ret = prm80_set_mem(rig, RIG_VFO_CURR, chan->channel_num);
|
|
if (ret != RIG_OK)
|
|
return ret;
|
|
}
|
|
|
|
/* [E] = Show system state (Mode-Chan-Chanstate-Sql-Vol-Lock-RX freq-TX freq). */
|
|
ret = prm80_transaction (rig, "E", 1, statebuf, &statebuf_len);
|
|
if (ret != RIG_OK)
|
|
return ret;
|
|
if (statebuf_len < 20)
|
|
return -RIG_EPROTO;
|
|
|
|
/* Example: 1240080AFF0033F02D40 */
|
|
if (hhtoi(statebuf) != 0x12)
|
|
rig_debug(RIG_DEBUG_WARN, "%s: Unknown mode 0x%c%c\n",
|
|
__func__, statebuf[0], statebuf[1]);
|
|
chan->mode = RIG_MODE_FM;
|
|
chan->width = rig_passband_normal(rig, chan->mode);
|
|
chan->channel_num = hhtoi(statebuf+2);
|
|
|
|
chanstate = hhtoi(statebuf+4) & 0x0f;
|
|
/* is it rptr_shift or split mode ? */
|
|
chan->rptr_shift = (chanstate & 0x01) == 0 ? RIG_RPT_SHIFT_NONE :
|
|
chanstate & 0x02 ? RIG_RPT_SHIFT_MINUS :
|
|
chanstate & 0x04 ? RIG_RPT_SHIFT_PLUS : RIG_RPT_SHIFT_NONE;
|
|
chan->flags = chanstate & 0x08 ? RIG_CHFLAG_SKIP : 0;
|
|
|
|
chan->levels[LVL_SQL].f = ((float)(hhtoi(statebuf+6)>>4))/15.;
|
|
chan->levels[LVL_AF].f = ((float)(hhtoi(statebuf+8)>>4))/15.;
|
|
/* same as chanstate bit 1 */
|
|
chan->flags = hhtoi(statebuf+10) == 0 ? 0 : RIG_CHFLAG_SKIP;
|
|
chan->freq = ((hhtoi(statebuf+12)<<8) + hhtoi(statebuf+14)) * 12500;
|
|
chan->tx_freq = ((hhtoi(statebuf+16)<<8) + hhtoi(statebuf+18)) * 12500;
|
|
chan->rptr_offs = chan->tx_freq - chan->freq;
|
|
|
|
return RIG_OK;
|
|
}
|
|
|
|
/*
|
|
* prm80_set_channel
|
|
* Assumes rig!=NULL
|
|
*/
|
|
int prm80_set_channel(RIG * rig, const channel_t * chan)
|
|
{
|
|
char statebuf[BUFSZ];
|
|
int statebuf_len = BUFSZ;
|
|
int ret;
|
|
|
|
if (chan->vfo == RIG_VFO_MEM) {
|
|
ret = prm80_set_mem(rig, RIG_VFO_CURR, chan->channel_num);
|
|
if (ret != RIG_OK)
|
|
return ret;
|
|
}
|
|
|
|
/* [T] = Set current channel state. (Mode-Chan-Chanstate-Sql-Vol-Lock-RX freq-TX freq) ? */
|
|
/* Example: 1240080AFF0033F02D40 ? */
|
|
statebuf_len = sprintf(statebuf, "T%02X%02X%02X%02X%02X%02X%04X%04X",
|
|
chan->mode == RIG_MODE_FM ? 0x12 : 0x12,
|
|
chan->channel_num,
|
|
chan->flags & RIG_CHFLAG_SKIP ? 0x08 : 0, /* TODO: tx shift */
|
|
(unsigned)(chan->levels[LVL_SQL].f*15),
|
|
(unsigned)(chan->levels[LVL_AF].f*15),
|
|
chan->flags & RIG_CHFLAG_SKIP ? 0x01 : 0x00, /* Lock */
|
|
(unsigned)(chan->freq / 12500.),
|
|
(unsigned)(chan->tx_freq / 12500.)
|
|
);
|
|
|
|
ret = prm80_transaction (rig, statebuf, statebuf_len, NULL, NULL);
|
|
if (ret != RIG_OK)
|
|
return ret;
|
|
|
|
return RIG_OK;
|
|
}
|
|
|
|
|
|
/*
|
|
* prm80_set_level
|
|
* Assumes rig!=NULL
|
|
*/
|
|
int prm80_set_level(RIG *rig, vfo_t vfo, setting_t level, value_t val)
|
|
{
|
|
int cmd_len;
|
|
char cmdbuf[BUFSZ];
|
|
|
|
switch (level) {
|
|
case RIG_LEVEL_AF:
|
|
cmd_len = sprintf(cmdbuf, "O%02u" , (unsigned)(val.f * 15));
|
|
|
|
return prm80_transaction (rig, cmdbuf, cmd_len, NULL, NULL);
|
|
|
|
case RIG_LEVEL_SQL:
|
|
cmd_len = sprintf(cmdbuf, "F%02u" , (unsigned)(val.f * 15));
|
|
|
|
return prm80_transaction (rig, cmdbuf, cmd_len, NULL, NULL);
|
|
|
|
case RIG_LEVEL_RFPOWER:
|
|
return -RIG_ENIMPL;
|
|
|
|
default:
|
|
rig_debug(RIG_DEBUG_ERR,"Unsupported set_level %d\n", level);
|
|
return -RIG_EINVAL;
|
|
}
|
|
|
|
return RIG_OK;
|
|
}
|
|
|
|
/*
|
|
* prm80_get_level
|
|
* Assumes rig!=NULL
|
|
*/
|
|
int prm80_get_level(RIG *rig, vfo_t vfo, setting_t level, value_t *val)
|
|
{
|
|
int ret;
|
|
channel_t chan;
|
|
|
|
memset(&chan, 0, sizeof(chan));
|
|
chan.vfo = RIG_VFO_CURR;
|
|
|
|
ret = prm80_get_channel(rig, &chan);
|
|
if (ret != RIG_OK)
|
|
return ret;
|
|
|
|
switch (level) {
|
|
case RIG_LEVEL_AF:
|
|
val->f = chan.levels[LVL_AF].f;
|
|
|
|
return RIG_OK;
|
|
|
|
case RIG_LEVEL_SQL:
|
|
val->f = chan.levels[LVL_SQL].f;
|
|
|
|
return RIG_OK;
|
|
|
|
default:
|
|
rig_debug(RIG_DEBUG_ERR,"Unsupported set_level %d\n", level);
|
|
return -RIG_EINVAL;
|
|
}
|
|
|
|
return RIG_OK;
|
|
}
|
|
|
|
/*
|
|
* prm80_get_info
|
|
* Assumes rig!=NULL
|
|
*/
|
|
const char * prm80_get_info(RIG *rig)
|
|
{
|
|
static char buf[BUFSZ];
|
|
int ret, buf_len=BUFSZ;
|
|
|
|
/* [V] = Print firmware version. */
|
|
ret = prm80_transaction (rig, "V", 1, buf, &buf_len);
|
|
if (ret < 0)
|
|
return NULL;
|
|
|
|
return buf;
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
* initrigs_prm80 is called by rig_backend_load
|
|
*/
|
|
DECLARE_INITRIG_BACKEND(prm80)
|
|
{
|
|
rig_debug(RIG_DEBUG_VERBOSE, "prm80: _init called\n");
|
|
|
|
rig_register(&prm8060_caps);
|
|
|
|
return RIG_OK;
|
|
}
|
|
|