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.
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.
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
22 * Author : Boris Mikhailenko <stg34@stargazer.dp.ua>
27 $Date: 2010/11/03 11:28:07 $
32 #include <sys/types.h>
33 #include <sys/socket.h>
34 #include <netinet/in.h>
35 #include <arpa/inet.h>
39 #include <cstdio> // fopen and similar
40 #include <cstdlib> // strtol
42 #include "stg/common.h"
43 #include "stg/locker.h"
44 #include "stg/const.h" // MONITOR_TIME_DELAY_SEC
45 #include "traffcounter_impl.h"
46 #include "stg_timer.h"
47 #include "users_impl.h"
49 #define FLUSH_TIME (10)
50 #define REMOVE_TIME (31)
52 const char protoName[PROTOMAX][8] =
53 {"TCP", "UDP", "ICMP", "TCP_UDP", "ALL"};
57 tcp = 0, udp, icmp, tcp_udp, all
60 //-----------------------------------------------------------------------------
61 TRAFFCOUNTER_IMPL::TRAFFCOUNTER_IMPL(USERS_IMPL * u, const std::string & fn)
67 WriteServLog(GetStgLogger()),
71 touchTimeP(stgTime - MONITOR_TIME_DELAY_SEC),
79 addUserNotifier(*this),
80 delUserNotifier(*this)
82 for (int i = 0; i < DIR_NUM; i++)
83 strprintf(&dirName[i], "DIR%d", i);
85 dirName[DIR_NUM] = "NULL";
87 users->AddNotifierUserAdd(&addUserNotifier);
88 users->AddNotifierUserDel(&delUserNotifier);
90 pthread_mutex_init(&mutex, NULL);
92 //-----------------------------------------------------------------------------
93 TRAFFCOUNTER_IMPL::~TRAFFCOUNTER_IMPL()
95 pthread_mutex_destroy(&mutex);
97 //-----------------------------------------------------------------------------
98 int TRAFFCOUNTER_IMPL::Start()
100 STG_LOCKER lock(&mutex);
107 printfd(__FILE__, "TRAFFCOUNTER_IMPL::Start() - Cannot read rules\n");
108 WriteServLog("TRAFFCOUNTER: Cannot read rules.");
112 printfd(__FILE__, "TRAFFCOUNTER::Start()\n");
113 int h = users->OpenSearch();
114 assert(h && "USERS::OpenSearch is always correct");
117 while (users->SearchNext(h, &u) == 0)
121 users->CloseSearch(h);
124 if (pthread_create(&thread, NULL, Run, this))
126 printfd(__FILE__, "TRAFFCOUNTER_IMPL::Start() - Cannot start thread\n");
127 WriteServLog("TRAFFCOUNTER: Error: Cannot start thread.");
132 //-----------------------------------------------------------------------------
133 int TRAFFCOUNTER_IMPL::Stop()
140 int h = users->OpenSearch();
141 assert(h && "USERS::OpenSearch is always correct");
144 while (users->SearchNext(h, &u) == 0)
146 UnSetUserNotifiers(u);
148 users->CloseSearch(h);
150 //5 seconds to thread stops itself
151 struct timespec ts = {0, 200000000};
152 for (int i = 0; i < 25 && !stopped; i++)
154 nanosleep(&ts, NULL);
160 printfd(__FILE__, "TRAFFCOUNTER::Stop()\n");
164 //-----------------------------------------------------------------------------
165 void * TRAFFCOUNTER_IMPL::Run(void * data)
168 sigfillset(&signalSet);
169 pthread_sigmask(SIG_BLOCK, &signalSet, NULL);
171 TRAFFCOUNTER_IMPL * tc = static_cast<TRAFFCOUNTER_IMPL *>(data);
175 time_t touchTime = stgTime - MONITOR_TIME_DELAY_SEC;
176 struct timespec ts = {0, 500000000};
182 tc->FlushAndRemove();
186 if (tc->monitoring && (touchTime + MONITOR_TIME_DELAY_SEC <= stgTime))
188 std::string monFile(tc->monitorDir + "/traffcounter_r");
189 printfd(__FILE__, "Monitor=%d file TRAFFCOUNTER %s\n", tc->monitoring, monFile.c_str());
194 if (++c % FLUSH_TIME == 0)
195 tc->FlushAndRemove();
201 //-----------------------------------------------------------------------------
202 void TRAFFCOUNTER_IMPL::Process(const RAW_PACKET & rawPacket)
207 if (monitoring && (touchTimeP + MONITOR_TIME_DELAY_SEC <= stgTime))
209 std::string monFile = monitorDir + "/traffcounter_p";
210 printfd(__FILE__, "Monitor=%d file TRAFFCOUNTER %s\n", monitoring, monFile.c_str());
211 touchTimeP = stgTime;
215 STG_LOCKER lock(&mutex);
217 //printfd(__FILE__, "TRAFFCOUNTER::Process()\n");
218 //TODO replace find with lower_bound.
220 // Searching a new packet in a tree.
221 pp_iter pi = packets.find(rawPacket);
223 // Packet found - update length and time
224 if (pi != packets.end())
226 pi->second.lenU += rawPacket.GetLen();
227 pi->second.lenD += rawPacket.GetLen();
228 pi->second.updateTime = stgTime;
229 /*printfd(__FILE__, "=============================\n");
230 printfd(__FILE__, "Packet found!\n");
231 printfd(__FILE__, "Version=%d\n", rawPacket.GetIPVersion());
232 printfd(__FILE__, "HeaderLen=%d\n", rawPacket.GetHeaderLen());
233 printfd(__FILE__, "PacketLen=%d\n", rawPacket.GetLen());
234 printfd(__FILE__, "SIP=%s\n", inet_ntostring(rawPacket.GetSrcIP()).c_str());
235 printfd(__FILE__, "DIP=%s\n", inet_ntostring(rawPacket.GetDstIP()).c_str());
236 printfd(__FILE__, "src port=%d\n", rawPacket.GetSrcPort());
237 printfd(__FILE__, "pst port=%d\n", rawPacket.GetDstPort());
238 printfd(__FILE__, "len=%d\n", rawPacket.GetLen());
239 printfd(__FILE__, "proto=%d\n", rawPacket.GetProto());
240 printfd(__FILE__, "PacketDirU=%d\n", pi->second.dirU);
241 printfd(__FILE__, "PacketDirD=%d\n", pi->second.dirD);
242 printfd(__FILE__, "=============================\n");*/
246 PACKET_EXTRA_DATA ed;
248 // Packet not found - add new packet
250 ed.updateTime = stgTime;
251 ed.flushTime = stgTime;
254 userU is that whose user_ip == packet_ip_src
255 userD is that whose user_ip == packet_ip_dst
258 uint32_t ipU = rawPacket.GetSrcIP();
259 uint32_t ipD = rawPacket.GetDstIP();
261 // Searching users with such IP
262 if (users->FindByIPIdx(ipU, &ed.userU) == 0)
264 ed.userUPresent = true;
267 if (users->FindByIPIdx(ipD, &ed.userD) == 0)
269 ed.userDPresent = true;
272 if (ed.userUPresent ||
275 DeterminateDir(rawPacket, &ed.dirU, &ed.dirD);
277 ed.lenD = ed.lenU = rawPacket.GetLen();
279 //TODO use result of lower_bound to inserting new record
281 // Adding packet to a tree.
282 std::pair<pp_iter, bool> insertResult = packets.insert(std::make_pair(rawPacket, ed));
283 pp_iter newPacket = insertResult.first;
285 // Adding packet reference to an IP index.
286 ip2packets.insert(std::make_pair(ipU, newPacket));
287 ip2packets.insert(std::make_pair(ipD, newPacket));
290 //-----------------------------------------------------------------------------
291 void TRAFFCOUNTER_IMPL::FlushAndRemove()
293 STG_LOCKER lock(&mutex);
295 Packets::size_type oldPacketsSize = packets.size();
296 Index::size_type oldIp2packetsSize = ip2packets.size();
299 pi = packets.begin();
301 ip2packets.erase(ip2packets.begin(), ip2packets.end());
302 while (pi != packets.end())
305 if (stgTime - pi->second.flushTime > FLUSH_TIME)
307 if (pi->second.userUPresent)
309 //printfd(__FILE__, "+++ Flushing U user %s (%s:%d) of length %d\n", pi->second.userU->GetLogin().c_str(), inet_ntostring(pi->first.GetSrcIP()).c_str(), pi->first.GetSrcPort(), pi->second.lenU);
312 if (pi->second.dirU < DIR_NUM)
314 #ifdef TRAFF_STAT_WITH_PORTS
315 pi->second.userU->AddTraffStatU(pi->second.dirU,
316 pi->first.GetDstIP(),
317 pi->first.GetDstPort(),
320 pi->second.userU->AddTraffStatU(pi->second.dirU,
321 pi->first.GetDstIP(),
327 pi->second.flushTime = stgTime;
330 if (pi->second.userDPresent)
332 //printfd(__FILE__, "+++ Flushing D user %s (%s:%d) of length %d\n", pi->second.userD->GetLogin().c_str(), inet_ntostring(pi->first.GetDstIP()).c_str(), pi->first.GetDstPort(), pi->second.lenD);
335 if (pi->second.dirD < DIR_NUM)
337 #ifdef TRAFF_STAT_WITH_PORTS
338 pi->second.userD->AddTraffStatD(pi->second.dirD,
339 pi->first.GetSrcIP(),
340 pi->first.GetSrcPort(),
343 pi->second.userD->AddTraffStatD(pi->second.dirD,
344 pi->first.GetSrcIP(),
350 pi->second.flushTime = stgTime;
354 if (stgTime - pi->second.updateTime < REMOVE_TIME)
356 std::pair<pp_iter, bool> res = newPackets.insert(*pi);
359 ip2packets.insert(std::make_pair(pi->first.GetSrcIP(), res.first));
360 ip2packets.insert(std::make_pair(pi->first.GetDstIP(), res.first));
365 swap(packets, newPackets);
366 printfd(__FILE__, "FlushAndRemove() packets: %d(rem %d) ip2packets: %d(rem %d)\n",
368 oldPacketsSize - packets.size(),
370 oldIp2packetsSize - ip2packets.size());
373 //-----------------------------------------------------------------------------
374 void TRAFFCOUNTER_IMPL::AddUser(USER_IMPL * user)
376 printfd(__FILE__, "AddUser: %s\n", user->GetLogin().c_str());
377 uint32_t uip = user->GetCurrIP();
378 std::pair<ip2p_iter, ip2p_iter> pi;
380 STG_LOCKER lock(&mutex);
381 // Find all packets with IP belongs to this user
382 pi = ip2packets.equal_range(uip);
384 while (pi.first != pi.second)
386 if (pi.first->second->first.GetSrcIP() == uip)
388 assert((!pi.first->second->second.userUPresent ||
389 pi.first->second->second.userU == user) &&
390 "U user present but it's not current user");
392 pi.first->second->second.lenU = 0;
393 pi.first->second->second.userU = user;
394 pi.first->second->second.userUPresent = true;
397 if (pi.first->second->first.GetDstIP() == uip)
399 assert((!pi.first->second->second.userDPresent ||
400 pi.first->second->second.userD == user) &&
401 "D user present but it's not current user");
403 pi.first->second->second.lenD = 0;
404 pi.first->second->second.userD = user;
405 pi.first->second->second.userDPresent = true;
411 //-----------------------------------------------------------------------------
412 void TRAFFCOUNTER_IMPL::DelUser(uint32_t uip)
414 printfd(__FILE__, "DelUser: %s \n", inet_ntostring(uip).c_str());
415 std::pair<ip2p_iter, ip2p_iter> pi;
417 STG_LOCKER lock(&mutex);
418 pi = ip2packets.equal_range(uip);
420 while (pi.first != pi.second)
422 if (pi.first->second->first.GetSrcIP() == uip)
424 if (pi.first->second->second.dirU < DIR_NUM && pi.first->second->second.userUPresent)
426 #ifdef TRAFF_STAT_WITH_PORTS
427 pi.first->second->second.userU->AddTraffStatU(pi.first->second->second.dirU,
428 pi.first->second->first.GetDstIP(),
429 pi.first->second->first.GetDstPort(),
430 pi.first->second->second.lenU);
432 pi.first->second->second.userU->AddTraffStatU(pi.first->second->second.dirU,
433 pi.first->second->first.GetDstIP(),
434 pi.first->second->second.lenU);
437 pi.first->second->second.userUPresent = false;
440 if (pi.first->second->first.GetDstIP() == uip)
442 if (pi.first->second->second.dirD < DIR_NUM && pi.first->second->second.userDPresent)
444 #ifdef TRAFF_STAT_WITH_PORTS
445 pi.first->second->second.userD->AddTraffStatD(pi.first->second->second.dirD,
446 pi.first->second->first.GetSrcIP(),
447 pi.first->second->first.GetSrcPort(),
448 pi.first->second->second.lenD);
450 pi.first->second->second.userD->AddTraffStatD(pi.first->second->second.dirD,
451 pi.first->second->first.GetSrcIP(),
452 pi.first->second->second.lenD);
456 pi.first->second->second.userDPresent = false;
462 ip2packets.erase(pi.first, pi.second);
464 //-----------------------------------------------------------------------------
465 void TRAFFCOUNTER_IMPL::SetUserNotifiers(USER_IMPL * user)
467 // Adding user. Adding notifiers to user.
468 TRF_IP_BEFORE ipBNotifier(*this, user);
469 ipBeforeNotifiers.push_front(ipBNotifier);
470 user->AddCurrIPBeforeNotifier(&(*ipBeforeNotifiers.begin()));
472 TRF_IP_AFTER ipANotifier(*this, user);
473 ipAfterNotifiers.push_front(ipANotifier);
474 user->AddCurrIPAfterNotifier(&(*ipAfterNotifiers.begin()));
476 //-----------------------------------------------------------------------------
477 void TRAFFCOUNTER_IMPL::UnSetUserNotifiers(USER_IMPL * user)
479 // Removing user. Removing notifiers from user.
480 std::list<TRF_IP_BEFORE>::iterator bi;
481 std::list<TRF_IP_AFTER>::iterator ai;
483 bi = ipBeforeNotifiers.begin();
484 while (bi != ipBeforeNotifiers.end())
486 if (user->GetLogin() == bi->GetUser()->GetLogin())
488 user->DelCurrIPBeforeNotifier(&(*bi));
489 ipBeforeNotifiers.erase(bi);
495 ai = ipAfterNotifiers.begin();
496 while (ai != ipAfterNotifiers.end())
498 if (user->GetLogin() == ai->GetUser()->GetLogin())
500 user->DelCurrIPAfterNotifier(&(*ai));
501 ipAfterNotifiers.erase(ai);
507 //-----------------------------------------------------------------------------
508 void TRAFFCOUNTER_IMPL::DeterminateDir(const RAW_PACKET & packet,
509 int * dirU, // Direction for incoming packet
510 int * dirD) const // Direction for outgoing packet
512 bool addrMatchU = false;
513 bool portMatchU = false;
514 bool addrMatchD = false;
515 bool portMatchD = false;
516 bool foundU = false; // Was rule for U found ?
517 bool foundD = false; // Was rule for D found ?
518 //printfd(__FILE__, "foundU=%d, foundD=%d\n", foundU, foundD);
520 enum { ICMP_RPOTO = 1, TCP_PROTO = 6, UDP_PROTO = 17 };
522 std::list<RULE>::const_iterator ln;
525 while (ln != rules.end())
538 portMatchU = (packet.GetProto() == ICMP_RPOTO);
542 if (packet.GetProto() == TCP_PROTO || packet.GetProto() == UDP_PROTO)
543 portMatchU = (packet.GetDstPort() >= ln->port1) && (packet.GetDstPort() <= ln->port2);
547 if (packet.GetProto() == TCP_PROTO)
548 portMatchU = (packet.GetDstPort() >= ln->port1) && (packet.GetDstPort() <= ln->port2);
552 if (packet.GetProto() == UDP_PROTO)
553 portMatchU = (packet.GetDstPort() >= ln->port1) && (packet.GetDstPort() <= ln->port2);
557 printfd(__FILE__, "Error! Incorrect rule!\n");
561 addrMatchU = (packet.GetDstIP() & ln->mask) == ln->ip;
563 if (!foundU && addrMatchU && portMatchU)
567 //printfd(__FILE__, "Up rule ok! %d\n", ln->dir);
583 portMatchD = (packet.GetProto() == ICMP_RPOTO);
587 if (packet.GetProto() == TCP_PROTO || packet.GetProto() == UDP_PROTO)
588 portMatchD = (packet.GetSrcPort() >= ln->port1) && (packet.GetSrcPort() <= ln->port2);
592 if (packet.GetProto() == TCP_PROTO)
593 portMatchD = (packet.GetSrcPort() >= ln->port1) && (packet.GetSrcPort() <= ln->port2);
597 if (packet.GetProto() == UDP_PROTO)
598 portMatchD = (packet.GetSrcPort() >= ln->port1) && (packet.GetSrcPort() <= ln->port2);
602 printfd(__FILE__, "Error! Incorrect rule!\n");
606 addrMatchD = (packet.GetSrcIP() & ln->mask) == ln->ip;
608 if (!foundD && addrMatchD && portMatchD)
612 //printfd(__FILE__, "Down rule ok! %d\n", ln->dir);
617 } //while (ln != rules.end())
625 //-----------------------------------------------------------------------------
626 bool TRAFFCOUNTER_IMPL::ReadRules(bool test)
628 //printfd(__FILE__, "TRAFFCOUNTER::ReadRules()\n");
633 char tp[100]; // protocol
634 char ta[100]; // address
635 char td[100]; // target direction
638 f = fopen(rulesFileName.c_str(), "rt");
642 printfd(__FILE__, "TRAFFCOUNTER_IMPL::ReadRules() - File '%s' cannot be opened.\n", rulesFileName.c_str());
643 WriteServLog("File '%s' cannot be oppened.", rulesFileName.c_str());
647 while (fgets(str, 1023, f))
650 if (str[strspn(str," \t")] == '#' || str[strspn(str," \t")] == '\n')
655 r = sscanf(str,"%99s %99s %99s", tp, ta, td);
658 printfd(__FILE__, "TRAFFCOUNTER_IMPL::ReadRules() - Error in file '%s' at line %d. There must be 3 parameters.\n", rulesFileName.c_str(), lineNumber);
659 WriteServLog("Error in file '%s' at line %d. There must be 3 parameters.", rulesFileName.c_str(), lineNumber);
667 for (uint8_t i = 0; i < PROTOMAX; i++)
669 if (strcasecmp(tp, protoName[i]) == 0)
673 for (uint32_t i = 0; i < DIR_NUM + 1; i++)
675 if (td == dirName[i])
679 if (rul.dir == 0xff || rul.proto == 0xff)
681 printfd(__FILE__, "TRAFFCOUNTER_IMPL::ReadRules() - Error in file '%s' at line %d.\n", rulesFileName.c_str(), lineNumber);
682 WriteServLog("Error in file %s. Line %d.",
683 rulesFileName.c_str(), lineNumber);
688 if (ParseAddress(ta, &rul) != 0)
690 printfd(__FILE__, "TRAFFCOUNTER_IMPL::ReadRules() - Error in file '%s' at line %d. Error in adress.\n", rulesFileName.c_str(), lineNumber);
691 WriteServLog("Error in file %s. Error in adress. Line %d.",
692 rulesFileName.c_str(), lineNumber);
697 rules.push_back(rul);
702 // Adding lastest rule: ALL 0.0.0.0/0 NULL
703 rul.dir = DIR_NUM; //NULL
704 rul.ip = 0; //0.0.0.0
711 rules.push_back(rul);
715 //-----------------------------------------------------------------------------
716 int TRAFFCOUNTER_IMPL::Reload()
718 STG_LOCKER lock(&mutex);
722 printfd(__FILE__, "TRAFFCOUNTER_IMPL::Reload() - Failed to reload rules.\n");
723 WriteServLog("TRAFFCOUNTER: Cannot reload rules. Errors found.");
729 printfd(__FILE__, "TRAFFCOUNTER_IMPL::Reload() - Reloaded rules successfully.\n");
730 WriteServLog("TRAFFCOUNTER: Reloaded rules successfully.");
733 //-----------------------------------------------------------------------------
734 bool TRAFFCOUNTER_IMPL::ParseAddress(const char * ta, RULE * rule) const
736 char addr[50], mask[20], port1[20], port2[20], ports[40];
738 size_t len = strlen(ta);
741 memset(addr, 0, sizeof(addr));
742 for (i = 0; i < len; i++)
744 if (ta[i] == '/' || ta[i] == ':')
782 if (!(rule->proto == tcp || rule->proto == udp || rule->proto == tcp_udp))
784 printfd(__FILE__, "TRAFFCOUNTER_IMPL::ParseAddress() - No ports specified for this protocol.\n");
785 WriteServLog("No ports specified for this protocol.");
790 ports[i - p] = ta[i];
796 strcpy(ports, "0-65535");
803 if ((sss = strchr(ports, '-')) != NULL)
805 strncpy(port1, ports, int(sss-ports));
806 port1[int(sss - ports)] = 0;
807 strcpy(port2, sss + 1);
811 strcpy(port1, ports);
812 strcpy(port2, ports);
815 // Convert strings to mask, ports and IP
816 uint16_t prt1, prt2, msk;
817 struct in_addr ipaddr;
820 msk = static_cast<uint16_t>(strtol(mask, &res, 10));
824 prt1 = static_cast<uint16_t>(strtol(port1, &res, 10));
828 prt2 = static_cast<uint16_t>(strtol(port2, &res, 10));
832 int r = inet_aton(addr, &ipaddr);
836 rule->ip = ipaddr.s_addr;
837 rule->mask = CalcMask(msk);
839 //printfd(__FILE__, "msk=%d mask=%08X mask=%08X\n", msk, rule->mask, (0xFFffFFff << (32 - msk)));
841 if ((ipaddr.s_addr & rule->mask) != ipaddr.s_addr)
843 printfd(__FILE__, "TRAFFCOUNTER_IMPL::ParseAddress() - Address does'n match mask.\n");
844 WriteServLog("Address does'n match mask.");
853 //-----------------------------------------------------------------------------
854 uint32_t TRAFFCOUNTER_IMPL::CalcMask(uint32_t msk) const
856 if (msk >= 32) return 0xFFffFFff;
857 if (msk == 0) return 0;
858 return htonl(0xFFffFFff << (32 - msk));
860 //---------------------------------------------------------------------------
861 void TRAFFCOUNTER_IMPL::FreeRules()
865 //-----------------------------------------------------------------------------
866 void TRAFFCOUNTER_IMPL::SetMonitorDir(const std::string & dir)
869 monitoring = !monitorDir.empty();
871 //-----------------------------------------------------------------------------