Diffstat (limited to 'noncore/net/opietooth/manager/rfcommhelper.cpp') (more/less context) (ignore whitespace changes)
-rw-r--r-- | noncore/net/opietooth/manager/rfcommhelper.cpp | 181 |
1 files changed, 181 insertions, 0 deletions
diff --git a/noncore/net/opietooth/manager/rfcommhelper.cpp b/noncore/net/opietooth/manager/rfcommhelper.cpp new file mode 100644 index 0000000..0769da2 --- a/dev/null +++ b/noncore/net/opietooth/manager/rfcommhelper.cpp | |||
@@ -0,0 +1,181 @@ | |||
1 | #include <unistd.h> | ||
2 | #include <fcntl.h> | ||
3 | #include <errno.h> | ||
4 | #include <signal.h> | ||
5 | |||
6 | #include <stdio.h> | ||
7 | #include <stdlib.h> | ||
8 | |||
9 | #include <sys/types.h> | ||
10 | #include <sys/time.h> | ||
11 | #include <sys/wait.h> | ||
12 | |||
13 | |||
14 | #include "rfcommhelper.h" | ||
15 | |||
16 | using namespace OpieTooth; | ||
17 | |||
18 | bool RfCommHelper::terminate = false; | ||
19 | pid_t RfCommHelper::m_pid; | ||
20 | |||
21 | RfCommHelper::RfCommHelper() | ||
22 | : m_connected( false ) | ||
23 | { | ||
24 | signal( SIGCHLD, signal_handler ); | ||
25 | } | ||
26 | RfCommHelper::~RfCommHelper() { | ||
27 | detach(); | ||
28 | } | ||
29 | QCString RfCommHelper::attachedDevice() const { | ||
30 | return m_device; | ||
31 | } | ||
32 | void RfCommHelper::detach() { | ||
33 | if (m_connected ) | ||
34 | ::kill( m_pid, 9 ); | ||
35 | if ( m_in2out[0] ) | ||
36 | close(m_in2out[0] ); | ||
37 | if ( m_in2out[1] ) | ||
38 | close(m_in2out[1] ); | ||
39 | if ( m_out2in[0] ) | ||
40 | close(m_out2in[0] ); | ||
41 | if ( m_out2in[1] ) | ||
42 | close(m_out2in[1] ); | ||
43 | } | ||
44 | bool RfCommHelper::attach( const QString& bd_addr, int port ) { | ||
45 | int i =0; | ||
46 | bool ok = false; | ||
47 | while (!ok ) { | ||
48 | if (i == 4) break; | ||
49 | ok = connect( i, bd_addr, port ); | ||
50 | i++; | ||
51 | } | ||
52 | return ok; | ||
53 | } | ||
54 | /* | ||
55 | * not implemented yet | ||
56 | */ | ||
57 | void RfCommHelper::regroup() { | ||
58 | |||
59 | } | ||
60 | bool RfCommHelper::connect(int devi, const QString& bdaddr, int port) { | ||
61 | m_connected = false; | ||
62 | if ( pipe(m_fd) < 0 ) | ||
63 | m_fd[0] = m_fd[1] = 0; | ||
64 | if ( pipe(m_in2out) < 0 ) | ||
65 | m_in2out[0] = m_in2out[1] = 0; | ||
66 | if ( pipe(m_out2in ) < 0 ) | ||
67 | m_out2in[0] = m_out2in[1] = 0; | ||
68 | |||
69 | m_pid = fork(); | ||
70 | switch( m_pid ) { | ||
71 | case -1: | ||
72 | return false; | ||
73 | break; | ||
74 | /* | ||
75 | * This is the child code. | ||
76 | * We do some fd work | ||
77 | * and then we'll execlp | ||
78 | * to start it up | ||
79 | */ | ||
80 | case 0:{ // child code | ||
81 | setupComChild(); | ||
82 | char por[15]; | ||
83 | char dev[15]; | ||
84 | sprintf( por, "%d", port ); | ||
85 | sprintf( dev, "%d", devi ); | ||
86 | execlp( "rfcomm", "rfcomm", dev, bdaddr.latin1(), por, NULL ); | ||
87 | char resultByte = 1; | ||
88 | if ( m_fd[1] ) | ||
89 | write(m_fd[1], &resultByte, 1 ); | ||
90 | _exit( -1 ); | ||
91 | break; | ||
92 | } | ||
93 | /* | ||
94 | * The Parent. We'll first wait for fd[0] to fill | ||
95 | * up. | ||
96 | * Then we will wait for out2in[0] to fill up and then | ||
97 | * we will parse it. | ||
98 | * maybe the signal handler gets it's turn in this case we return | ||
99 | * false | ||
100 | * otheriwse we will parse the Output and either return true | ||
101 | * or false | ||
102 | */ | ||
103 | default: { | ||
104 | if ( m_fd[1] ) | ||
105 | close( m_fd[1] ); | ||
106 | if ( m_fd[0] ) for (;;) { | ||
107 | char resultByte; | ||
108 | int len; | ||
109 | len = read(m_fd[0], &resultByte, 1 ); | ||
110 | if ( len == 1 ) { // it failed to execute | ||
111 | return false; | ||
112 | } | ||
113 | if ( len == -1 ) | ||
114 | if ( (errno == ECHILD ) || (errno == EINTR ) ) | ||
115 | continue; // the other process is not yet ready? | ||
116 | |||
117 | break; | ||
118 | } | ||
119 | if ( m_fd[0] ) | ||
120 | close( m_fd[0] ); | ||
121 | terminate = false; | ||
122 | fd_set fds; | ||
123 | struct timeval timeout; | ||
124 | int sel; | ||
125 | while (!terminate ) { | ||
126 | FD_ZERO( &fds ); | ||
127 | FD_SET( m_in2out[0], &fds ); | ||
128 | timeout.tv_sec = 5; | ||
129 | timeout.tv_usec = 0; | ||
130 | |||
131 | sel = select( m_in2out[0]+1, &fds, NULL, NULL, &timeout ); | ||
132 | if ( sel ) | ||
133 | if (FD_ISSET(m_in2out[0], &fds ) ) { | ||
134 | char buf[2048]; | ||
135 | int len; | ||
136 | buf[0] = 0; | ||
137 | len = read( m_in2out[0], buf, sizeof(buf) ); | ||
138 | if ( len > 0 ) { | ||
139 | QCString string( buf ); | ||
140 | if (string.left(9) == "Connected" ) { | ||
141 | m_connected = true; | ||
142 | m_device = m_device.sprintf("/dev/tty%d", devi ); | ||
143 | break; // we got connected | ||
144 | }; | ||
145 | } | ||
146 | // now parese it | ||
147 | }else {// time out | ||
148 | // 5 seconds without input check terminate? | ||
149 | // | ||
150 | ; | ||
151 | } | ||
152 | } | ||
153 | break; | ||
154 | } | ||
155 | } | ||
156 | return !terminate; | ||
157 | } | ||
158 | |||
159 | |||
160 | void RfCommHelper::setupComChild() { | ||
161 | if ( m_fd[0] ) | ||
162 | close(m_fd[0]); | ||
163 | if ( m_fd[1] ) | ||
164 | fcntl( m_fd[1] , F_SETFD, FD_CLOEXEC); | ||
165 | |||
166 | /* duplicating pipes and making them STDIN and STDOUT | ||
167 | * of the new process | ||
168 | * [0] is for reading | ||
169 | * [1] is for writing | ||
170 | */ | ||
171 | dup2( m_out2in[0], STDIN_FILENO ); | ||
172 | dup2( m_in2out[1], STDOUT_FILENO ); | ||
173 | |||
174 | |||
175 | }; | ||
176 | void RfCommHelper::signal_handler(int) { | ||
177 | int status; | ||
178 | terminate = true; | ||
179 | signal( SIGCHLD, signal_handler ); | ||
180 | waitpid( m_pid, &status, WNOHANG ); | ||
181 | } | ||