5 files changed, 617 insertions, 2 deletions

diff --git a/noncore/net/opietooth/lib/bt-serial.c b/noncore/net/opietooth/lib/bt-serial.c
new file mode 100644
index 0000000..d1a65a2
--- a/dev/null
+++ b/noncore/net/opietooth/lib/bt-serial.c
@@ -0,0 +1,308 @@
+/* $Id$
+         *Bluetooth serial forwarder functions implementation
+ *
+         *(c) Copyright 2006 GPL
+ *
+         *This software is provided under the GNU public license, incorporated
+         *herein by reference. The software is provided without warranty or 
+         *support.
+ */
+#include "bt-serial.h"
+#include <errno.h>
+#include <unistd.h>
+#include <sys/time.h>
+#include <sys/types.h>
+#include <sys/socket.h>
+#include <bluetooth/bluetooth.h>
+#include <bluetooth/rfcomm.h>
+#include <bluetooth/sdp.h>
+#include <bluetooth/sdp_lib.h>
+#include <termios.h>
+#include <sys/stat.h>
+#include <fcntl.h>
+#include <stdio.h>
+
+static int hserv = -1; //Server socket
+sdp_session_t* session = NULL; //session with an SDP server
+
+static sdp_session_t* register_service(uint8_t rfchannel)
+{
+    int err = 0;
+    sdp_profile_desc_t profile[1];
+    uint32_t service_uuid_int[] = { 0, 0, 0, 0xABCD };
+    const char *service_name = "Serial forwarder";
+    const char *service_dsc = "Serial forwarder";
+    const char *service_prov = "OPIE team";
+    uuid_t root_uuid, l2cap_uuid, rfcomm_uuid, svc_uuid, service_uuid;
+    sdp_list_t* l2cap_list = 0;
+    sdp_list_t* rfcomm_list = 0;
+    sdp_list_t* root_list = 0;
+    sdp_list_t* proto_list = 0;
+    sdp_list_t* access_proto_list = 0;
+    sdp_list_t* profile_list = 0;
+    sdp_list_t* service_list = 0;
+    sdp_data_t* channel = 0; 
+    sdp_record_t* record = sdp_record_alloc();    
+    sdp_session_t* lsession = 0;
+
+    // set the general service ID
+    sdp_uuid128_create(&svc_uuid, &service_uuid_int);
+    sdp_set_service_id(record, svc_uuid);
+    // make the service record publicly browsable
+    sdp_uuid16_create(&root_uuid, PUBLIC_BROWSE_GROUP);
+    root_list = sdp_list_append(0, &root_uuid);
+    sdp_set_browse_groups( record, root_list );
+
+    // set l2cap information
+    sdp_uuid16_create(&l2cap_uuid, L2CAP_UUID);
+    l2cap_list = sdp_list_append( 0, &l2cap_uuid );
+    proto_list = sdp_list_append( 0, l2cap_list );
+
+    // set rfcomm information
+    sdp_uuid16_create(&rfcomm_uuid, RFCOMM_UUID);
+    channel = sdp_data_alloc(SDP_UINT8, &rfchannel);
+    rfcomm_list = sdp_list_append( 0, &rfcomm_uuid );
+    sdp_list_append( rfcomm_list, channel );
+    sdp_list_append( proto_list, rfcomm_list );
+
+    // attach protocol information to service record
+    access_proto_list = sdp_list_append( 0, proto_list );
+    sdp_set_access_protos( record, access_proto_list );
+
+    sdp_uuid16_create(&service_uuid, SERIAL_PORT_SVCLASS_ID);
+    service_list = sdp_list_append( 0, &service_uuid );
+    sdp_set_service_classes(record, service_list);
+
+    profile[0].version = 0x0100;
+    sdp_uuid16_create(&profile[0].uuid, SERIAL_PORT_PROFILE_ID);
+    profile_list = sdp_list_append(0, &profile[0]);
+    sdp_set_profile_descs(record, profile_list);
+    
+    // set the name, provider, and description
+    sdp_set_info_attr(record, service_name, service_prov, service_dsc);
+
+    // connect to the local SDP server, register the service record, and 
+    // disconnect
+    lsession = sdp_connect(BDADDR_ANY, BDADDR_LOCAL, SDP_RETRY_IF_BUSY);
+    if (lsession == NULL)
+        goto errout;
+    err = sdp_record_register(lsession, record, 0);
+    if (err) {
+        sdp_close(lsession);
+        lsession = NULL;
+    }
+errout:
+    // cleanup
+    sdp_data_free( channel );
+    sdp_list_free( l2cap_list, 0 );
+    sdp_list_free( rfcomm_list, 0 );
+    sdp_list_free( root_list, 0 );
+    sdp_list_free( access_proto_list, 0 );
+    sdp_list_free( profile_list, 0 );
+    sdp_list_free( service_list, 0 );
+    
+    return lsession;
+}
+
+/*
+ * Function opens and configures serial port
+ * portName - name of the serial port
+ * return 0 on success, -1 on error
+ */
+int openSerial(const char* portName)
+{
+    struct termios tc; //port attributes
+    int hserial = -1; //serial port handler
+    int result; //function call result
+    if ((hserial = open(portName, O_RDWR)) < 0)
+        goto errout;
+    if ((result = tcgetattr(hserial, &tc)) < 0)
+        goto errout;
+    cfmakeraw(&tc);
+    cfsetispeed(&tc, B9600);
+    cfsetospeed(&tc, B9600);
+    if ((result = tcsetattr(hserial, TCSANOW, &tc)) < 0)
+        goto errout;
+    if (result == 0)
+        errno = 0;
+errout:
+    if (errno) {
+        if (hserial >= 0) {
+            close(hserial);
+            hserial = -1;
+        }
+    }
+    return hserial;
+}
+
+/*
+ * bt_serialStart 
+ * Function starts bt-serial service
+ * return 0 success -1 on error
+ */
+int bt_serialStart(void)
+{
+    struct sockaddr_rc loc_addr; //server address
+    int i; //just an index variable
+    int result = 0; //function call result
+    if (hserv >= 0)
+        return 0;
+    hserv = socket(AF_BLUETOOTH, SOCK_STREAM, BTPROTO_RFCOMM);
+    // bind socket to port 1 of the first available 
+    // local bluetooth adapter
+    memset(&loc_addr, 0, sizeof(struct sockaddr_rc));
+    loc_addr.rc_family = AF_BLUETOOTH;
+    loc_addr.rc_bdaddr = *BDADDR_ANY;
+    for (i = 1; i < 32; i++) {
+        loc_addr.rc_channel = (uint8_t)i;
+        if (!(result = bind(hserv,
+            (struct sockaddr *)&loc_addr, 
+            sizeof(loc_addr))) || errno == EINVAL) {
+            break;
+        }
+    }
+    if (result != 0)
+        goto errout;
+    else
+        errno = 0;
+    if (listen(hserv, 1) < 0)
+        goto errout;
+    session = register_service(loc_addr.rc_channel);
+errout:
+    if (errno) {
+        result = errno;
+        close(hserv);
+        hserv = -1;
+        if (session != NULL)
+            sdp_close(session);
+        errno = result;
+        result = -1;
+    }
+    return result;
+}
+
+/*
+ * bt_serialStop
+ * Function stops bt-serial service
+ * return device handler on success -1 on error
+ */
+int bt_serialStop(void)
+{
+    int result = 0; //Function call result
+
+    if (hserv >= 0) {
+        result = close(hserv);
+        hserv = -1;
+        if (session != NULL)
+            sdp_close(session);
+    }
+    return result;
+}
+
+/*
+ * btWrite
+ * hbt - handler of the BT connection
+ * buf - buffer to write
+ * plen - total length to write (and zero it!!!)
+ * return number of bytes written on success or -1
+ */
+int btWrite(int hbt, uint8_t* buf, int* plen)
+{
+    int result; //Function call result
+    const suseconds_t writeDelay = 100000L; //wait after writing
+    result = write(hbt, buf, *plen);
+#ifdef _DEBUG_
+    printf("ser->bt %d\n", *plen);
+#endif
+    *plen = 0;
+    usleep(writeDelay);
+    return result;
+}
+
+/*
+ * bt_serialForward
+ * Function forwards data received from bt-connection to serial and backward
+ * conn - connection handler
+ * portName - name of the serial port to open
+ * return 0 success -1 on error
+ */
+/*
+ * This function has a hack. My BT adapter hangs if you try to write small
+ * portions of data to it to often. That's why we either wait for big enough
+ * (> wrThresh) portion of data from a serial port and write it to BT or 
+ * wait for a timeout (tv).
+ */
+int bt_serialForward(BTSerialConn* conn, const char* portName)
+{
+    int result; //Function call result
+    fd_set inSet; //Set we scan for input
+    uint8_t inBuf[1500]; //buffer we read and write
+    uint8_t outBuf[1500]; //buffer we read and write
+    int outBytes; //bytes to be written to bt
+    int nbytes = 0; //number of bytes we could read
+    int maxfd; //maximal filehandler
+    struct timeval tv; //time we shall wait for select
+    const int wrThresh = 250; //threshold after which we send packet to bt
+    const suseconds_t waitDelay = 200000L; //Time (us) we wait for data 
+    struct sockaddr_rc rem_addr; //client address
+    int len = sizeof(rem_addr); //argument length
+
+    if (conn == NULL) {
+        errno = EINVAL;
+        return -1;
+    }
+    memset(&rem_addr, 0, sizeof(struct sockaddr_rc));
+    conn->bt_handler = -1;
+    conn->ser_handler = -1;
+    conn->bt_handler = accept(hserv, (struct sockaddr *)&rem_addr, &len);
+    if (conn->bt_handler < 0)
+        return -1;
+    conn->ser_handler = openSerial(portName);
+    if (conn->ser_handler < 0)
+        return -1;
+#ifdef _DEBUG_
+    printf("Connect!\n");
+#endif
+
+    FD_ZERO(&inSet);
+    maxfd = (conn->bt_handler > conn->ser_handler)? conn->bt_handler: 
+        conn->ser_handler;
+    outBytes = 0;
+    do {
+        FD_SET(conn->bt_handler, &inSet);
+        FD_SET(conn->ser_handler, &inSet);
+        tv.tv_sec = 0;
+        tv.tv_usec = waitDelay;
+        result = select(maxfd + 1, &inSet, NULL, NULL, &tv);
+        if (result > 0) {
+            if (FD_ISSET(conn->bt_handler, &inSet)) {
+                if ((nbytes = read(conn->bt_handler, inBuf, sizeof(inBuf))) > 0)
+                    result = write(conn->ser_handler, inBuf, nbytes);
+#ifdef _DEBUG_
+                printf("bt->ser %d\n", nbytes);
+#endif
+            }
+            if (FD_ISSET(conn->ser_handler, &inSet)) {
+                if ((nbytes = read(conn->ser_handler, 
+                    outBuf + outBytes, sizeof(outBuf) - outBytes)) > 0) {
+                    outBytes += nbytes;
+                    if (outBytes > wrThresh)
+                        result = btWrite(conn->bt_handler, outBuf, &outBytes);
+                }
+            }
+        } else if (result == 0) {
+            if (outBytes > 0) 
+                result = btWrite(conn->bt_handler, outBuf, &outBytes);
+        }
+    } while (result == 0 || (result > 0 && nbytes > 0));
+    if (nbytes <= 0)
+        result = -1;
+    close(conn->bt_handler);
+    close(conn->ser_handler);
+#ifdef _DEBUG_
+    printf("Disconnect!\n");
+#endif
+    return 0;
+}
+
+//eof
diff --git a/noncore/net/opietooth/lib/bt-serial.h b/noncore/net/opietooth/lib/bt-serial.h
new file mode 100644
index 0000000..737e2a0
--- a/dev/null
+++ b/noncore/net/opietooth/lib/bt-serial.h
@@ -0,0 +1,57 @@
+/* $Id$
+         *Bluetooth serial forwarder functions declaration
+ *
+         *(c) Copyright 2006 GPL
+ *
+         *This software is provided under the GNU public license, incorporated
+         *herein by reference. The software is provided without warranty or 
+         *support.
+ */
+#ifndef _BT_SERIAL_H_
+#define _BT_SERIAL_H_
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+typedef struct //bt-serial connection handler
+{
+    int bt_handler; //Bluetooth connection handler
+    int ser_handler; //serial port handler
+} BTSerialConn;
+
+/*
+ * bt_serialStart 
+ * Function starts bt-serial service
+ * return 0 success -1 on error
+ */
+int bt_serialStart(void);
+
+/*
+ * bt_serialForward
+ * Function forwards data received from bt-connection to serial and backward
+ * conn - connection handler
+ * portName - name of the port to connect
+ * return 0 success -1 on error
+ */
+int bt_serialForward(BTSerialConn* conn, const char* portName);
+
+/*
+ * bt_serialStop
+ * Function stops bt-serial service
+ * return device handler on success -1 on error
+ */
+int bt_serialStop(void);
+
+/*
+ * Function opens and configures serial port
+ * portName - name of the serial port
+ * return 0 on success, -1 on error
+ */
+int openSerial(const char* portName);
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif
+//eof
diff --git a/noncore/net/opietooth/lib/forwarder.cc b/noncore/net/opietooth/lib/forwarder.cc
new file mode 100644
index 0000000..c38f5b8
--- a/dev/null
+++ b/noncore/net/opietooth/lib/forwarder.cc
@@ -0,0 +1,203 @@
+/* $Id$
+         *Bluetooth serial forwarder class implementation
+ *
+         *(c) Copyright 2006 GPL
+ *
+         *This software is provided under the GNU public license, incorporated
+         *herein by reference. The software is provided without warranty or 
+         *support.
+ */
+#include "bt-serial.h"
+#include <sys/types.h>
+#include <sys/wait.h>
+#include <errno.h>
+#include <stdlib.h>
+#include <fcntl.h>
+#include <qapplication.h>
+#include <opie2/oprocctrl.h>
+#include "forwarder.h"
+using namespace OpieTooth;
+using namespace Opie::Core;
+using namespace Opie::Core::Internal;
+
+SerialForwarder::SerialForwarder(QString& devName, int dspeed) : 
+    OProcess(), device(devName), speed(dspeed)
+{
+    status = false;
+}
+
+SerialForwarder::~SerialForwarder()
+{
+    stop();
+}
+
+
+bool SerialForwarder::start(RunMode runmode, Communication comm)
+{
+    int htmp; //temporary device
+    int result; //call result
+
+    if ( runs )
+    {
+        return false;  // cannot start a process that is already running
+        // or if no executable has been assigned
+    }
+    //First, check if serial device is usable
+    htmp = ::openSerial(device);
+    if (htmp < 0)
+        return false;
+    close(htmp);
+
+    run_mode = runmode;
+    status = 0;
+
+    if(::bt_serialStart() < 0)
+        return false;
+
+    if ( !setupCommunication( comm ) )
+        qWarning( "Could not setup Communication!" );
+
+    // We do this in the parent because if we do it in the child process
+    // gdb gets confused when the application runs from gdb.
+    uid_t uid = getuid();
+    gid_t gid = getgid();
+#ifdef HAVE_INITGROUPS
+
+    struct passwd *pw = getpwuid( uid );
+#endif
+
+    int fd[ 2 ];
+    if ( 0 > pipe( fd ) )
+    {
+        fd[ 0 ] = fd[ 1 ] = 0; // Pipe failed.. continue
+    }
+
+    runs = true;
+
+    QApplication::flushX();
+
+    // WABA: Note that we use fork() and not vfork() because
+    // vfork() has unclear semantics and is not standardized.
+    pid_ = fork();
+
+    if ( 0 == pid_ )
+    {
+        if ( fd[ 0 ] )
+            close( fd[ 0 ] );
+        if ( !runPrivileged() )
+        {
+            setgid( gid );
+#if defined( HAVE_INITGROUPS)
+
+            if ( pw )
+                initgroups( pw->pw_name, pw->pw_gid );
+#endif
+
+            setuid( uid );
+        }
+        // The child process
+        if ( !commSetupDoneC() )
+            qWarning( "Could not finish comm setup in child!" );
+
+        setupEnvironment();
+
+        // Matthias
+        if ( run_mode == DontCare )
+            setpgid( 0, 0 );
+        // restore default SIGPIPE handler (Harri)
+        struct sigaction act;
+        sigemptyset( &( act.sa_mask ) );
+        sigaddset( &( act.sa_mask ), SIGPIPE );
+        act.sa_handler = SIG_DFL;
+        act.sa_flags = 0;
+        sigaction( SIGPIPE, &act, 0L );
+
+        // We set the close on exec flag.
+        // Closing of fd[1] indicates that the execvp succeeded!
+        if ( fd[ 1 ] )
+            fcntl( fd[ 1 ], F_SETFD, FD_CLOEXEC );
+        do {
+            BTSerialConn conn; //Connection handler
+            if ( fd[ 1 ] ) {
+                ::close(fd[1]);
+                fd[1] = 0;
+            }
+            result = ::bt_serialForward(&conn, device);
+        } while(result == 0);
+
+        char resultByte = 1;
+        if ( fd[ 1 ] )
+            write( fd[ 1 ], &resultByte, 1 );
+        _exit( -1 );
+    }
+    else if ( -1 == pid_ )
+    {
+        // forking failed
+
+        runs = false;
+        return false;
+    }
+    else
+    {
+        if ( fd[ 1 ] )
+            close( fd[ 1 ] );
+        // the parent continues here
+
+        // Discard any data for stdin that might still be there
+        input_data = 0;
+
+        // Check whether client could be started.
+        if ( fd[ 0 ] )
+            for ( ;; )
+            {
+                char resultByte;
+                int n = ::read( fd[ 0 ], &resultByte, 1 );
+                if ( n == 1 )
+                {
+                    // Error
+                    runs = false;
+                    close( fd[ 0 ] );
+                    pid_ = 0;
+                    return false;
+                }
+                if ( n == -1 )
+                {
+                    if ( ( errno == ECHILD ) || ( errno == EINTR ) )
+                        continue; // Ignore
+                }
+                break; // success
+            }
+        if ( fd[ 0 ] )
+            close( fd[ 0 ] );
+
+        if ( !commSetupDoneP() )   // finish communication socket setup for the parent
+            qWarning( "Could not finish comm setup in parent!" );
+
+        if ( run_mode == Block )
+        {
+            commClose();
+
+            // The SIGCHLD handler of the process controller will catch
+            // the exit and set the status
+            while ( runs )
+            {
+                OProcessController::theOProcessController->
+                slotDoHousekeeping( 0 );
+            }
+            runs = FALSE;
+            emit processExited( this );
+        }
+    }
+    return true;
+}
+
+/*
+ * Stop forwarding process
+ */
+int SerialForwarder::stop()
+{
+    kill(SIGTERM);
+    ::bt_serialStop();
+    return 0;
+}
+//eof
diff --git a/noncore/net/opietooth/lib/forwarder.h b/noncore/net/opietooth/lib/forwarder.h
new file mode 100644
index 0000000..f90ed70
--- a/dev/null
+++ b/noncore/net/opietooth/lib/forwarder.h
@@ -0,0 +1,45 @@
+/* $Id$
+         *Bluetooth serial forwarder class declaration
+ *
+         *(c) Copyright 2006 GPL
+ *
+         *This software is provided under the GNU public license, incorporated
+         *herein by reference. The software is provided without warranty or 
+         *support.
+ */
+#ifndef OpieTooth_Forwarder_H
+#define OpieTooth_Forwarder_H
+#include <qobject.h>
+#include <qstring.h>
+#include <unistd.h>
+#include <signal.h>
+#include <opie2/oprocess.h>
+namespace Opie {
+    namespace Core {
+        class OProcess;
+        namespace Internal {
+            class OProcessController; 
+        }
+    }
+};
+
+namespace OpieTooth {
+    class SerialForwarder : public Opie::Core::OProcess {
+        
+        Q_OBJECT
+    
+    protected:
+        QString device; //Name of the device
+        int speed; //device speed to set
+    public:
+        SerialForwarder(QString& devName, int speed);
+        ~SerialForwarder();
+        //Function starts the forwarding process
+        virtual bool start( RunMode runmode = NotifyOnExit,
+                        Communication comm = NoCommunication );
+        //Stop the forwarding process
+        int stop();
+    };
+};
+#endif
+//eof
diff --git a/noncore/net/opietooth/lib/lib.pro b/noncore/net/opietooth/lib/lib.pro
index 9d3c14d..781bf15 100644
--- a/noncore/net/opietooth/lib/lib.pro
+++ b/noncore/net/opietooth/lib/lib.pro
@@ -1,7 +1,9 @@
 TEMPLATE        = lib
 CONFIG          += qte warn_on 
-        HEADERS = connection.h parser.h device.h manager.h remotedevice.h services.h startpanconnection.h startdunconnection.h 
-        SOURCES         = connection.cpp parser.cc device.cc manager.cc remotedevice.cc services.cc startpanconnection.cpp startdunconnection.cpp
+        HEADERS = connection.h parser.h device.h manager.h remotedevice.h services.h \
+                  startpanconnection.h startdunconnection.h bt-serial.h forwarder.h
+        SOURCES         = connection.cpp parser.cc device.cc manager.cc remotedevice.cc services.cc \
+                  startpanconnection.cpp startdunconnection.cpp bt-serial.c forwarder.cc
         TARGET  = opietooth1
 INCLUDEPATH += $(OPIEDIR)/include .
         DESTDIR         = $(OPIEDIR)/lib