icom.c revision 290001 
1/*
2 * Program to control ICOM radios
3 *
4 * This is a ripoff of the utility routines in the ICOM software
5 * distribution. The only function provided is to load the radio
6 * frequency. All other parameters must be manually set before use.
7 */
8#include <config.h>
9#include <ntp_stdlib.h>
10#include <ntp_tty.h>
11#include <l_stdlib.h>
12#include <icom.h>
13
14#include <unistd.h>
15#include <stdio.h>
16#include <fcntl.h>
17#include <errno.h>
18
19
20#ifdef SYS_WINNT
21#undef write	/* ports/winnt/include/config.h: #define write _write */
22extern int async_write(int, const void *, unsigned int);
23#define write(fd, data, octets)	async_write(fd, data, octets)
24#endif
25
26/*
27 * Packet routines
28 *
29 * These routines send a packet and receive the response. If an error
30 * (collision) occurs on transmit, the packet is resent. If an error
31 * occurs on receive (timeout), all input to the terminating FI is
32 * discarded and the packet is resent. If the maximum number of retries
33 * is not exceeded, the program returns the number of octets in the user
34 * buffer; otherwise, it returns zero.
35 *
36 * ICOM frame format
37 *
38 * Frames begin with a two-octet preamble PR-PR followyd by the
39 * transceiver address RE, controller address TX, control code CN, zero
40 * or more data octets DA (depending on command), and terminator FI.
41 * Since the bus is bidirectional, every octet output is echoed on
42 * input. Every valid frame sent is answered with a frame in the same
43 * format, but with the RE and TX fields interchanged. The CN field is
44 * set to NAK if an error has occurred. Otherwise, the data are returned
45 * in this and following DA octets. If no data are returned, the CN
46 * octet is set to ACK.
47 *
48 *	+------+------+------+------+------+--//--+------+
49 *	|  PR  |  PR  |  RE  |  TX  |  CN  |  DA  |  FI  |
50 *	+------+------+------+------+------+--//--+------+
51 */
52/*
53 * Scraps
54 */
55#define DICOM /dev/icom/	/* ICOM port link */
56
57/*
58 * Local function prototypes
59 */
60static void doublefreq		(double, u_char *, int);
61
62
63/*
64 * icom_freq(fd, ident, freq) - load radio frequency
65 *
66 * returns:
67 *  0 (ok)
68 * -1 (error)
69 *  1 (short write to device)
70 */
71int
72icom_freq(
73	int fd,			/* file descriptor */
74	int ident,		/* ICOM radio identifier */
75	double freq		/* frequency (MHz) */
76	)
77{
78	u_char cmd[] = {PAD, PR, PR, 0, TX, V_SFREQ, 0, 0, 0, 0, FI,
79	    FI};
80	int temp;
81	int rc;
82
83	cmd[3] = (char)ident;
84	if (ident == IC735)
85		temp = 4;
86	else
87		temp = 5;
88	doublefreq(freq * 1e6, &cmd[6], temp);
89	rc = write(fd, cmd, temp + 7);
90	if (rc == -1) {
91		msyslog(LOG_ERR, "icom_freq: write() failed: %m");
92		return -1;
93	} else if (rc != temp + 7) {
94		msyslog(LOG_ERR, "icom_freq: only wrote %d of %d bytes.",
95			rc, temp+7);
96		return 1;
97	}
98
99	return 0;
100}
101
102
103/*
104 * doublefreq(freq, y, len) - double to ICOM frequency with padding
105 */
106static void
107doublefreq(			/* returns void */
108	double freq,		/* frequency */
109	u_char *x,		/* radio frequency */
110	int len			/* length (octets) */
111	)
112{
113	int i;
114	char s1[16];
115	char *y;
116
117	snprintf(s1, sizeof(s1), " %10.0f", freq);
118	y = s1 + 10;
119	i = 0;
120	while (*y != ' ') {
121		x[i] = *y-- & 0x0f;
122		x[i] = x[i] | ((*y-- & 0x0f) << 4);
123		i++;
124	}
125	for ( ; i < len; i++)
126		x[i] = 0;
127	x[i] = FI;
128}
129
130/*
131 * icom_init() - open and initialize serial interface
132 *
133 * This routine opens the serial interface for raw transmission; that
134 * is, character-at-a-time, no stripping, checking or monkeying with the
135 * bits. For Unix, an input operation ends either with the receipt of a
136 * character or a 0.5-s timeout.
137 */
138int
139icom_init(
140	const char *device,	/* device name/link */
141	int speed,		/* line speed */
142	int trace		/* trace flags */	)
143{
144	TTY ttyb;
145	int fd;
146	int rc;
147	int saved_errno;
148
149	fd = tty_open(device, O_RDWR, 0777);
150	if (fd < 0)
151		return -1;
152
153	rc = tcgetattr(fd, &ttyb);
154	if (rc < 0) {
155		saved_errno = errno;
156		close(fd);
157		errno = saved_errno;
158		return -1;
159	}
160	ttyb.c_iflag = 0;	/* input modes */
161	ttyb.c_oflag = 0;	/* output modes */
162	ttyb.c_cflag = IBAUD|CS8|CLOCAL; /* control modes  (no read) */
163	ttyb.c_lflag = 0;	/* local modes */
164	ttyb.c_cc[VMIN] = 0;	/* min chars */
165	ttyb.c_cc[VTIME] = 5;	/* receive timeout */
166	cfsetispeed(&ttyb, (u_int)speed);
167	cfsetospeed(&ttyb, (u_int)speed);
168	rc = tcsetattr(fd, TCSANOW, &ttyb);
169	if (rc < 0) {
170		saved_errno = errno;
171		close(fd);
172		errno = saved_errno;
173		return -1;
174	}
175	return (fd);
176}
177
178/* end program */
179