/* * * BlueZ - Bluetooth protocol stack for Linux * * Copyright (C) 2002-2003 Maxim Krasnyansky * Copyright (C) 2002-2004 Marcel Holtmann * * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation; * * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS. * IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY * CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. * * ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS, * COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS * SOFTWARE IS DISCLAIMED. * * * $Id$ */ #ifdef HAVE_CONFIG_H #include #endif #include #include #include #include #include #include #include #include #include #include "lib.h" #define MS_PPP 2 #define MS_SUCCESS 1 #define MS_FAILED -1 #define MS_TIMEOUT -2 static sigjmp_buf jmp; static int retry; static int timeout; static void sig_alarm(int sig) { siglongjmp(jmp, MS_TIMEOUT); } static int w4_str(int fd, char *str) { char buf[40]; int r, len = 0; while (1) { r = read(fd, buf + len, sizeof(buf) - len - 1); if (r < 0) { if (errno == EINTR || errno == EAGAIN) continue; break; } if (!r) break; len += r; if (len < strlen(str)) continue; buf[len] = 0; if (strstr(buf, str)) return MS_SUCCESS; /* Detect PPP */ if (strchr(buf, '~')) return MS_PPP; } return MS_FAILED; } static int ms_server(int fd) { switch (w4_str(fd, "CLIENT")) { case MS_SUCCESS: write_n(fd, "CLIENTSERVER", 12); case MS_PPP: return MS_SUCCESS; default: return MS_FAILED; } } static int ms_client(int fd) { write_n(fd, "CLIENT", 6); return w4_str(fd, "CLIENTSERVER"); } int ms_dun(int fd, int server, int timeo) { sig_t osig; retry = 4; timeout = timeo; if (!server) timeout /= retry; osig = signal(SIGALRM, sig_alarm); while (1) { int r = sigsetjmp(jmp, 1); if (r) { if (r == MS_TIMEOUT && !server && --retry) continue; alarm(0); signal(SIGALRM, osig); switch (r) { case MS_SUCCESS: case MS_PPP: errno = 0; return 0; case MS_FAILED: errno = EPROTO; break; case MS_TIMEOUT: errno = ETIMEDOUT; break; } return -1; } alarm(timeout); if (server) r = ms_server(fd); else r = ms_client(fd); siglongjmp(jmp, r); } }