xref: /freebsd/contrib/ntp/libntp/icom.c (revision b626f5a73a48f44a31a200291b141e1da408a2ff)
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 */
22 extern 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  */
60 static 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  */
71 int
icom_freq(int fd,int ident,double freq)72 icom_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  */
106 static void
doublefreq(double freq,u_char * x,int len)107 doublefreq(			/* 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  */
138 int
icom_init(const char * device,int speed,int trace)139 icom_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