contrib/ntp/libntp/icom.c

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