/* * * Copyright (c) 2002, Smart Link Ltd. * Copyright (c) 2021, Aon plc * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above * copyright notice, this list of conditions and the following * disclaimer in the documentation and/or other materials provided * with the distribution. * 3. Neither the name of the Smart Link Ltd. nor the names of its * contributors may be used to endorse or promote products derived * from this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. * */ /* * * modem_main.c -- modem main func. * * Author: Sasha K (sashak@smlink.com) * * */ #define _GNU_SOURCE #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #define ENOIOCTLCMD 515 #ifdef SUPPORT_ALSA #define ALSA_PCM_NEW_HW_PARAMS_API 1 #define ALSA_PCM_NEW_SW_PARAMS_API 1 #include /* buffer size in periods */ #define BUFFER_PERIODS 12 #define SHORT_BUFFER_PERIODS 4 #endif #include #include #define INFO(fmt,args...) fprintf(stderr, fmt , ##args ); #define ERR(fmt,args...) fprintf(stderr, "error: " fmt , ##args ); #define DBG(fmt,args...) dprintf("main: " fmt, ##args) //#define SLMODEMD_USER "nobody" #define LOCKED_MEM_MIN_KB (8UL * 1024) #define LOCKED_MEM_MIN (LOCKED_MEM_MIN_KB * 1024) #define CLOSE_COUNT_MAX 100 /* modem init externals : FIXME remove it */ extern int dp_dummy_init(void); extern void dp_dummy_exit(void); extern int dp_sinus_init(void); extern void dp_sinus_exit(void); extern int prop_dp_init(void); extern void prop_dp_exit(void); extern int datafile_load_info(char *name,struct dsp_info *info); extern int datafile_save_info(char *name,struct dsp_info *info); extern int modem_ring_detector_start(struct modem *m); /* global config data */ extern const char *modem_dev_name; extern unsigned int ring_detector; extern unsigned int need_realtime; extern const char *modem_group; extern mode_t modem_perm; extern unsigned int use_short_buffer; extern const char *modem_exec; struct device_struct { int num; int fd; #ifdef SUPPORT_ALSA snd_pcm_t *phandle; snd_pcm_t *chandle; snd_mixer_t *mhandle; snd_mixer_elem_t *hook_off_elem; snd_mixer_elem_t *cid_elem; snd_mixer_elem_t *speaker_elem; unsigned int period; unsigned int buf_periods; unsigned int started; #endif int delay; }; static char inbuf[4096]; static char outbuf[4096]; /* * ALSA 'driver' * */ #ifdef SUPPORT_ALSA #define INTERNAL_DELAY 40 /* internal device tx/rx delay: should be selfdetectible */ extern unsigned use_alsa; static snd_output_t *dbg_out = NULL; static int alsa_mixer_setup(struct device_struct *dev, const char *dev_name) { char card_name[32]; int card_num = 0; char *p; snd_mixer_elem_t *elem; int err; if((p = strchr(dev_name, ':'))) card_num = strtoul(p+1, NULL, 0); sprintf(card_name, "hw:%d", card_num); err = snd_mixer_open(&dev->mhandle, 0); if(err < 0) { DBG("mixer setup: cannot open: %s\n", snd_strerror(err)); return err; } err = snd_mixer_attach(dev->mhandle, card_name); if (err < 0) { ERR("mixer setup: attach %s error: %s\n", card_name, snd_strerror(err)); goto error; } err = snd_mixer_selem_register(dev->mhandle, NULL, NULL); if (err <0) { ERR("mixer setup: register %s error: %s\n", card_name, snd_strerror(err)); goto error; } err = snd_mixer_load(dev->mhandle); if (err < 0) { ERR("mixer setup: load %s error: %s\n", card_name, snd_strerror(err)); goto error; } for (elem = snd_mixer_first_elem(dev->mhandle) ; elem; elem = snd_mixer_elem_next(elem)) { if(strcmp(snd_mixer_selem_get_name(elem),"Off-hook") == 0) dev->hook_off_elem = elem; else if(strcmp(snd_mixer_selem_get_name(elem),"Caller ID") == 0) dev->cid_elem = elem; else if(strcmp(snd_mixer_selem_get_name(elem),"Modem Speaker") == 0) dev->speaker_elem = elem; } if(dev->hook_off_elem) return 0; error: snd_mixer_close(dev->mhandle); dev->mhandle = NULL; if (!err) { ERR("mixer setup: Off-hook switch not found for card %s\n", card_name); err = -ENODEV; } return err; } static int alsa_device_setup(struct device_struct *dev, const char *dev_name) { struct pollfd pfd; int ret; memset(dev,0,sizeof(*dev)); ret = alsa_mixer_setup(dev, dev_name); if(ret < 0) DBG("alsa setup: cannot setup mixer: %s\n", snd_strerror(ret)); ret = snd_pcm_open(&dev->phandle, dev_name, SND_PCM_STREAM_PLAYBACK, SND_PCM_NONBLOCK); if(ret < 0) { ERR("alsa setup: cannot open playback device '%s': %s\n", dev_name, snd_strerror(ret)); return -1; } ret = snd_pcm_open(&dev->chandle, dev_name, SND_PCM_STREAM_CAPTURE, SND_PCM_NONBLOCK); if(ret < 0) { ERR("alsa setup: cannot open playback device '%s': %s\n", dev_name, snd_strerror(ret)); return -1; } ret = snd_pcm_poll_descriptors(dev->chandle, &pfd, 1); if(ret <= 0) { ERR("alsa setup: cannot get poll descriptors of '%s': %s\n", dev_name, snd_strerror(ret)); return -1; } dev->fd = pfd.fd; dev->num = 0; /* <-- FIXME */ if(modem_debug_level > 0) snd_output_stdio_attach(&dbg_out,stderr,0); return 0; } static int alsa_device_release(struct device_struct *dev) { snd_pcm_close (dev->phandle); snd_pcm_close (dev->chandle); if (dev->mhandle) { if (dev->hook_off_elem) snd_mixer_selem_set_playback_switch_all(dev->hook_off_elem, 0); if (dev->cid_elem) snd_mixer_selem_set_playback_switch_all(dev->cid_elem, 0); if (dev->speaker_elem) snd_mixer_selem_set_playback_switch_all(dev->speaker_elem, 0); snd_mixer_close(dev->mhandle); } return 0; } static int alsa_xrun_recovery(struct device_struct *dev) { int err; int len; DBG("alsa xrun: try to recover...\n"); err = snd_pcm_prepare(dev->phandle); if (err < 0) { ERR("xrun recovery: cannot prepare playback: %s\n", snd_strerror(err)); return err; } len = dev->delay - INTERNAL_DELAY; snd_pcm_format_set_silence(SND_PCM_FORMAT_S16_LE, outbuf, len); err = snd_pcm_writei(dev->phandle, outbuf, len); if (err < 0) { ERR("xrun recovery: write error: %s\n", snd_strerror(err)); return err; } err = snd_pcm_start(dev->chandle); if(err < 0) { ERR("xrun recovcery snd_pcm_start error: %s\n", snd_strerror(err)); return err; } DBG("alsa xrun: recovered.\n"); return 0; } static int alsa_device_read(struct device_struct *dev, char *buf, int count) { int ret; do { ret = snd_pcm_readi(dev->chandle,buf,count); if (ret == -EPIPE) { ret = alsa_xrun_recovery(dev); break; } } while (ret == -EAGAIN); #if 0 if(ret != dev->period) DBG("alsa_device_read (%d): %d ...\n",count,ret); #endif return ret ; } static int alsa_device_write(struct device_struct *dev, const char *buf, int count) { int written = 0; if(!dev->started) return 0; while(count > 0) { int ret = snd_pcm_writei(dev->phandle,buf,count); if(ret < 0) { if (ret == -EAGAIN) continue; if (ret == -EPIPE) { ret = alsa_xrun_recovery(dev); } written = ret; break; } count -= ret; buf += ret; written += ret; } #if 0 if(written != dev->period) DBG("alsa_device_write (%d): %d...\n",asked,written); #endif return written; } static snd_pcm_format_t mdm2snd_format(unsigned mdm_format) { if(mdm_format == MFMT_S16_LE) return SND_PCM_FORMAT_S16_LE; return SND_PCM_FORMAT_UNKNOWN; } static int setup_stream(snd_pcm_t *handle, struct modem *m, const char *stream_name) { struct device_struct *dev = m->dev_data; snd_pcm_hw_params_t *hw_params; snd_pcm_sw_params_t *sw_params; snd_pcm_format_t format; unsigned int rate, rrate; snd_pcm_uframes_t size, rsize; int err; err = snd_pcm_hw_params_malloc(&hw_params); if (err < 0) { ERR("cannot alloc hw params for %s: %s\n", stream_name, snd_strerror(err)); return err; } err = snd_pcm_hw_params_any(handle,hw_params); if (err < 0) { ERR("cannot init hw params for %s: %s\n", stream_name, snd_strerror(err)); return err; } err = snd_pcm_hw_params_set_access(handle, hw_params, SND_PCM_ACCESS_RW_INTERLEAVED); if (err < 0) { ERR("cannot set access for %s: %s\n", stream_name, snd_strerror(err)); return err; } format = mdm2snd_format(m->format); if(format == SND_PCM_FORMAT_UNKNOWN) { ERR("unsupported format for %s\n",stream_name); return -1; } err = snd_pcm_hw_params_set_format(handle, hw_params, format); if (err < 0) { ERR("cannot set format for %s: %s\n", stream_name, snd_strerror(err)); return err; } err = snd_pcm_hw_params_set_channels(handle, hw_params, 1); if (err < 0) { ERR("cannot set channels for %s: %s\n", stream_name, snd_strerror(err)); return err; } rrate = rate = m->srate; err = snd_pcm_hw_params_set_rate_near(handle, hw_params, &rrate, 0); if (err < 0) { ERR("cannot set rate for %s: %s\n", stream_name, snd_strerror(err)); return err; } if ( rrate != rate ) { ERR("rate %d is not supported by %s (%d).\n", rate, stream_name, rrate); return -1; } rsize = size = dev->period ; err = snd_pcm_hw_params_set_period_size_near(handle, hw_params, &rsize, NULL); if (err < 0) { ERR("cannot set periods for %s: %s\n", stream_name, snd_strerror(err)); return err; } if ( rsize < size ) { ERR("period size %ld is not supported by %s (%ld).\n", size, stream_name, rsize); return -1; } rsize = size = use_short_buffer ? rsize * dev->buf_periods : rsize * 32; err = snd_pcm_hw_params_set_buffer_size_near(handle, hw_params, &rsize); if (err < 0) { ERR("cannot set buffer for %s: %s\n", stream_name, snd_strerror(err)); return err; } if ( rsize != size ) { DBG("buffer size for %s is changed %ld -> %ld\n", stream_name, size, rsize); } err = snd_pcm_hw_params(handle, hw_params); if (err < 0) { ERR("cannot setup hw params for %s: %s\n", stream_name, snd_strerror(err)); return err; } err = snd_pcm_prepare(handle); if (err < 0) { ERR("cannot prepare %s: %s\n", stream_name, snd_strerror(err)); return err; } snd_pcm_hw_params_free(hw_params); err = snd_pcm_sw_params_malloc(&sw_params); if (err < 0) { ERR("cannot alloc sw params for %s: %s\n", stream_name, snd_strerror(err)); return err; } err = snd_pcm_sw_params_current(handle,sw_params); if (err < 0) { ERR("cannot get sw params for %s: %s\n", stream_name, snd_strerror(err)); return err; } err = snd_pcm_sw_params_set_start_threshold(handle, sw_params, INT_MAX); if (err < 0) { ERR("cannot set start threshold for %s: %s\n", stream_name, snd_strerror(err)); return err; } err = snd_pcm_sw_params_set_avail_min(handle, sw_params, 4); if (err < 0) { ERR("cannot set avail min for %s: %s\n", stream_name, snd_strerror(err)); return err; } err = snd_pcm_sw_params_set_xfer_align(handle, sw_params, 4); if (err < 0) { ERR("cannot set align for %s: %s\n", stream_name, snd_strerror(err)); return err; } err = snd_pcm_sw_params(handle, sw_params); if (err < 0) { ERR("cannot set sw params for %s: %s\n", stream_name, snd_strerror(err)); return err; } snd_pcm_sw_params_free(sw_params); if(modem_debug_level > 0) snd_pcm_dump(handle,dbg_out); return 0; } static int alsa_start (struct modem *m) { struct device_struct *dev = m->dev_data; int err, len; DBG("alsa_start...\n"); dev->period = m->frag; dev->buf_periods = use_short_buffer ? SHORT_BUFFER_PERIODS : BUFFER_PERIODS; err = setup_stream(dev->phandle, m, "playback"); if(err < 0) return err; err = setup_stream(dev->chandle, m, "capture"); if(err < 0) return err; dev->delay = 0; len = use_short_buffer ? dev->period * dev->buf_periods : 384; DBG("startup write: %d...\n",len); err = snd_pcm_format_set_silence(SND_PCM_FORMAT_S16_LE, outbuf, len); if(err < 0) { ERR("silence error\n"); return err; } err = snd_pcm_writei(dev->phandle,outbuf,len); if(err < 0) { ERR("startup write error\n"); return err; } dev->delay = err; dev->delay += INTERNAL_DELAY; /* <-- fixme: delay detection is needed */ err = snd_pcm_link(dev->chandle, dev->phandle); if(err < 0) { ERR("snd_pcm_link error: %s\n", snd_strerror(err)); return err; } err = snd_pcm_start(dev->chandle); if(err < 0) { ERR("snd_pcm_start error: %s\n", snd_strerror(err)); return err; } dev->started = 1; return 0; } static int alsa_stop (struct modem *m) { struct device_struct *dev = m->dev_data; DBG("alsa_stop...\n"); dev->started = 0; snd_pcm_drop(dev->chandle); snd_pcm_nonblock(dev->phandle, 0); snd_pcm_drain(dev->phandle); snd_pcm_nonblock(dev->phandle, 1); snd_pcm_unlink(dev->chandle); snd_pcm_hw_free(dev->phandle); snd_pcm_hw_free(dev->chandle); return 0; } static int alsa_ioctl(struct modem *m, unsigned int cmd, unsigned long arg) { /* TODO */ struct device_struct *dev = m->dev_data; DBG("alsa_ioctl: cmd %x, arg %lx...\n",cmd,arg); switch(cmd) { case MDMCTL_CAPABILITIES: return -EINVAL; case MDMCTL_HOOKSTATE: return (dev->hook_off_elem) ? snd_mixer_selem_set_playback_switch_all( dev->hook_off_elem, (arg == MODEM_HOOK_OFF) ) : 0 ; case MDMCTL_SPEAKERVOL: return (dev->speaker_elem) ? snd_mixer_selem_set_playback_volume_all( dev->speaker_elem, arg) : 0 ; case MDMCTL_CODECTYPE: return CODEC_SILABS; case MDMCTL_IODELAY: DBG("delay = %d\n", dev->delay); return dev->delay; default: return 0; } return -EINVAL; } struct modem_driver alsa_modem_driver = { .name = "alsa modem driver", .start = alsa_start, .stop = alsa_stop, .ioctl = alsa_ioctl, }; #endif /* * 'driver' stuff * */ static int modemap_start (struct modem *m) { struct device_struct *dev = m->dev_data; int ret; DBG("modemap_start...\n"); dev->delay = 0; ret = ioctl(dev->fd,100000+MDMCTL_START,0); if (ret < 0) return ret; ret = 192*2; memset(outbuf, 0 , ret); ret = write(dev->fd, outbuf, ret); if (ret < 0) { ioctl(dev->fd,100000+MDMCTL_STOP,0); return ret; } dev->delay = ret/2; return 0; } static int modemap_stop (struct modem *m) { struct device_struct *dev = m->dev_data; DBG("modemap_stop...\n"); return ioctl(dev->fd,100000+MDMCTL_STOP,0); } static int modemap_ioctl(struct modem *m, unsigned int cmd, unsigned long arg) { struct device_struct *dev = m->dev_data; int ret; DBG("modemap_ioctl: cmd %x, arg %lx...\n",cmd,arg); if (cmd == MDMCTL_SETFRAG) arg <<= MFMT_SHIFT(m->format); ret = ioctl(dev->fd,cmd+100000,&arg); if (cmd == MDMCTL_IODELAY && ret > 0) { ret >>= MFMT_SHIFT(m->format); ret += dev->delay; } return ret; } struct modem_driver mdm_modem_driver = { .name = "modemap driver", .start = modemap_start, .stop = modemap_stop, .ioctl = modemap_ioctl, }; static int socket_start (struct modem *m) { struct device_struct *dev = m->dev_data; int ret; DBG("socket_start...\n"); int sockets[2]; if (socketpair(AF_UNIX, SOCK_STREAM, 0, sockets) == -1) { perror("socketpair"); exit(-1); } pid_t pid = fork(); if (pid == -1) { perror("fork"); exit(-1); } if (pid == 0) { // child char str[16]; snprintf(str,sizeof(str),"%d",sockets[0]); close(sockets[1]); if(m->hook == MODEM_HOOK_SNOOPING) ret = execl(modem_exec,modem_exec,"rr",str,NULL); else ret = execl(modem_exec,modem_exec,m->dial_string,str,NULL); if (ret == -1) { ERR("prog: %s\n", modem_exec); perror("execl"); exit(-1); } } else { close(sockets[0]); dev->fd = sockets[1]; dev->delay = 0; ret = 192*2; memset(outbuf, 0 , ret); ret = write(dev->fd, outbuf, ret); DBG("done delay thing\n"); if (ret < 0) { close(dev->fd); dev->fd = -1; return ret; } dev->delay = ret/2; } return 0; } static int socket_stop (struct modem *m) { struct device_struct *dev = m->dev_data; DBG("socket_stop...\n"); close(dev->fd); dev->fd = -1; wait(NULL); // for exec'ed child return 0; } static int socket_ioctl(struct modem *m, unsigned int cmd, unsigned long arg) { //struct device_struct *dev = m->dev_data; int ret = 0; DBG("socket_ioctl: cmd %x, arg %lx...\n",cmd,arg); if (cmd == MDMCTL_SETFRAG) arg <<= MFMT_SHIFT(m->format); switch (cmd) { case MDMCTL_CAPABILITIES: ret = -EINVAL; break; case MDMCTL_CODECTYPE: ret = 4; // CODEC_STLC7550; XXX this worked fine as 0 (CODEC_UNKNOWN)... break; case MDMCTL_IODELAY: // kernel module returns s->delay + ST7554_HW_IODELAY (48) ret = 0;//48 >> MFMT_SHIFT(m->format); //ret += dev->delay; //DBG("%d %d %d %d",m->format,MFMT_SHIFT(m->format),dev->delay,ret); break; case MDMCTL_HOOKSTATE: // 0 = on, 1 = off case MDMCTL_SPEED: // sample rate (9600) case MDMCTL_GETFMTS: case MDMCTL_SETFMT: case MDMCTL_SETFRAGMENT: // (30) case MDMCTL_START: case MDMCTL_STOP: case MDMCTL_GETSTAT: ret = 0; break; default: return -ENOIOCTLCMD; } DBG("socket_ioctl: returning %x\n",ret); return ret; } struct modem_driver socket_modem_driver = { .name = "socket driver", .start = socket_start, .stop = socket_stop, .ioctl = socket_ioctl, }; static int mdm_device_read(struct device_struct *dev, char *buf, int size) { int ret = read(dev->fd, buf, size*2); if (ret > 0) ret /= 2; return ret; } static int mdm_device_write(struct device_struct *dev, const char *buf, int size) { int ret = write(dev->fd, buf, size*2); if (ret > 0) ret /= 2; return ret; } #if 0 static int mdm_device_setup(struct device_struct *dev, const char *dev_name) { struct stat stbuf; int ret, fd; memset(dev,0,sizeof(*dev)); ret = stat(dev_name,&stbuf); if(ret) { ERR("mdm setup: cannot stat `%s': %s\n", dev_name, strerror(errno)); return -1; } if(!S_ISCHR(stbuf.st_mode)) { ERR("mdm setup: not char device `%s'\n", dev_name); return -1; } /* device stuff */ fd = open(dev_name,O_RDWR); if(fd < 0) { ERR("mdm setup: cannot open dev `%s': %s\n",dev_name,strerror(errno)); return -1; } dev->fd = fd; dev->num = minor(stbuf.st_rdev); return 0; } #endif static int mdm_device_release(struct device_struct *dev) { close(dev->fd); return 0; } static int socket_device_setup(struct device_struct *dev, const char *dev_name) { memset(dev,0,sizeof(*dev)); return 0; } /* * PTY creation (or re-creation) * */ static char link_name[PATH_MAX]; int create_pty(struct modem *m) { struct termios termios; const char *pty_name; int pty, ret; if(m->pty) close(m->pty); pty = getpt(); if (pty < 0 || grantpt(pty) < 0 || unlockpt(pty) < 0) { ERR("getpt: %s\n", strerror(errno)); return -1; } if(m->pty) { termios = m->termios; } else { ret = tcgetattr(pty, &termios); /* non canonical raw tty */ cfmakeraw(&termios); cfsetispeed(&termios, B115200); cfsetospeed(&termios, B115200); } ret = tcsetattr(pty, TCSANOW, &termios); if (ret) { ERR("tcsetattr: %s\n",strerror(errno)); return -1; } fcntl(pty,F_SETFL,O_NONBLOCK); pty_name = ptsname(pty); m->pty = pty; m->pty_name = pty_name; modem_update_termios(m,&termios); if(modem_group && *modem_group) { struct group *grp = getgrnam(modem_group); if(!grp) { ERR("cannot find group '%s': %s\n", modem_group, strerror(errno)); } else { ret = chown(pty_name, -1, grp->gr_gid); if(ret < 0) { ERR("cannot chown '%s' to ':%s': %s\n", pty_name, modem_group, strerror(errno)); } } } ret = chmod(pty_name, modem_perm); if (ret < 0) { ERR("cannot chmod '%s' to %o: %s\n", pty_name, modem_perm, strerror(errno)); } if(*link_name) { unlink(link_name); if(symlink(pty_name,link_name)) { ERR("cannot create symbolink link `%s' -> `%s': %s\n", link_name,pty_name,strerror(errno)); *link_name = '\0'; } else { INFO("symbolic link `%s' -> `%s' created.\n", link_name, pty_name); } } return 0; } /* * main run cycle * */ static int (*device_setup)(struct device_struct *dev, const char *dev_name); static int (*device_release)(struct device_struct *dev); static int (*device_read)(struct device_struct *dev, char *buf, int size); static int (*device_write)(struct device_struct *dev, const char *buf, int size); static struct modem_driver *modem_driver; static volatile sig_atomic_t keep_running = 1; void mark_termination(int signum) { DBG("signal %d: mark termination.\n",signum); keep_running = 0; } static int modem_run(struct modem *m, struct device_struct *dev) { struct timeval tmo; fd_set rset,eset; struct termios termios; unsigned pty_closed = 0, close_count = 0; int max_fd; int ret, count; void *in; while(keep_running) { if(m->event) modem_event(m); #ifdef MODEM_CONFIG_RING_DETECTOR if(ring_detector && !m->started) modem_ring_detector_start(m); #endif tmo.tv_sec = 1; tmo.tv_usec= 0; FD_ZERO(&rset); FD_ZERO(&eset); if(m->started) FD_SET(dev->fd,&rset); FD_SET(dev->fd,&eset); max_fd = dev->fd; if(pty_closed && close_count > 0) { if(!m->started || ++close_count > CLOSE_COUNT_MAX ) close_count = 0; } else if(m->xmit.size - m->xmit.count > 0) { FD_SET(m->pty,&rset); if(m->pty > max_fd) max_fd = m->pty; } ret = select(max_fd + 1,&rset,NULL,&eset,&tmo); if (ret < 0) { if (errno == EINTR) continue; ERR("select: %s\n",strerror(errno)); return ret; } if ( ret == 0 ) continue; if(FD_ISSET(dev->fd, &eset)) { unsigned stat; DBG("dev exception...\n"); #ifdef SUPPORT_ALSA if(use_alsa) { DBG("dev exception...\n"); continue; } #endif ret = ioctl(dev->fd,100000+MDMCTL_GETSTAT,&stat); if(ret < 0) { ERR("dev ioctl: %s\n",strerror(errno)); return -1; } if(stat&MDMSTAT_ERROR) modem_error(m); if(stat&MDMSTAT_RING) modem_ring(m); continue; } if(FD_ISSET(dev->fd, &rset)) { count = device_read(dev,inbuf,sizeof(inbuf)/2); if((count <= 0) && (m->hook != MODEM_HOOK_SNOOPING)) { if (errno == ECONNRESET) { DBG("lost connection to child socket process\n"); } else { ERR("dev read: %s\n",strerror(errno)); } // hack to force hangup modem_hangup(m); // sets sample_timer_func to run_modem_stop() m->sample_timer_func(m); m->sample_timer = 0; m->sample_timer_func = NULL; continue; } in = inbuf; if(m->update_delay < 0) { if ( -m->update_delay >= count) { DBG("change delay -%d...\n", count); dev->delay -= count; m->update_delay += count; continue; } DBG("change delay %d...\n", m->update_delay); in -= m->update_delay; count += m->update_delay; dev->delay += m->update_delay; m->update_delay = 0; } modem_process(m,inbuf,outbuf,count); if (dev->fd == -1) { DBG("closed connection to child socket process\n"); continue; } count = device_write(dev,outbuf,count); if(count < 0) { ERR("dev write: %s\n",strerror(errno)); return -1; } else if (count == 0) { DBG("dev write = 0\n"); } if(m->update_delay > 0) { DBG("change delay +%d...\n", m->update_delay); memset(outbuf, 0, m->update_delay*2); count = device_write(dev,outbuf,m->update_delay); if(count < 0) { ERR("dev write: %s\n",strerror(errno)); return -1; } if(count != m->update_delay) { ERR("cannot update delay: %d instead of %d.\n", count, m->update_delay); return -1; } dev->delay += m->update_delay; m->update_delay = 0; } } if(FD_ISSET(m->pty,&rset)) { /* check termios */ tcgetattr(m->pty,&termios); if(memcmp(&termios,&m->termios,sizeof(termios))) { DBG("termios changed.\n"); modem_update_termios(m,&termios); } /* read data */ count = m->xmit.size - m->xmit.count; if(count == 0) continue; if(count > sizeof(inbuf)) count = sizeof(inbuf); count = read(m->pty,inbuf,count); if(count < 0) { if(errno == EAGAIN) { DBG("pty read, errno = EAGAIN\n"); continue; } if(errno == EIO) { /* closed */ if(!pty_closed) { DBG("pty closed.\n"); if(termios.c_cflag&HUPCL) { modem_hangup(m); /* re-create PTM - simulate hangup */ ret = create_pty(m); if (ret < 0) { ERR("cannot re-create PTY.\n"); return -1; } } else pty_closed = 1; } // DBG("pty read, errno = EIO\n"); close_count = 1; continue; } else ERR("pty read: %s\n",strerror(errno)); return -1; } else if (count == 0) { DBG("pty read = 0\n"); } pty_closed = 0; count = modem_write(m,inbuf,count); if(count < 0) { ERR("modem_write failed.\n"); return -1; } } } return 0; } int modem_main(const char *dev_name) { char path_name[PATH_MAX]; struct device_struct device; struct modem *m; int pty; int ret = 0; struct passwd *pwd; modem_debug_init(basename(dev_name)); ret = device_setup(&device, dev_name); if (ret) { ERR("cannot setup device `%s'\n", dev_name); exit(-1); } dp_dummy_init(); dp_sinus_init(); prop_dp_init(); modem_timer_init(); sprintf(link_name,"/tmp/ttySL%d", device.num); m = modem_create(modem_driver,basename(dev_name)); m->name = basename(dev_name); m->dev_data = &device; m->dev_name = dev_name; ret = create_pty(m); if(ret < 0) { ERR("cannot create PTY.\n"); exit(-1); } INFO("modem `%s' created. TTY is `%s'\n", m->name, m->pty_name); // sprintf(path_name,"/var/lib/slmodem/data.%s",basename(dev_name)); // datafile_load_info(path_name,&m->dsp_info); if (need_realtime) { struct sched_param prm; if(mlockall(MCL_CURRENT|MCL_FUTURE)) { ERR("mlockall: %s\n",strerror(errno)); } prm.sched_priority = sched_get_priority_max(SCHED_FIFO); if(sched_setscheduler(0,SCHED_FIFO,&prm)) { ERR("sched_setscheduler: %s\n",strerror(errno)); } DBG("rt applyed: SCHED_FIFO, pri %d\n",prm.sched_priority); } signal(SIGINT, mark_termination); signal(SIGTERM, mark_termination); #ifdef SLMODEMD_USER if (need_realtime) { struct rlimit limit; if (getrlimit(RLIMIT_MEMLOCK, &limit)) { ERR("getrlimit failed to read RLIMIT_MEMLOCK\n"); exit(-1); } if (limit.rlim_cur != RLIM_INFINITY && limit.rlim_cur < LOCKED_MEM_MIN) { ERR("locked memory limit too low:\n"); ERR("need %lu bytes, have %lu bytes\n", LOCKED_MEM_MIN, (unsigned long)limit.rlim_cur); ERR("try 'ulimit -l %lu'\n", LOCKED_MEM_MIN_KB); exit(-1); } } pwd = getpwnam(SLMODEMD_USER); if (!pwd) { ERR("getpwnam " SLMODEMD_USER ": %s\n",strerror(errno)); exit(-1); } ret = (setgroups(1,&pwd->pw_gid) || setgid(pwd->pw_gid) || setuid(pwd->pw_uid)); if (ret) { ERR("setgroups or setgid %ld or setuid %ld failed: %s\n", (long)pwd->pw_gid,(long)pwd->pw_uid,strerror(errno)); exit(-1); } if (setuid(0) != -1) { ERR("setuid 0 succeeded after dropping privileges!\n"); exit(-1); } DBG("dropped privileges to %ld.%ld\n", (long)pwd->pw_gid,(long)pwd->pw_uid); #endif INFO("Use `%s' as modem device, Ctrl+C for termination.\n", *link_name ? link_name : m->pty_name); /* main loop here */ ret = modem_run(m,&device); datafile_save_info(path_name,&m->dsp_info); pty = m->pty; modem_delete(m); usleep(100000); close(pty); if(*link_name) unlink(link_name); dp_dummy_exit(); dp_sinus_exit(); prop_dp_exit(); device_release(&device); modem_debug_exit(); exit(ret); return 0; } int main(int argc, char *argv[]) { extern void modem_cmdline(int argc, char *argv[]); int ret; modem_cmdline(argc,argv); if(!modem_dev_name) modem_dev_name = "/dev/slamr0"; device_setup = socket_device_setup; device_release = mdm_device_release; device_read = mdm_device_read; device_write = mdm_device_write; modem_driver = &socket_modem_driver; #ifdef SUPPORT_ALSA if(use_alsa) { device_setup = alsa_device_setup; device_release = alsa_device_release; device_read = alsa_device_read; device_write = alsa_device_write; modem_driver = &alsa_modem_driver; } #endif ret = modem_main(modem_dev_name); return ret; }