X-Git-Url: http://git.jankratochvil.net/?p=gnokii.git;a=blobdiff_plain;f=common%2Fdevices%2Funixserial.c;h=9594d890e21e20a5a5c3140fa78c5a299139262e;hp=bc7e37eb0dbace25d9f7dfd91df3ea5ad0cca651;hb=49dd905279a8e62936e3713510ab0fd738e20ecb;hpb=2f2703c9133032c12671ca5c77ae626b8fb178d4 diff --git a/common/devices/unixserial.c b/common/devices/unixserial.c index bc7e37e..9594d89 100644 --- a/common/devices/unixserial.c +++ b/common/devices/unixserial.c @@ -6,11 +6,47 @@ A Linux/Unix toolset and driver for Nokia mobile phones. + Copyright (C) 1999, 2000 Hugh Blemings & Pavel Janík ml. + Released under the terms of the GNU GPL, see file COPYING for more details. + $Log$ + Revision 1.1.1.5 2002/04/03 00:08:07 short + Found in "gnokii-working" directory, some November-patches version + + Revision 1.9 2001/09/14 12:15:28 pkot + Cleanups from 0.3.3 (part1) + + Revision 1.8 2001/08/20 23:27:37 pkot + Add hardware shakehand to the link layer (Manfred Jonsson) + + Revision 1.7 2001/07/03 00:03:36 pkot + Small fixes to let gnokii compile and work under solaris (thanks to Artur Kubiak) + + Revision 1.6 2001/03/21 23:36:04 chris + Added the statemachine + This will break gnokii --identify and --monitor except for 6210/7110 + + Revision 1.5 2001/03/19 23:43:46 pkot + Solaris/ *BSD '#if defined' cleanup + + Revision 1.4 2001/03/13 01:21:38 pkot + *BSD updates (Bert Driehuis) + + Revision 1.3 2001/03/06 22:27:46 pkot + Misc docs and Makefiles updates and cleanups + + Revision 1.2 2001/02/21 19:57:05 chris + More fiddling with the directory layout + + */ +/* [global] option "serial_write_usleep" default: */ +#define SERIAL_WRITE_USLEEP_DEFAULT (-1) + #include "misc.h" +#include "cfgreader.h" /* Do not compile this file under Win32 systems. */ @@ -20,6 +56,12 @@ #include #include #include +#include +#include +#include +#include +#include +#include #if __unices__ # include @@ -64,12 +106,91 @@ struct termios serial_termios; +/* Script handling: */ + +static void device_script_cfgfunc(const char *section,const char *key,const char *value) +{ + setenv(key,value,1/*overwrite*/); /* errors ignored */ +} + +static int device_script(int fd, const char *section) +{ +pid_t pid; +const char *scriptname = CFG_Get(CFG_Info, "global", section); + + if (!scriptname) + return(0); + + errno=0; + switch ((pid=fork())) { + case -1: + fprintf(stderr,_("device_script(\"%s\"): fork() failure: %s!\n"),scriptname,strerror(errno)); + return(-1); + + default: { /* parent */ +int status; + if (pid==waitpid(pid,&status,0/*options*/) && WIFEXITED(status) && !WEXITSTATUS(status)) + return(0); + fprintf(stderr,_("device_script(\"%s\"): child script failure: %s, exit code=%d\n"),scriptname, + (WIFEXITED(status) ? _("normal exit") : _("abnormal exit")), + (WIFEXITED(status) ? WEXITSTATUS(status) : -1)); + errno=EIO; + return(-1); + } + + case 0: { /* child */ + CFG_GetForeach(CFG_Info,section,device_script_cfgfunc); + errno=0; + if (0!=dup2(fd,0) || 1!=dup2(fd,1) || close(fd)) { + fprintf(stderr,_("device_script(\"%s\"): file descriptor prepare: %s\n"),scriptname,strerror(errno)); + _exit(-1); + } + /* FIXME: close all open descriptors - how to track them? + */ + execl("/bin/sh","sh","-c",scriptname,NULL); + fprintf(stderr,_("device_script(\"%s\"): execute script: %s\n"),scriptname,strerror(errno)); + _exit(-1); + /* NOTREACHED */ + } + } + /* NOTREACHED */ +} + +int serial_close_all_openfds[0x10]; /* -1 when entry not used, fd otherwise */ +int serial_close(int __fd); + +static void serial_close_all(void) +{ + int i; + + dprintf("serial_close_all() executed\n"); + for (i=0;i= 0) { +#if 1 /* HACK */ + serial_termios.c_cflag |= HUPCL; /* production == 1 */ +#else + serial_termios.c_cflag &= ~HUPCL; /* debugging == 0 */ +#endif - if (__fd >= 0) tcsetattr(__fd, TCSANOW, &serial_termios); + } return (close(__fd)); } -/* Open a device with standard options. */ - +/* Open a device with standard options. + * Use value (-1) for "__with_hw_handshake" if its specification is required from the user + */ int serial_opendevice(__const char *__file, int __with_odd_parity, int __with_async, int __with_hw_handshake) { int fd; int retcode; struct termios tp; + /* handle config file handshake override: */ + { +char *s=CFG_Get(CFG_Info, "global", "handshake"); + + if (s && (!strcasecmp(s,"software") || !strcasecmp(s,"rtscts"))) + __with_hw_handshake=false; + else if (s && (!strcasecmp(s,"hardware") || !strcasecmp(s,"xonxoff"))) + __with_hw_handshake=true; + else if (s) + fprintf(stderr,_("Unrecognized [%s] option \"%s\", use \"%s\" or \"%s\" value, ignoring!"), + "global","handshake","software","hardware"); + + if (__with_hw_handshake==-1) { + fprintf(stderr,_("[%s] option \"%s\" not found, trying to use \"%s\" value!"), + "global","handshake","software"); + __with_hw_handshake=false; + } + } + /* Open device */ + /* O_NONBLOCK MUST be used here as the CLOCAL may be currently off + * and if DCD is down the "open" syscall would be stuck wating for DCD. + */ fd = serial_open(__file, O_RDWR | O_NOCTTY | O_NONBLOCK); if (fd < 0) return fd; - /* Allow process/thread to receive SIGIO */ - -#if !(__unices__) - retcode = fcntl(fd, F_SETOWN, getpid()); - if (retcode == -1){ - perror("Gnokii serial_opendevice: fnctl(F_SETOWN)"); - serial_close(fd); - return(-1); - } -#endif - - /* Make filedescriptor asynchronous. */ - - if (__with_async) { - retcode=fcntl(fd, F_SETFL, FASYNC); - if (retcode == -1){ - perror("Gnokii serial_opendevice: fnctl(F_SETFL)"); - serial_close(fd); - return(-1); - } - } - /* Initialise the port settings */ memcpy(&tp, &serial_termios, sizeof(struct termios)); /* Set port settings for canonical input processing */ - tp.c_cflag = B0 | CS8 | CLOCAL | CREAD; + tp.c_cflag = B0 | CS8 | CLOCAL | CREAD | HUPCL; if (__with_odd_parity) { tp.c_cflag |= (PARENB | PARODD); tp.c_iflag = 0; @@ -172,6 +317,61 @@ int serial_opendevice(__const char *__file, int __with_odd_parity, int __with_as return(-1); } + /* Set speed */ + { +char *baudratestring=CFG_Get(CFG_Info, "global", "serial_baudrate"); +int baudrate=0; + + if (baudratestring) + baudrate=atoi(baudratestring); + if (baudrate && !serial_changespeed(fd,baudrate)) + baudrate=0; + if (!baudrate) + serial_changespeed(fd,19200/*default value*/); + } + + /* We need to turn off O_NONBLOCK now (we have CLOCAL set so it is safe). + * When we run some device script it really doesn't expect NONBLOCK! + */ + + retcode=fcntl(fd, F_SETFL, 0); + if (retcode == -1){ + perror("Gnokii serial_opendevice: fnctl(F_SETFL)"); + serial_close(fd); + return(-1); + } + + /* handle config file connect_script: + */ + if (-1 == device_script(fd,"connect_script")) { + fprintf(stderr,"Gnokii serial_opendevice: connect_script\n"); + serial_close(fd); + return(-1); + } + + /* Allow process/thread to receive SIGIO */ + +#if !(__unices__) + retcode = fcntl(fd, F_SETOWN, getpid()); + if (retcode == -1){ + perror("Gnokii serial_opendevice: fnctl(F_SETOWN)"); + serial_close(fd); + return(-1); + } +#endif + + /* Make filedescriptor asynchronous. */ + + /* We need to supply FNONBLOCK (or O_NONBLOCK) again as it would get reset + * by F_SETFL as a side-effect! + */ + retcode=fcntl(fd, F_SETFL, (__with_async ? FASYNC : 0) | FNONBLOCK); + if (retcode == -1){ + perror("Gnokii serial_opendevice: fnctl(F_SETFL)"); + serial_close(fd); + return(-1); + } + return fd; } @@ -183,13 +383,17 @@ void serial_setdtrrts(int __fd, int __dtr, int __rts) { flags = TIOCM_DTR; - if (__dtr) ioctl(__fd, TIOCMBIS, &flags); - else ioctl(__fd, TIOCMBIC, &flags); + if (__dtr) + ioctl(__fd, TIOCMBIS, &flags); + else + ioctl(__fd, TIOCMBIC, &flags); flags = TIOCM_RTS; - if (__rts) ioctl(__fd, TIOCMBIS, &flags); - else ioctl(__fd, TIOCMBIC, &flags); + if (__rts) + ioctl(__fd, TIOCMBIS, &flags); + else + ioctl(__fd, TIOCMBIC, &flags); } @@ -205,9 +409,12 @@ int serial_select(int fd, struct timeval *timeout) { } -/* Change the speed of the serial device. */ +/* Change the speed of the serial device. + * RETURNS: Success + */ -void serial_changespeed(int __fd, int __speed) { +bool serial_changespeed(int __fd, int __speed) { + bool retcode = true; #ifndef SGTTY struct termios t; @@ -223,30 +430,36 @@ void serial_changespeed(int __fd, int __speed) { case 38400: speed = B38400; break; case 57600: speed = B57600; break; case 115200: speed = B115200; break; + default: + fprintf(stderr,_("Serial port speed %d not supported!\n"),__speed); + return(false); } #ifndef SGTTY - tcgetattr(__fd, &t); + if (tcgetattr(__fd, &t)) + retcode = false; // This is not needed! We set up the speed via cfsetspeed // t.c_cflag &= ~CBAUD; // t.c_cflag |= speed; -#ifdef DEBUG - if (cfsetspeed(&t, speed) == -1) - fprintf(stdout,_("Serial port speed setting failed\n")); -#else - cfsetspeed(&t, speed); -#endif + if (cfsetspeed(&t, speed) == -1) { + dprintf(_("Serial port speed setting failed\n")); + retcode = false; + } tcsetattr(__fd, TCSADRAIN, &t); #else - ioctl(__fd, TIOCGETP, &t); + if (ioctl(__fd, TIOCGETP, &t)) + retcode = false; t.sg_ispeed = speed; t.sg_ospeed = speed; - ioctl(__fd, TIOCSETN, &t); + if (ioctl(__fd, TIOCSETN, &t)) + retcode = false; #endif + + return(retcode); } /* Read from serial device. */ @@ -256,11 +469,65 @@ size_t serial_read(int __fd, __ptr_t __buf, size_t __nbytes) { return (read(__fd, __buf, __nbytes)); } +#if !defined(TIOCMGET) && defined(TIOCMODG) +#define TIOCMGET TIOCMODG +#endif + +static void check_dcd(int __fd) +{ +#ifdef TIOCMGET +int mcs; + + if (ioctl(__fd, TIOCMGET, &mcs) || !(mcs & TIOCM_CAR)) { + fprintf(stderr,_("ERROR: Modem DCD is down and global/require_dcd parameter is set!\n")); + exit(EXIT_FAILURE); /* Hard quit of all threads */ + } +#else + /* Impossible!! (eg. Coherent) */ +#endif +} + /* Write to serial device. */ size_t serial_write(int __fd, __const __ptr_t __buf, size_t __n) { - - return (write(__fd, __buf, __n)); + +size_t r=0; +ssize_t got; +static long serial_write_usleep=LONG_MIN; +static int require_dcd=-1; + + if (serial_write_usleep==LONG_MIN) { +char *s=CFG_Get(CFG_Info, "global", "serial_write_usleep"); + + serial_write_usleep=(!s ? + SERIAL_WRITE_USLEEP_DEFAULT : atol(CFG_Get(CFG_Info, "global", "serial_write_usleep"))); + } + + if (require_dcd==-1) { + require_dcd=(!!CFG_Get(CFG_Info, "global", "require_dcd")); +#ifndef TIOCMGET + if (require_dcd) + fprintf(stderr,_("WARNING: global/require_dcd argument was set but it is not supported on this system!\n")); +#endif + } + + if (require_dcd) + check_dcd(__fd); + + if (serial_write_usleep<0) + return(write(__fd, __buf, __n)); + + while (__n>0) { + got=write(__fd, __buf, 1); + if (got<=0) + return((!r ? -1 : r)); + __buf++; + __n--; + r++; + if (serial_write_usleep) + usleep(serial_write_usleep); + } + return(r); } #endif /* WIN32 */