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

Reformat drake.c to Linux C Style

libusb-1-0
Nate Bargmann 2016-02-12 21:07:39 -06:00
rodzic 5436f26023
commit 0e2ee1c4d5
1 zmienionych plików z 213 dodań i 198 usunięć
Pokaż statystyki Ściągnij plik aktualizacji Ściągnij plik porównania Expand all files Collapse all files

411
drake/drake.c
Wyświetl plik

@ -71,19 +71,21 @@ int drake_transaction(RIG *rig, const char *cmd, int cmd_len, char *data, int *d
serial_flush(&rs->rigport); serial_flush(&rs->rigport);
retval = write_block(&rs->rigport, cmd, cmd_len); retval = write_block(&rs->rigport, cmd, cmd_len);
if (retval != RIG_OK) if (retval != RIG_OK)
return retval; return retval;
/* no data expected, TODO: flush input? */ /* no data expected, TODO: flush input? */
if (!data || !data_len) if (!data || !data_len)
return 0; return 0;
retval = read_string(&rs->rigport, data, BUFSZ, LF, 1); retval = read_string(&rs->rigport, data, BUFSZ, LF, 1);
if (retval == -RIG_ETIMEOUT) if (retval == -RIG_ETIMEOUT)
retval = 0; retval = 0;
if (retval < 0) if (retval < 0)
return retval; return retval;
*data_len = retval; *data_len = retval;
return RIG_OK; return RIG_OK;
@ -138,32 +140,36 @@ int drake_set_freq(RIG *rig, vfo_t vfo, freq_t freq)
*/ */
int drake_get_freq(RIG *rig, vfo_t vfo, freq_t *freq) int drake_get_freq(RIG *rig, vfo_t vfo, freq_t *freq)
{ {
int freq_len, retval; int freq_len, retval;
char freqbuf[BUFSZ]; char freqbuf[BUFSZ];
double f; double f;
char fmult; char fmult;
retval = drake_transaction (rig, "RF" EOM, 3, freqbuf, &freq_len); retval = drake_transaction (rig, "RF" EOM, 3, freqbuf, &freq_len);
if (retval != RIG_OK)
return retval;
/* RA command returns *fffff.ff*mHz<CR> */ if (retval != RIG_OK)
if (freq_len != 15) { return retval;
rig_debug(RIG_DEBUG_ERR,"drake_get_freq: wrong answer %s, "
"len=%d\n", freqbuf, freq_len);
return -RIG_ERJCTED;
}
fmult = freqbuf[10];
freqbuf[9] = '\0';
/* extract freq */ /* RA command returns *fffff.ff*mHz<CR> */
sscanf(freqbuf+1, "%lf", &f); if (freq_len != 15) {
rig_debug(RIG_DEBUG_ERR,"drake_get_freq: wrong answer %s, "
"len=%d\n", freqbuf, freq_len);
return -RIG_ERJCTED;
}
fmult = freqbuf[10];
freqbuf[9] = '\0';
/* extract freq */
sscanf(freqbuf+1, "%lf", &f);
f *= 1000.0;
if (fmult=='M'||fmult=='m')
f *= 1000.0; f *= 1000.0;
if (fmult=='M'||fmult=='m')
f *= 1000.0;
*freq = (freq_t)f;
return RIG_OK; *freq = (freq_t)f;
return RIG_OK;
} }
/* /*
@ -183,11 +189,12 @@ int drake_set_vfo(RIG *rig, vfo_t vfo)
case RIG_VFO_MEM: vfo_function = 'C'; break; case RIG_VFO_MEM: vfo_function = 'C'; break;
default: default:
rig_debug(RIG_DEBUG_ERR,"drake_set_vfo: unsupported VFO %d\n", rig_debug(RIG_DEBUG_ERR,"drake_set_vfo: unsupported VFO %d\n",
vfo); vfo);
return -RIG_EINVAL; return -RIG_EINVAL;
} }
cmd_len = 0; cmd_len = 0;
if ((vfo_function=='A')||(vfo_function=='B')) if ((vfo_function=='A')||(vfo_function=='B'))
cmd_len = sprintf((char *) cmdbuf, "V%c" EOM, vfo_function); cmd_len = sprintf((char *) cmdbuf, "V%c" EOM, vfo_function);
if ((vfo_function=='F')||(vfo_function=='C')) if ((vfo_function=='F')||(vfo_function=='C'))
@ -205,17 +212,18 @@ int drake_set_vfo(RIG *rig, vfo_t vfo)
int drake_get_vfo(RIG *rig, vfo_t *vfo) int drake_get_vfo(RIG *rig, vfo_t *vfo)
{ {
int mdbuf_len, retval; int mdbuf_len, retval;
char mdbuf[BUFSZ]; char mdbuf[BUFSZ];
char cvfo; char cvfo;
retval = drake_transaction (rig, "RA" EOM, 3, mdbuf, &mdbuf_len); retval = drake_transaction (rig, "RA" EOM, 3, mdbuf, &mdbuf_len);
if (retval != RIG_OK) if (retval != RIG_OK)
return retval; return retval;
if (mdbuf_len < 35) { if (mdbuf_len < 35) {
rig_debug(RIG_DEBUG_ERR,"drake_get_vfo: wrong answer %s, " rig_debug(RIG_DEBUG_ERR,"drake_get_vfo: wrong answer %s, "
"len=%d\n", mdbuf, mdbuf_len); "len=%d\n", mdbuf, mdbuf_len);
return -RIG_ERJCTED; return -RIG_ERJCTED;
} }
if (mdbuf[0]=='*') if (mdbuf[0]=='*')
@ -226,9 +234,9 @@ int drake_get_vfo(RIG *rig, vfo_t *vfo)
case '0' : *vfo = RIG_VFO_B; break; case '0' : *vfo = RIG_VFO_B; break;
case '8' : *vfo = RIG_VFO_A; break; case '8' : *vfo = RIG_VFO_A; break;
default : rig_debug(RIG_DEBUG_ERR, default : rig_debug(RIG_DEBUG_ERR,
"drake_get_vfo: unsupported vfo %c\n", cvfo); "drake_get_vfo: unsupported vfo %c\n", cvfo);
*vfo = RIG_VFO_VFO; *vfo = RIG_VFO_VFO;
return -RIG_EINVAL; return -RIG_EINVAL;
} }
} }
@ -257,7 +265,7 @@ int drake_set_mode(RIG *rig, vfo_t vfo, rmode_t mode, pbwidth_t width)
case RIG_MODE_RTTY: mode_sel = MD_RTTY; break; case RIG_MODE_RTTY: mode_sel = MD_RTTY; break;
default: default:
rig_debug(RIG_DEBUG_ERR,"drake_set_mode: " rig_debug(RIG_DEBUG_ERR,"drake_set_mode: "
"unsupported mode %d\n", mode); "unsupported mode %d\n", mode);
return -RIG_EINVAL; return -RIG_EINVAL;
} }
@ -280,17 +288,18 @@ int drake_set_mode(RIG *rig, vfo_t vfo, rmode_t mode, pbwidth_t width)
case 6000: width_sel = '6'; break; case 6000: width_sel = '6'; break;
default: default:
rig_debug(RIG_DEBUG_ERR,"drake_set_mode: " rig_debug(RIG_DEBUG_ERR,"drake_set_mode: "
"unsupported width %d\n", width); "unsupported width %d\n", width);
return -RIG_EINVAL; return -RIG_EINVAL;
} }
mdbuf_len = sprintf((char *) mdbuf, "W%c" EOM, width_sel); mdbuf_len = sprintf((char *) mdbuf, "W%c" EOM, width_sel);
retval = drake_transaction (rig, (char *) mdbuf, mdbuf_len, (char *) ackbuf, &ack_len); retval = drake_transaction (rig, (char *) mdbuf, mdbuf_len, (char *) ackbuf, &ack_len);
} }
if ((mode == RIG_MODE_AMS) || (mode == RIG_MODE_ECSSUSB) || (mode == RIG_MODE_ECSSLSB) || if ((mode == RIG_MODE_AMS) || (mode == RIG_MODE_ECSSUSB) || (mode == RIG_MODE_ECSSLSB) ||
(mode == RIG_MODE_AM) || (mode == RIG_MODE_USB) || (mode == RIG_MODE_LSB)) { (mode == RIG_MODE_AM) || (mode == RIG_MODE_USB) || (mode == RIG_MODE_LSB)) {
mdbuf_len = sprintf((char *) mdbuf, "S%c" EOM, mdbuf_len = sprintf((char *) mdbuf, "S%c" EOM,
((mode == RIG_MODE_AMS) || (mode==RIG_MODE_ECSSUSB) || (mode==RIG_MODE_ECSSLSB))?'O':'F'); ((mode == RIG_MODE_AMS) || (mode==RIG_MODE_ECSSUSB) || (mode==RIG_MODE_ECSSLSB))
? 'O' : 'F');
retval = drake_transaction (rig, (char *) mdbuf, mdbuf_len, (char *) ackbuf, &ack_len); retval = drake_transaction (rig, (char *) mdbuf, mdbuf_len, (char *) ackbuf, &ack_len);
} }
@ -311,13 +320,14 @@ int drake_get_mode(RIG *rig, vfo_t vfo, rmode_t *mode, pbwidth_t *width)
char csynch; char csynch;
retval = drake_transaction (rig, "RM" EOM, 3, mdbuf, &mdbuf_len); retval = drake_transaction (rig, "RM" EOM, 3, mdbuf, &mdbuf_len);
if (retval != RIG_OK) if (retval != RIG_OK)
return retval; return retval;
if (mdbuf_len != 8) { if (mdbuf_len != 8) {
rig_debug(RIG_DEBUG_ERR,"drake_get_mode: wrong answer %s, " rig_debug(RIG_DEBUG_ERR,"drake_get_mode: wrong answer %s, "
"len=%d\n", mdbuf, mdbuf_len); "len=%d\n", mdbuf, mdbuf_len);
return -RIG_ERJCTED; return -RIG_ERJCTED;
} }
cmode = mdbuf[3]; cmode = mdbuf[3];
@ -331,48 +341,48 @@ int drake_get_mode(RIG *rig, vfo_t vfo, rmode_t *mode, pbwidth_t *width)
case '3': *width = s_Hz(4000); break; case '3': *width = s_Hz(4000); break;
case '4': *width = s_Hz(6000); break; case '4': *width = s_Hz(6000); break;
default : default :
rig_debug(RIG_DEBUG_ERR, rig_debug(RIG_DEBUG_ERR,
"drake_get_mode: unsupported width %c\n", "drake_get_mode: unsupported width %c\n",
cwidth); cwidth);
*width = RIG_PASSBAND_NORMAL; *width = RIG_PASSBAND_NORMAL;
return -RIG_EINVAL; return -RIG_EINVAL;
} }
if ((cwidth >= '0') && (cwidth <= '4')) { if ((cwidth >= '0') && (cwidth <= '4')) {
switch(cmode & 0x33){ switch(cmode & 0x33){
case '0': *mode = RIG_MODE_LSB; break; case '0': *mode = RIG_MODE_LSB; break;
case '1': *mode = RIG_MODE_RTTY; break; case '1': *mode = RIG_MODE_RTTY; break;
case '2': *mode = RIG_MODE_FM; *width = s_Hz(12000); break; case '2': *mode = RIG_MODE_FM; *width = s_Hz(12000); break;
default : default :
rig_debug(RIG_DEBUG_ERR, rig_debug(RIG_DEBUG_ERR,
"drake_get_mode: unsupported mode %c\n", "drake_get_mode: unsupported mode %c\n",
cmode); cmode);
*mode = RIG_MODE_NONE; *mode = RIG_MODE_NONE;
return -RIG_EINVAL; return -RIG_EINVAL;
} }
} else { } else {
switch(cmode & 0x33){ switch(cmode & 0x33){
case '0': *mode = RIG_MODE_USB; break; case '0': *mode = RIG_MODE_USB; break;
case '1': *mode = RIG_MODE_CW; break; case '1': *mode = RIG_MODE_CW; break;
case '2': *mode = RIG_MODE_AM; break; case '2': *mode = RIG_MODE_AM; break;
default : default :
rig_debug(RIG_DEBUG_ERR, rig_debug(RIG_DEBUG_ERR,
"drake_get_mode: unsupported mode %c\n", "drake_get_mode: unsupported mode %c\n",
cmode); cmode);
*mode = RIG_MODE_NONE; *mode = RIG_MODE_NONE;
return -RIG_EINVAL; return -RIG_EINVAL;
} }
} }
if ((csynch & 0x34) == '4') { if ((csynch & 0x34) == '4') {
if (*mode == RIG_MODE_AM) if (*mode == RIG_MODE_AM)
*mode = RIG_MODE_AMS; *mode = RIG_MODE_AMS;
else else
if (*mode == RIG_MODE_USB) if (*mode == RIG_MODE_USB)
*mode = RIG_MODE_ECSSUSB; *mode = RIG_MODE_ECSSUSB;
else else
if (*mode == RIG_MODE_LSB) if (*mode == RIG_MODE_LSB)
*mode = RIG_MODE_ECSSLSB; *mode = RIG_MODE_ECSSLSB;
} }
return RIG_OK; return RIG_OK;
} }
@ -404,13 +414,14 @@ int drake_get_ant(RIG *rig, vfo_t vfo, ant_t *ant)
char cant; char cant;
retval = drake_transaction (rig, "RM" EOM, 3, mdbuf, &mdbuf_len); retval = drake_transaction (rig, "RM" EOM, 3, mdbuf, &mdbuf_len);
if (retval != RIG_OK) if (retval != RIG_OK)
return retval; return retval;
if (mdbuf_len != 8) { if (mdbuf_len != 8) {
rig_debug(RIG_DEBUG_ERR,"drake_get_ant: wrong answer %s, " rig_debug(RIG_DEBUG_ERR,"drake_get_ant: wrong answer %s, "
"len=%d\n", mdbuf, mdbuf_len); "len=%d\n", mdbuf, mdbuf_len);
return -RIG_ERJCTED; return -RIG_ERJCTED;
} }
cant = mdbuf[3]; cant = mdbuf[3];
@ -420,11 +431,11 @@ int drake_get_ant(RIG *rig, vfo_t vfo, ant_t *ant)
case '4': *ant = RIG_ANT_3; break; case '4': *ant = RIG_ANT_3; break;
case '8': *ant = RIG_ANT_2; break; case '8': *ant = RIG_ANT_2; break;
default : default :
rig_debug(RIG_DEBUG_ERR, rig_debug(RIG_DEBUG_ERR,
"drake_get_ant: unsupported antenna %c\n", "drake_get_ant: unsupported antenna %c\n",
cant); cant);
*ant = RIG_ANT_NONE; *ant = RIG_ANT_NONE;
return -RIG_EINVAL; return -RIG_EINVAL;
} }
return RIG_OK; return RIG_OK;
@ -437,7 +448,7 @@ int drake_get_ant(RIG *rig, vfo_t vfo, ant_t *ant)
int drake_set_mem(RIG *rig, vfo_t vfo, int ch) int drake_set_mem(RIG *rig, vfo_t vfo, int ch)
{ {
int len, ack_len, retval; int len, ack_len, retval;
char buf[16], ackbuf[16]; char buf[16], ackbuf[16];
struct drake_priv_data *priv = rig->state.priv; struct drake_priv_data *priv = rig->state.priv;
priv->curr_ch = ch; priv->curr_ch = ch;
@ -462,17 +473,18 @@ int drake_get_mem(RIG *rig, vfo_t vfo, int *ch)
{ {
struct drake_priv_data *priv = rig->state.priv; struct drake_priv_data *priv = rig->state.priv;
int mdbuf_len, retval; int mdbuf_len, retval;
char mdbuf[BUFSZ]; char mdbuf[BUFSZ];
int chan; int chan;
retval = drake_transaction (rig, "RC" EOM, 3, mdbuf, &mdbuf_len); retval = drake_transaction (rig, "RC" EOM, 3, mdbuf, &mdbuf_len);
if (retval != RIG_OK) if (retval != RIG_OK)
return retval; return retval;
if (mdbuf_len != 6) { if (mdbuf_len != 6) {
rig_debug(RIG_DEBUG_ERR,"drake_get_mem: wrong answer %s, " rig_debug(RIG_DEBUG_ERR,"drake_get_mem: wrong answer %s, "
"len=%d\n", mdbuf, mdbuf_len); "len=%d\n", mdbuf, mdbuf_len);
return -RIG_ERJCTED; return -RIG_ERJCTED;
} }
mdbuf[4] = '\0'; mdbuf[4] = '\0';
@ -495,7 +507,7 @@ int drake_set_chan(RIG *rig, const channel_t *chan)
struct drake_priv_data *priv = rig->state.priv; struct drake_priv_data *priv = rig->state.priv;
vfo_t old_vfo; vfo_t old_vfo;
int old_chan; int old_chan;
char mdbuf[16], ackbuf[16]; char mdbuf[16], ackbuf[16];
int mdbuf_len, ack_len, retval; int mdbuf_len, ack_len, retval;
drake_get_vfo(rig, &old_vfo); drake_get_vfo(rig, &old_vfo);
@ -514,15 +526,15 @@ int drake_set_chan(RIG *rig, const channel_t *chan)
drake_set_freq(rig, RIG_VFO_CURR, chan->freq); drake_set_freq(rig, RIG_VFO_CURR, chan->freq);
drake_set_mode(rig, RIG_VFO_CURR, chan->mode, chan->width); drake_set_mode(rig, RIG_VFO_CURR, chan->mode, chan->width);
drake_set_func(rig, RIG_VFO_CURR, RIG_FUNC_NB, drake_set_func(rig, RIG_VFO_CURR, RIG_FUNC_NB,
(chan->funcs & RIG_FUNC_NB) == RIG_FUNC_NB); (chan->funcs & RIG_FUNC_NB) == RIG_FUNC_NB);
drake_set_level(rig, RIG_VFO_CURR, RIG_LEVEL_AGC, drake_set_level(rig, RIG_VFO_CURR, RIG_LEVEL_AGC,
chan->levels[rig_setting2idx(RIG_LEVEL_AGC)]); chan->levels[rig_setting2idx(RIG_LEVEL_AGC)]);
drake_set_level(rig, RIG_VFO_CURR, RIG_LEVEL_PREAMP, drake_set_level(rig, RIG_VFO_CURR, RIG_LEVEL_PREAMP,
chan->levels[rig_setting2idx(RIG_LEVEL_PREAMP)]); chan->levels[rig_setting2idx(RIG_LEVEL_PREAMP)]);
drake_set_level(rig, RIG_VFO_CURR, RIG_LEVEL_ATT, drake_set_level(rig, RIG_VFO_CURR, RIG_LEVEL_ATT,
chan->levels[rig_setting2idx(RIG_LEVEL_ATT)]); chan->levels[rig_setting2idx(RIG_LEVEL_ATT)]);
drake_set_func(rig, RIG_VFO_CURR, RIG_FUNC_MN, drake_set_func(rig, RIG_VFO_CURR, RIG_FUNC_MN,
(chan->funcs & RIG_FUNC_MN) == RIG_FUNC_MN); (chan->funcs & RIG_FUNC_MN) == RIG_FUNC_MN);
mdbuf_len = sprintf(mdbuf, "PR" EOM "%03d" EOM, chan->channel_num); mdbuf_len = sprintf(mdbuf, "PR" EOM "%03d" EOM, chan->channel_num);
retval = drake_transaction (rig, mdbuf, mdbuf_len, ackbuf, &ack_len); retval = drake_transaction (rig, mdbuf, mdbuf_len, ackbuf, &ack_len);
@ -542,7 +554,7 @@ int drake_get_chan(RIG *rig, channel_t *chan)
struct drake_priv_data *priv = rig->state.priv; struct drake_priv_data *priv = rig->state.priv;
vfo_t old_vfo; vfo_t old_vfo;
int old_chan; int old_chan;
char mdbuf[BUFSZ],freqstr[BUFSZ]; char mdbuf[BUFSZ],freqstr[BUFSZ];
int mdbuf_len, retval; int mdbuf_len, retval;
chan->vfo = RIG_VFO_MEM; chan->vfo = RIG_VFO_MEM;
@ -586,22 +598,22 @@ int drake_get_chan(RIG *rig, channel_t *chan)
//now decypher it //now decypher it
retval = drake_transaction (rig, "RA" EOM, 3, mdbuf, &mdbuf_len); retval = drake_transaction (rig, "RA" EOM, 3, mdbuf, &mdbuf_len);
if (retval != RIG_OK) if (retval != RIG_OK)
return retval; return retval;
if (mdbuf_len < 35) { if (mdbuf_len < 35) {
rig_debug(RIG_DEBUG_ERR,"drake_get_channel: wrong answer %s, " rig_debug(RIG_DEBUG_ERR,"drake_get_channel: wrong answer %s, "
"len=%d\n", mdbuf, mdbuf_len); "len=%d\n", mdbuf, mdbuf_len);
return -RIG_ERJCTED; return -RIG_ERJCTED;
} }
if ((mdbuf[5] >= '4') && (mdbuf[5] <= '?')) if ((mdbuf[5] >= '4') && (mdbuf[5] <= '?'))
chan->funcs |= RIG_FUNC_NB; chan->funcs |= RIG_FUNC_NB;
switch(mdbuf[5] & 0x33){ switch(mdbuf[5] & 0x33){
case '0': chan->levels[rig_setting2idx(RIG_LEVEL_AGC)].i = RIG_AGC_OFF; break; case '0': chan->levels[rig_setting2idx(RIG_LEVEL_AGC)].i = RIG_AGC_OFF; break;
case '2': chan->levels[rig_setting2idx(RIG_LEVEL_AGC)].i = RIG_AGC_FAST; break; case '2': chan->levels[rig_setting2idx(RIG_LEVEL_AGC)].i = RIG_AGC_FAST; break;
case '3': chan->levels[rig_setting2idx(RIG_LEVEL_AGC)].i = RIG_AGC_SLOW; break; case '3': chan->levels[rig_setting2idx(RIG_LEVEL_AGC)].i = RIG_AGC_SLOW; break;
default : chan->levels[rig_setting2idx(RIG_LEVEL_AGC)].i = RIG_AGC_FAST; default : chan->levels[rig_setting2idx(RIG_LEVEL_AGC)].i = RIG_AGC_FAST;
} }
if ((mdbuf[6] & 0x3c) == '8') if ((mdbuf[6] & 0x3c) == '8')
@ -614,35 +626,35 @@ int drake_get_chan(RIG *rig, channel_t *chan)
chan->funcs |= RIG_FUNC_MN; chan->funcs |= RIG_FUNC_MN;
switch(mdbuf[7] & 0x3c){ switch(mdbuf[7] & 0x3c){
case '0': chan->ant = RIG_ANT_1; break; case '0': chan->ant = RIG_ANT_1; break;
case '4': chan->ant = RIG_ANT_3; break; case '4': chan->ant = RIG_ANT_3; break;
case '8': chan->ant = RIG_ANT_2; break; case '8': chan->ant = RIG_ANT_2; break;
default : chan->ant = RIG_ANT_NONE; default : chan->ant = RIG_ANT_NONE;
} }
switch(mdbuf[8] & 0x37){ switch(mdbuf[8] & 0x37){
case '0': chan->width = s_Hz(500); break; case '0': chan->width = s_Hz(500); break;
case '1': chan->width = s_Hz(1800); break; case '1': chan->width = s_Hz(1800); break;
case '2': chan->width = s_Hz(2300); break; case '2': chan->width = s_Hz(2300); break;
case '3': chan->width = s_Hz(4000); break; case '3': chan->width = s_Hz(4000); break;
case '4': chan->width = s_Hz(6000); break; case '4': chan->width = s_Hz(6000); break;
default : chan->width = RIG_PASSBAND_NORMAL; default : chan->width = RIG_PASSBAND_NORMAL;
} }
if ((mdbuf[8] >= '0') && (mdbuf[8] <= '4')) { if ((mdbuf[8] >= '0') && (mdbuf[8] <= '4')) {
switch(mdbuf[7] & 0x33){ switch(mdbuf[7] & 0x33){
case '0': chan->mode = RIG_MODE_LSB; break; case '0': chan->mode = RIG_MODE_LSB; break;
case '1': chan->mode = RIG_MODE_RTTY; break; case '1': chan->mode = RIG_MODE_RTTY; break;
case '2': chan->mode = RIG_MODE_FM; case '2': chan->mode = RIG_MODE_FM;
chan->width = s_Hz(12000); break; chan->width = s_Hz(12000); break;
default : chan->mode = RIG_MODE_NONE; default : chan->mode = RIG_MODE_NONE;
} }
} else { } else {
switch(mdbuf[7] & 0x33){ switch(mdbuf[7] & 0x33){
case '0': chan->mode = RIG_MODE_USB; break; case '0': chan->mode = RIG_MODE_USB; break;
case '1': chan->mode = RIG_MODE_CW; break; case '1': chan->mode = RIG_MODE_CW; break;
case '2': chan->mode = RIG_MODE_AM; break; case '2': chan->mode = RIG_MODE_AM; break;
default : chan->mode = RIG_MODE_NONE; default : chan->mode = RIG_MODE_NONE;
} }
} }
@ -670,8 +682,7 @@ int drake_get_chan(RIG *rig, channel_t *chan)
retval = drake_set_vfo(rig, RIG_VFO_VFO); retval = drake_set_vfo(rig, RIG_VFO_VFO);
if (retval != RIG_OK) if (retval != RIG_OK)
return retval; return retval;
} } else {
else {
retval = drake_set_mem(rig, RIG_VFO_CURR, old_chan); retval = drake_set_mem(rig, RIG_VFO_CURR, old_chan);
if (retval != RIG_OK) if (retval != RIG_OK)
return retval; return retval;
@ -759,28 +770,29 @@ int drake_get_func(RIG *rig, vfo_t vfo, setting_t func, int *status)
char mc; char mc;
retval = drake_transaction (rig, "RM" EOM, 3, mdbuf, &mdbuf_len); retval = drake_transaction (rig, "RM" EOM, 3, mdbuf, &mdbuf_len);
if (retval != RIG_OK) if (retval != RIG_OK)
return retval; return retval;
if (mdbuf_len != 8) { if (mdbuf_len != 8) {
rig_debug(RIG_DEBUG_ERR,"drake_get_func: wrong answer %s, " rig_debug(RIG_DEBUG_ERR,"drake_get_func: wrong answer %s, "
"len=%d\n", mdbuf, mdbuf_len); "len=%d\n", mdbuf, mdbuf_len);
return -RIG_ERJCTED; return -RIG_ERJCTED;
} }
switch(func) { switch(func) {
case RIG_FUNC_MN: case RIG_FUNC_MN:
mc = mdbuf[2]; mc = mdbuf[2];
*status = ((mc & 0x32) =='2'); *status = ((mc & 0x32) =='2');
break; break;
case RIG_FUNC_NB: case RIG_FUNC_NB:
/* TODO: NB narrow */ /* TODO: NB narrow */
mc = mdbuf[1]; mc = mdbuf[1];
*status = ((mc >= '4') && (mc <= '?')); *status = ((mc >= '4') && (mc <= '?'));
break; break;
default: default:
rig_debug(RIG_DEBUG_ERR,"Unsupported get func %d\n",func); rig_debug(RIG_DEBUG_ERR,"Unsupported get func %d\n",func);
return -RIG_EINVAL; return -RIG_EINVAL;
} }
return RIG_OK; return RIG_OK;
@ -804,8 +816,8 @@ int drake_set_level(RIG *rig, vfo_t vfo, setting_t level, value_t val)
break; break;
case RIG_LEVEL_AGC: case RIG_LEVEL_AGC:
len = sprintf(buf,"A%c" EOM, len = sprintf(buf,"A%c" EOM,
val.i==RIG_AGC_OFF?'O': val.i==RIG_AGC_OFF?'O':
(val.i==RIG_AGC_FAST?'F':'S')); (val.i==RIG_AGC_FAST?'F':'S'));
break; break;
default: default:
return -RIG_EINVAL; return -RIG_EINVAL;
@ -827,73 +839,73 @@ int drake_get_level(RIG *rig, vfo_t vfo, setting_t level, value_t *val)
char mc; char mc;
if ((level != RIG_LEVEL_RAWSTR)&&(level != RIG_LEVEL_STRENGTH)) { if ((level != RIG_LEVEL_RAWSTR)&&(level != RIG_LEVEL_STRENGTH)) {
retval = drake_transaction (rig, "RM" EOM, 3, lvlbuf, &lvl_len); retval = drake_transaction (rig, "RM" EOM, 3, lvlbuf, &lvl_len);
if (retval != RIG_OK) if (retval != RIG_OK)
return retval; return retval;
if (lvl_len != 8) { if (lvl_len != 8) {
rig_debug(RIG_DEBUG_ERR,"drake_get_level: wrong answer %s, " rig_debug(RIG_DEBUG_ERR,"drake_get_level: wrong answer %s, "
"len=%d\n", lvlbuf, lvl_len); "len=%d\n", lvlbuf, lvl_len);
return -RIG_ERJCTED; return -RIG_ERJCTED;
} }
} }
switch(level) { switch(level) {
case RIG_LEVEL_RAWSTR: case RIG_LEVEL_RAWSTR:
retval = drake_transaction (rig, "RSS" EOM, 4, lvlbuf, &lvl_len); retval = drake_transaction (rig, "RSS" EOM, 4, lvlbuf, &lvl_len);
if (retval != RIG_OK) if (retval != RIG_OK)
return retval; return retval;
if (lvl_len != 5) { if (lvl_len != 5) {
rig_debug(RIG_DEBUG_ERR,"drake_get_level: wrong answer" rig_debug(RIG_DEBUG_ERR,"drake_get_level: wrong answer"
"len=%d\n", lvl_len); "len=%d\n", lvl_len);
return -RIG_ERJCTED; return -RIG_ERJCTED;
} }
lvlbuf[3] = '\0'; lvlbuf[3] = '\0';
val->i = strtol(lvlbuf+1, (char **)NULL, 16); val->i = strtol(lvlbuf+1, (char **)NULL, 16);
break; break;
case RIG_LEVEL_STRENGTH: case RIG_LEVEL_STRENGTH:
retval = drake_transaction (rig, "RSS" EOM, 4, lvlbuf, &lvl_len); retval = drake_transaction (rig, "RSS" EOM, 4, lvlbuf, &lvl_len);
if (retval != RIG_OK) if (retval != RIG_OK)
return retval; return retval;
if (lvl_len != 5) { if (lvl_len != 5) {
rig_debug(RIG_DEBUG_ERR,"drake_get_level: wrong answer" rig_debug(RIG_DEBUG_ERR,"drake_get_level: wrong answer"
"len=%d\n", lvl_len); "len=%d\n", lvl_len);
return -RIG_ERJCTED; return -RIG_ERJCTED;
} }
lvlbuf[3] = '\0'; lvlbuf[3] = '\0';
ss = strtol(lvlbuf+1, (char **)NULL, 16); ss = strtol(lvlbuf+1, (char **)NULL, 16);
val->i = (int)rig_raw2val(ss,&rig->caps->str_cal); val->i = (int)rig_raw2val(ss,&rig->caps->str_cal);
break; break;
case RIG_LEVEL_PREAMP: case RIG_LEVEL_PREAMP:
mc = lvlbuf[2]; mc = lvlbuf[2];
if ((mc & 0x3c) == '8') if ((mc & 0x3c) == '8')
val->i = 10; val->i = 10;
else else
val->i = 0; val->i = 0;
break; break;
case RIG_LEVEL_ATT: case RIG_LEVEL_ATT:
mc = lvlbuf[2]; mc = lvlbuf[2];
if ((mc & 0x3c) =='4') if ((mc & 0x3c) =='4')
val->i = 10; val->i = 10;
else else
val->i = 0; val->i = 0;
break; break;
case RIG_LEVEL_AGC: case RIG_LEVEL_AGC:
mc = lvlbuf[1]; mc = lvlbuf[1];
switch(mc & 0x33){ switch(mc & 0x33){
case '0': val->i = RIG_AGC_OFF; break; case '0': val->i = RIG_AGC_OFF; break;
case '2': val->i = RIG_AGC_FAST; break; case '2': val->i = RIG_AGC_FAST; break;
case '3': val->i = RIG_AGC_SLOW; break; case '3': val->i = RIG_AGC_SLOW; break;
default : val->i = RIG_AGC_FAST; default : val->i = RIG_AGC_FAST;
} }
break; break;
default: default:
rig_debug(RIG_DEBUG_ERR,"Unsupported get_level %d\n",level); rig_debug(RIG_DEBUG_ERR,"Unsupported get_level %d\n",level);
return -RIG_EINVAL; return -RIG_EINVAL;
} }
return RIG_OK; return RIG_OK;
@ -917,8 +929,9 @@ int drake_get_powerstat (RIG * rig, powerstat_t *status)
char mdbuf[BUFSZ]; char mdbuf[BUFSZ];
retval = drake_transaction (rig, "RM" EOM, 3, mdbuf, &mdlen); retval = drake_transaction (rig, "RM" EOM, 3, mdbuf, &mdlen);
if (retval != RIG_OK) if (retval != RIG_OK)
return retval; return retval;
*status = (mdlen == 8); *status = (mdlen == 8);
@ -937,6 +950,7 @@ const char *drake_get_info(RIG *rig)
int retval, id_len; int retval, id_len;
retval = drake_transaction(rig, "ID" EOM, 3, idbuf, &id_len); retval = drake_transaction(rig, "ID" EOM, 3, idbuf, &id_len);
if (retval != RIG_OK) if (retval != RIG_OK)
return NULL; return NULL;
@ -979,6 +993,7 @@ DECLARE_PROBERIG_BACKEND(drake)
port->retry = 1; port->retry = 1;
retval = serial_open(port); retval = serial_open(port);
if (retval != RIG_OK) if (retval != RIG_OK)
return RIG_MODEL_NONE; return RIG_MODEL_NONE;
@ -1008,8 +1023,8 @@ DECLARE_PROBERIG_BACKEND(drake)
*/ */
if (memcmp(idbuf, "ID" EOM, 3)) /* catch loopback serial */ if (memcmp(idbuf, "ID" EOM, 3)) /* catch loopback serial */
rig_debug(RIG_DEBUG_VERBOSE,"probe_drake: found unknown device " rig_debug(RIG_DEBUG_VERBOSE,"probe_drake: found unknown device "
"with ID '%s', please report to Hamlib " "with ID '%s', please report to Hamlib "
"developers.\n", idbuf); "developers.\n", idbuf);
return RIG_MODEL_NONE; return RIG_MODEL_NONE;
} }