]> git.stg.codes - stg.git/blob - projects/stargazer/plugins/capture/divert_freebsd/divert_cap.cpp
5d49f6924287769cfdb3d8987ae29081370cd2f5
[stg.git] / projects / stargazer / plugins / capture / divert_freebsd / divert_cap.cpp
1 /*
2  *    This program is free software; you can redistribute it and/or modify
3  *    it under the terms of the GNU General Public License as published by
4  *    the Free Software Foundation; either version 2 of the License, or
5  *    (at your option) any later version.
6  *
7  *    This program is distributed in the hope that it will be useful,
8  *    but WITHOUT ANY WARRANTY; without even the implied warranty of
9  *    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
10  *    GNU General Public License for more details.
11  *
12  *    You should have received a copy of the GNU General Public License
13  *    along with this program; if not, write to the Free Software
14  *    Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
15  */
16
17 /*
18 * Author : Boris Mikhailenko <stg34@stg.dp.ua>
19 */
20
21 /*
22 $Revision: 1.13 $
23 $Date: 2010/09/10 06:43:03 $
24 */
25 #include <sys/types.h>
26 #include <sys/socket.h>
27 #include <netinet/in.h>
28
29 #include <sys/uio.h>
30 #include <sys/time.h>
31 #include <sys/ioctl.h>
32 #include <sys/poll.h>
33
34 #include <fcntl.h>
35 #include <unistd.h>
36
37 #include <cstdio>
38 #include <cstring>
39 #include <cerrno>
40 #include <cstdlib>
41 #include <csignal>
42
43 #include <algorithm>
44
45 #include "common.h"
46 #include "divert_cap.h"
47 #include "traffcounter.h"
48
49 #define BUFF_LEN (16384) /* max mtu -> lo=16436  TODO why?*/
50
51 //-----------------------------------------------------------------------------
52 struct DIVERT_DATA {
53 int sock;
54 short int port;
55 unsigned char buffer[BUFF_LEN];
56 char iface[10];
57 };
58 //-----------------------------------------------------------------------------
59 pollfd pollddiv;
60 DIVERT_DATA cddiv;  //capture data
61 //-----------------------------------------------------------------------------
62 class DIVERT_CAP_CREATOR {
63 private:
64     DIVERT_CAP * divc;
65
66 public:
67     DIVERT_CAP_CREATOR()
68         : divc(new DIVERT_CAP())
69         {
70         }
71     ~DIVERT_CAP_CREATOR()
72         {
73         delete divc;
74         }
75
76     DIVERT_CAP * GetCapturer()
77     {
78     return divc;
79     }
80 };
81 //-----------------------------------------------------------------------------
82 //-----------------------------------------------------------------------------
83 //-----------------------------------------------------------------------------
84 DIVERT_CAP_CREATOR dcc;
85 //-----------------------------------------------------------------------------
86 //-----------------------------------------------------------------------------
87 //-----------------------------------------------------------------------------
88 PLUGIN * GetPlugin()
89 {
90 return dcc.GetCapturer();
91 }
92 //-----------------------------------------------------------------------------
93 //-----------------------------------------------------------------------------
94 //-----------------------------------------------------------------------------
95 const std::string DIVERT_CAP::GetVersion() const
96 {
97 return "Divert_cap v.1.0";
98 }
99 //-----------------------------------------------------------------------------
100 DIVERT_CAP::DIVERT_CAP()
101     : port(0),
102       nonstop(false),
103       isRunning(false),
104       traffCnt(NULL)
105 {
106 }
107 //-----------------------------------------------------------------------------
108 int DIVERT_CAP::Start()
109 {
110 if (isRunning)
111     return 0;
112
113 if (DivertCapOpen() < 0)
114     {
115     errorStr = "Cannot open socket!";
116     printfd(__FILE__, "Cannot open socket\n");
117     return -1;
118     }
119
120 nonstop = true;
121
122 if (pthread_create(&thread, NULL, Run, this) == 0)
123     {
124     return 0;
125     }
126
127 errorStr = "Cannot create thread.";
128 printfd(__FILE__, "Cannot create thread\n");
129 return -1;
130 }
131 //-----------------------------------------------------------------------------
132 int DIVERT_CAP::Stop()
133 {
134 if (!isRunning)
135     return 0;
136
137 DivertCapClose();
138
139 nonstop = false;
140
141 //5 seconds to thread stops itself
142 int i;
143 for (i = 0; i < 25; i++)
144     {
145     if (!isRunning)
146         break;
147
148     usleep(200000);
149     }
150
151 //after 5 seconds waiting thread still running. now killing it
152 if (isRunning)
153     {
154     if (pthread_kill(thread, SIGINT))
155         {
156         errorStr = "Cannot kill thread.";
157         printfd(__FILE__, "Cannot kill thread\n");
158         return -1;
159         }
160     }
161
162 return 0;
163 }
164 //-----------------------------------------------------------------------------
165 void * DIVERT_CAP::Run(void * d)
166 {
167 DIVERT_CAP * dc = (DIVERT_CAP *)d;
168 dc->isRunning = true;
169
170 char buffer[64];
171 while (dc->nonstop)
172     {
173     RAW_PACKET rp;
174     dc->DivertCapRead(buffer, 64, NULL);
175
176     if (buffer[12] != 0x8)
177         continue;
178
179     memcpy(rp.pckt, &buffer[14], pcktSize);
180
181     dc->traffCnt->Process(rp);
182     }
183
184 dc->isRunning = false;
185 return NULL;
186 }
187 //-----------------------------------------------------------------------------
188 int DIVERT_CAP::DivertCapOpen()
189 {
190 memset(&pollddiv, 0, sizeof(pollddiv));
191 memset(&cddiv, 0, sizeof(DIVERT_DATA));
192
193 strcpy(cddiv.iface, "foo");
194 cddiv.port = port;
195
196 DivertCapOpen(0);
197 pollddiv.events = POLLIN;
198 pollddiv.fd = cddiv.sock;
199
200 return 0;
201 }
202 //-----------------------------------------------------------------------------
203 int DIVERT_CAP::DivertCapOpen(int)
204 {
205 int ret;
206 cddiv.sock = socket(PF_INET, SOCK_RAW, IPPROTO_DIVERT);
207 if (cddiv.sock < 0)
208     {
209     errorStr = "Create divert socket error.";
210     printfd(__FILE__, "Cannot create divert socket\n");
211     return -1;
212     }
213
214 struct sockaddr_in divAddr;
215
216 memset(&divAddr, 0, sizeof(divAddr));
217
218 divAddr.sin_family = AF_INET;
219 divAddr.sin_port = htons(cddiv.port);
220 divAddr.sin_addr.s_addr = INADDR_ANY;
221
222 ret = bind(cddiv.sock, (struct sockaddr *)&divAddr, sizeof(divAddr));
223
224 if (ret < 0)
225     {
226     errorStr = "Bind divert socket error.";
227     printfd(__FILE__, "Cannot bind divert socket\n");
228     return -1;
229     }
230
231 return cddiv.sock;
232 }
233 //-----------------------------------------------------------------------------
234 int DIVERT_CAP::DivertCapRead(char * b, int blen, char ** iface)
235 {
236 poll(&pollddiv, 1, -1);
237
238 if (pollddiv.revents & POLLIN)
239     {
240     DivertCapRead(b, blen, iface, 0);
241     pollddiv.revents = 0;
242     return 0;
243     }
244
245 return 0;
246 }
247 //-----------------------------------------------------------------------------
248 int DIVERT_CAP::DivertCapRead(char * b, int blen, char ** iface, int)
249 {
250 static char buf[BUFF_LEN];
251 static struct sockaddr_in divertaddr;
252 static int bytes;
253 static socklen_t divertaddrSize = sizeof(divertaddr);
254
255 if ((bytes = recvfrom (cddiv.sock, buf, BUFF_LEN,
256                        0, (struct sockaddr*) &divertaddr, &divertaddrSize)) > 50)
257     {
258     memcpy(b + 14, buf, blen - 14);
259     b[12] = 0x8;
260
261     if (iface)
262         *iface = cddiv.iface;
263
264     sendto(cddiv.sock, buf, bytes, 0, (struct sockaddr*)&divertaddr, divertaddrSize);
265     }
266
267 return 0;
268 }
269 //-----------------------------------------------------------------------------
270 int DIVERT_CAP::DivertCapClose()
271 {
272 close(cddiv.sock);
273 return 0;
274 }
275 //-----------------------------------------------------------------------------
276 int DIVERT_CAP::ParseSettings()
277 {
278 int p;
279 PARAM_VALUE pv;
280 vector<PARAM_VALUE>::const_iterator pvi;
281
282 pv.param = "Port";
283 pvi = std::find(settings.moduleParams.begin(), settings.moduleParams.end(), pv);
284 if (pvi == settings.moduleParams.end())
285     {
286     port = 15701;
287     return 0;
288     }
289
290 if (ParseIntInRange(pvi->value[0], 1, 65535, &p))
291     {
292     errorStr = "Cannot parse parameter \'Port\': " + errorStr;
293     printfd(__FILE__, "Cannot parse parameter 'Port'\n");
294     return -1;
295     }
296
297 port = p;
298
299 return 0;
300 }
301 //-----------------------------------------------------------------------------
302 int DIVERT_CAP::ParseIntInRange(const std::string & str, int min, int max, int * val)
303 {
304 if (str2x(str.c_str(), *val))
305     {
306     errorStr = "Incorrect value \'" + str + "\'.";
307     return -1;
308     }
309 if (*val < min || *val > max)
310     {
311     errorStr = "Value \'" + str + "\' out of range.";
312     return -1;
313     }
314 return 0;
315 }
316 //-----------------------------------------------------------------------------