kopia lustrzana https://github.com/Hamlib/Hamlib
Added read_serial function to read strings from a port.
git-svn-id: https://hamlib.svn.sourceforge.net/svnroot/hamlib/trunk@846 7ae35d74-ebe9-4afe-98af-79ac388436b8Hamlib-1.1.3
rodzic
a95aa52b1b
commit
2e78e9b0bb
75
src/serial.c
75
src/serial.c
|
@ -4,7 +4,7 @@
|
|||
* Parts of the PTT handling are derived from soundmodem, an excellent
|
||||
* ham packet softmodem written by Thomas Sailer, HB9JNX.
|
||||
*
|
||||
* $Id: serial.c,v 1.21 2001-12-27 22:00:43 fillods Exp $
|
||||
* $Id: serial.c,v 1.22 2002-01-07 17:14:22 fgretief Exp $
|
||||
*
|
||||
* This library is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU Library General Public License as
|
||||
|
@ -126,6 +126,7 @@ int serial_open(port_t *rp) {
|
|||
#else /* sgtty */
|
||||
ioctl (fd, TIOCGETP, &sg);
|
||||
#endif
|
||||
cfmakeraw(&options); /* Set serial port to RAW mode by default. */
|
||||
|
||||
/*
|
||||
* Set the baud rates to requested values
|
||||
|
@ -567,6 +568,78 @@ int fread_block(port_t *p, char *rxbuffer, size_t count)
|
|||
return total_count; /* return bytes count read */
|
||||
}
|
||||
|
||||
/*
|
||||
* Read a string from "fd" and put result into
|
||||
* an array of unsigned char pointed to by "rxbuffer"
|
||||
*
|
||||
* Blocks on read until timeout hits.
|
||||
*
|
||||
* It then reads characters until one of the characters in
|
||||
* "stopset" is found, or until "rxmax-1" characters was copied
|
||||
* into rxbuffer. String termination character is added at the end.
|
||||
*
|
||||
* Actually, this function has nothing specific to serial comm,
|
||||
* it could work very well also with any file handle, like a socket.
|
||||
*
|
||||
* Assumes rxbuffer!=NULL
|
||||
*/
|
||||
int read_string(port_t *p, char *rxbuffer, size_t rxmax, const char *stopset)
|
||||
{
|
||||
fd_set rfds;
|
||||
struct timeval tv, tv_timeout;
|
||||
int rd_count, total_count = 0;
|
||||
int retval;
|
||||
|
||||
rxbuffer[0] = '\000';
|
||||
|
||||
FD_ZERO(&rfds);
|
||||
FD_SET(p->fd, &rfds);
|
||||
|
||||
/*
|
||||
* Wait up to timeout ms.
|
||||
*/
|
||||
tv_timeout.tv_sec = p->timeout/1000;
|
||||
tv_timeout.tv_usec = (p->timeout%1000)*1000;
|
||||
|
||||
while (total_count < (rxmax-1)) {
|
||||
tv = tv_timeout; /* select may have updated it */
|
||||
|
||||
retval = select(p->fd+1, &rfds, NULL, NULL, &tv);
|
||||
if (retval == 0) /* Timed out */
|
||||
break;
|
||||
|
||||
if (retval < 0) {
|
||||
rig_debug(RIG_DEBUG_ERR,__FUNCTION__": select error after %d chars:"
|
||||
" %s\n", total_count, strerror(errno));
|
||||
return -RIG_EIO;
|
||||
}
|
||||
/*
|
||||
* read 1 character from the rig, (check if in stop set)
|
||||
* The file descriptor must have been set up non blocking.
|
||||
*/
|
||||
rd_count = read(p->fd, &rxbuffer[total_count], 1);
|
||||
if (rd_count < 0) {
|
||||
rig_debug(RIG_DEBUG_ERR, __FUNCTION__": read failed - %s\n",
|
||||
strerror(errno));
|
||||
return -RIG_EIO;
|
||||
}
|
||||
++total_count;
|
||||
if (stopset && strchr(stopset, rxbuffer[total_count-1]))
|
||||
break;
|
||||
/* Note: This function will always break on a '\000' character. */
|
||||
}
|
||||
rxbuffer[total_count] = '\000';
|
||||
|
||||
if (total_count == 0) {
|
||||
rig_debug(RIG_DEBUG_WARN, __FUNCTION__": timedout without reading a character\n");
|
||||
return -RIG_ETIMEOUT;
|
||||
}
|
||||
|
||||
rig_debug(RIG_DEBUG_TRACE,"RX %d characters\n",total_count);
|
||||
dump_hex(rxbuffer, total_count);
|
||||
return total_count; /* return bytes count read */
|
||||
}
|
||||
|
||||
/*
|
||||
* ser_ptt_set and par_ptt_set
|
||||
* ser_ptt_open/ser_ptt_close & par_ptt_open/par_ptt_close
|
||||
|
|
|
@ -2,7 +2,7 @@
|
|||
* Hamlib Interface - serial communication header
|
||||
* Copyright (c) 2000,2001 by Stephane Fillod and Frank Singleton
|
||||
*
|
||||
* $Id: serial.h,v 1.14 2001-12-17 22:42:48 fillods Exp $
|
||||
* $Id: serial.h,v 1.15 2002-01-07 17:14:22 fgretief Exp $
|
||||
*
|
||||
* This library is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU Library General Public License as
|
||||
|
@ -31,6 +31,7 @@ extern HAMLIB_EXPORT(int) read_block(port_t *p, char *rxbuffer, size_t count);
|
|||
extern HAMLIB_EXPORT(int) write_block(port_t *p, const char *txbuffer, size_t count);
|
||||
extern HAMLIB_EXPORT(int) fread_block(port_t *p, char *rxbuffer, size_t count);
|
||||
extern HAMLIB_EXPORT(int) serial_flush(port_t *p);
|
||||
extern HAMLIB_EXPORT(int) read_string(port_t *p, char *rxbuffer, size_t rxmax, const char *stopset);
|
||||
|
||||
/* Hamlib internal use, see rig.c */
|
||||
int ser_open(port_t *p);
|
||||
|
|
Ładowanie…
Reference in New Issue