kopia lustrzana https://github.com/Hamlib/Hamlib
				
				
				
			
		
			
				
	
	
		
			423 wiersze
		
	
	
		
			9.1 KiB
		
	
	
	
		
			C
		
	
	
			
		
		
	
	
			423 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 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 <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);
 | |
| 
 | |
| 	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;
 | |
| }
 | |
| 
 |