gvpe/src/protocol.C

/*
    protocol.C -- handle the protocol, encryption, handshaking etc.
 
    This program is free software; you can redistribute it and/or modify
    it under the terms of the GNU General Public License as published by
    the Free Software Foundation; either version 2 of the License, or
    (at your option) any later version.
 
    This program is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    GNU General Public License for more details.
 
    You should have received a copy of the GNU General Public License
    along with this program; if not, write to the Free Software
    Foundation, Inc. 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
*/

#include "config.h"

#include <list>

#include <cstdlib>
#include <cstring>
#include <cstdio>

#include <sys/types.h>
#include <sys/socket.h>
#include <sys/poll.h>
#include <sys/wait.h>
#include <netinet/in.h>
#include <arpa/inet.h>
#include <errno.h>
#include <time.h>
#include <unistd.h>

#include "pidfile.h"

#include "connection.h"
#include "util.h"
#include "protocol.h"

/////////////////////////////////////////////////////////////////////////////

const char *vpn::script_if_up (int)
{
  // the tunnel device mtu should be the physical mtu - overhead
  // the tricky part is rounding to the cipher key blocksize
  int mtu = conf.mtu - ETH_OVERHEAD - VPE_OVERHEAD - MAX_OVERHEAD;
  mtu += ETH_OVERHEAD - 6 - 6; // now we have the data portion
  mtu -= mtu % EVP_CIPHER_block_size (CIPHER); // round
  mtu -= ETH_OVERHEAD - 6 - 6; // and get interface mtu again

  char *env;
  asprintf (&env, "CONFBASE=%s", confbase);
  putenv (env);
  asprintf (&env, "NODENAME=%s", THISNODE->nodename);
  putenv (env);
  asprintf (&env, "NODEID=%d", THISNODE->id);
  putenv (env);
  asprintf (&env, "IFNAME=%s", tap->interface ());
  putenv (env);
  asprintf (&env, "MTU=%d", mtu);
  putenv (env);
  asprintf (&env, "MAC=%02x:%02x:%02x:%02x:%02x:%02x",
            0xfe, 0xfd, 0x80, 0x00, THISNODE->id >> 8,
            THISNODE->id & 0xff);
  putenv (env);

  return ::conf.script_if_up ? ::conf.script_if_up : "if-up";
}

int
vpn::setup ()
{
  sockinfo si;

  si.set (THISNODE);

  udpv4_fd = -1;

  if (THISNODE->protocols & PROT_UDPv4)
    {
      udpv4_fd = socket (PF_INET, SOCK_DGRAM, IPPROTO_UDP);

      if (udpv4_fd < 0)
        return -1;

      if (bind (udpv4_fd, si.sav4 (), si.salenv4 ()))
        {
          slog (L_ERR, _("can't bind udpv4 to %s: %s"), (const char *)si, strerror (errno));
          exit (1);
        }

#ifdef IP_MTU_DISCOVER
      // this I really consider a linux bug. I am neither connected
      // nor do I fragment myself. Linux still sets DF and doesn't
      // fragment for me sometimes.
      {
        int oval = IP_PMTUDISC_DONT;
        setsockopt (udpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
      }
#endif

      // standard daemon practise...
      {
        int oval = 1;
        setsockopt (udpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
      }

      udpv4_ev_watcher.start (udpv4_fd, POLLIN);
    }

  ipv4_fd = -1;
  if (THISNODE->protocols & PROT_IPv4)
    {
      ipv4_fd = socket (PF_INET, SOCK_RAW, ::conf.ip_proto);

      if (ipv4_fd < 0)
        return -1;

      if (bind (ipv4_fd, si.sav4 (), si.salenv4 ()))
        {
          slog (L_ERR, _("can't bind ipv4 socket to %s: %s"), (const char *)si, strerror (errno));
          exit (1);
        }

#ifdef IP_MTU_DISCOVER
      // this I really consider a linux bug. I am neither connected
      // nor do I fragment myself. Linux still sets DF and doesn't
      // fragment for me sometimes.
      {
        int oval = IP_PMTUDISC_DONT;
        setsockopt (ipv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
      }
#endif

      ipv4_ev_watcher.start (ipv4_fd, POLLIN);
    }

  tap = new tap_device ();
  if (!tap) //D this, of course, never catches
    {
      slog (L_ERR, _("cannot create network interface '%s'"), conf.ifname);
      exit (1);
    }
  
  run_script (run_script_cb (this, &vpn::script_if_up), true);

  tap_ev_watcher.start (tap->fd, POLLIN);

  reconnect_all ();

  return 0;
}

void
vpn::send_ipv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
{
  setsockopt (ipv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);
  sendto (ipv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
}

void
vpn::send_udpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
{
  setsockopt (udpv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);
  sendto (udpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
}

void
vpn::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi)
{
  unsigned int src = pkt->src ();
  unsigned int dst = pkt->dst ();

  slog (L_NOISE, _("<<?/%s received possible vpn packet type %d from %d to %d, length %d"),
        (const char *)rsi, pkt->typ (), pkt->src (), pkt->dst (), pkt->len);

  if (src == 0 || src > conns.size ()
      || dst > conns.size ()
      || pkt->typ () >= vpn_packet::PT_MAX)
    slog (L_WARN, _("(%s): received corrupted packet type %d (src %d, dst %d)"),
          (const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());
  else
    {
      connection *c = conns[src - 1];

      if (dst == 0 && !THISNODE->routerprio)
        slog (L_WARN, _("%s(%s): received broadcast, but we are no router"),
              c->conf->nodename, (const char *)rsi);
      else if (dst != 0 && dst != THISNODE->id)
        // FORWARDING NEEDED ;)
        slog (L_WARN,
              _("received frame for node %d ('%s') from %s, but this is node %d ('%s')"),
              dst, conns[dst - 1]->conf->nodename,
              (const char *)rsi,
              THISNODE->id, THISNODE->nodename);
      else
        c->recv_vpn_packet (pkt, rsi);
    }
}

void
vpn::udpv4_ev (short revents)
{
  if (revents & (POLLIN | POLLERR))
    {
      vpn_packet *pkt = new vpn_packet;
      struct sockaddr_in sa;
      socklen_t sa_len = sizeof (sa);
      int len;

      len = recvfrom (udpv4_fd, &((*pkt)[0]), MAXSIZE, 0, (sockaddr *)&sa, &sa_len);

      sockinfo si(sa);

      if (len > 0)
        {
          pkt->len = len;

          recv_vpn_packet (pkt, si);
        }
      else
        {
          // probably ECONNRESET or somesuch
          slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));
        }

      delete pkt;
    }
  else if (revents & POLLHUP)
    {
      // this cannot ;) happen on udp sockets
      slog (L_ERR, _("FATAL: POLLHUP on udp v4 fd, terminating."));
      exit (1);
    }
  else
    {
      slog (L_ERR,
              _("FATAL: unknown revents %08x in socket, terminating\n"),
              revents);
      exit (1);
    }
}

void
vpn::ipv4_ev (short revents)
{
  if (revents & (POLLIN | POLLERR))
    {
      vpn_packet *pkt = new vpn_packet;
      struct sockaddr_in sa;
      socklen_t sa_len = sizeof (sa);
      int len;

      len = recvfrom (ipv4_fd, &((*pkt)[0]), MAXSIZE, 0, (sockaddr *)&sa, &sa_len);

      sockinfo si(sa, PROT_IPv4);

      if (len > 0)
        {
          pkt->len = len;

          // raw sockets deliver the ipv4, but don't expect it on sends
          // this is slow, but...
          pkt->skip_hdr (IP_OVERHEAD);

          recv_vpn_packet (pkt, si);
        }
      else
        {
          // probably ECONNRESET or somesuch
          slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));
        }

      delete pkt;
    }
  else if (revents & POLLHUP)
    {
      // this cannot ;) happen on udp sockets
      slog (L_ERR, _("FATAL: POLLHUP on ipv4 fd, terminating."));
      exit (1);
    }
  else
    {
      slog (L_ERR,
              _("FATAL: unknown revents %08x in socket, terminating\n"),
              revents);
      exit (1);
    }
}

void
vpn::tap_ev (short revents)
{
  if (revents & POLLIN)
    {
      /* process data */
      tap_packet *pkt;

      pkt = tap->recv ();

      int dst = mac2id (pkt->dst);
      int src = mac2id (pkt->src);

      if (src != THISNODE->id)
        {
          slog (L_ERR, _("FATAL: tap packet not originating on current node received, terminating."));
          exit (1);
        }

      if (dst == THISNODE->id)
        {
          slog (L_ERR, _("FATAL: tap packet destined for current node received, terminating."));
          exit (1);
        }

      if (dst > conns.size ())
        slog (L_ERR, _("tap packet for unknown node %d received, ignoring."), dst);
      else
        {
          if (dst)
            {
              // unicast
              if (dst != THISNODE->id)
                conns[dst - 1]->inject_data_packet (pkt);
            }
          else
            {
              // broadcast, first check router, then self, then english
              connection *router = find_router ();

              if (router)
                router->inject_data_packet (pkt, true);
              else
                for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
                  if ((*c)->conf != THISNODE)
                    (*c)->inject_data_packet (pkt);
            }
        }

      delete pkt;
    }
  else if (revents & (POLLHUP | POLLERR))
    {
      slog (L_ERR, _("FATAL: POLLHUP or POLLERR on network device fd, terminating."));
      exit (1);
    }
  else
    abort ();
}

void
vpn::event_cb (tstamp &ts)
{
  if (events)
    {
      if (events & EVENT_SHUTDOWN)
        {
          slog (L_INFO, _("preparing shutdown..."));

          shutdown_all ();

          remove_pid (pidfilename);

          slog (L_INFO, _("terminating"));

          exit (0);
        }

      if (events & EVENT_RECONNECT)
        {
          slog (L_INFO, _("forced reconnect"));

          reconnect_all ();
        }

      events = 0;
    }

  ts = TSTAMP_CANCEL;
}

void
vpn::shutdown_all ()
{
  for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
    (*c)->shutdown ();
}

void
vpn::reconnect_all ()
{
  for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
    delete *c;

  conns.clear ();

  connection_init ();

  for (configuration::node_vector::iterator i = conf.nodes.begin ();
       i != conf.nodes.end (); ++i)
    {
      connection *conn = new connection (this);

      conn->conf = *i;
      conns.push_back (conn);

      conn->establish_connection ();
    }
}

connection *vpn::find_router ()
{
  u32 prio = 0;
  connection *router = 0;

  for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
    {
      connection *c = *i;

      if (c->conf->routerprio > prio
          && c->connectmode == conf_node::C_ALWAYS
          && c->conf != THISNODE
          && c->ictx && c->octx)
        {
          prio = c->conf->routerprio;
          router = c;
        }
    }

  return router;
}

void vpn::connect_request (int id)
{
  connection *c = find_router ();

  if (c)
    c->connect_request (id);
  //else // does not work, because all others must connect to the same router
  //  // no router found, aggressively connect to all routers
  //  for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
  //    if ((*i)->conf->routerprio)
  //      (*i)->establish_connection ();
}

void
connection::dump_status ()
{
  slog (L_NOTICE, _("node %s (id %d)"), conf->nodename, conf->id);
  slog (L_NOTICE, _("  connectmode %d (%d) / sockaddr %s / minor %d"),
        connectmode, conf->connectmode, (const char *)si, (int)prot_minor);
  slog (L_NOTICE, _("  ictx/octx %08lx/%08lx / oseqno %d / retry_cnt %d"),
        (long)ictx, (long)octx, (int)oseqno, (int)retry_cnt);
  slog (L_NOTICE, _("  establish_conn %ld / rekey %ld / keepalive %ld"),
        (long)(establish_connection.at), (long)(rekey.at), (long)(keepalive.at));
}

void
vpn::dump_status ()
{
  slog (L_NOTICE, _("BEGIN status dump (%ld)"), (long)NOW);

  for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
    (*c)->dump_status ();

  slog (L_NOTICE, _("END status dump"));
}

vpn::vpn (void)
: udpv4_ev_watcher(this, &vpn::udpv4_ev)
, ipv4_ev_watcher(this, &vpn::ipv4_ev)
, tap_ev_watcher(this, &vpn::tap_ev)
, event(this, &vpn::event_cb)
{
}

vpn::~vpn ()
{
}

Revision:	1.26
Committed:	Wed Apr 2 03:06:22 2003 UTC (23 years, 6 months ago) by pcg
Content type:	text/plain
Branch:	MAIN
Changes since 1.25:	+3 -1153 lines
Log Message:	* empty log message *
#	User	Rev	Content
1	pcg	1.1	/*
2			protocol.C -- handle the protocol, encryption, handshaking etc.
3
4			This program is free software; you can redistribute it and/or modify
5			it under the terms of the GNU General Public License as published by
6			the Free Software Foundation; either version 2 of the License, or
7			(at your option) any later version.
8
9			This program is distributed in the hope that it will be useful,
10			but WITHOUT ANY WARRANTY; without even the implied warranty of
11			MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12			GNU General Public License for more details.
13
14			You should have received a copy of the GNU General Public License
15			along with this program; if not, write to the Free Software
16			Foundation, Inc. 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
17			*/
18
19			#include "config.h"
20
21	pcg	1.10	#include <list>
22
23	pcg	1.1	#include <cstdlib>
24			#include <cstring>
25			#include <cstdio>
26
27			#include <sys/types.h>
28			#include <sys/socket.h>
29			#include <sys/poll.h>
30			#include <sys/wait.h>
31			#include <netinet/in.h>
32			#include <arpa/inet.h>
33			#include <errno.h>
34			#include <time.h>
35			#include <unistd.h>
36
37			#include "pidfile.h"
38
39	pcg	1.26	#include "connection.h"
40			#include "util.h"
41	pcg	1.1	#include "protocol.h"
42
43			/////////////////////////////////////////////////////////////////////////////
44
45	pcg	1.17	const char *vpn::script_if_up (int)
46	pcg	1.1	{
47			// the tunnel device mtu should be the physical mtu - overhead
48			// the tricky part is rounding to the cipher key blocksize
49	pcg	1.17	int mtu = conf.mtu - ETH_OVERHEAD - VPE_OVERHEAD - MAX_OVERHEAD;
50	pcg	1.1	mtu += ETH_OVERHEAD - 6 - 6; // now we have the data portion
51			mtu -= mtu % EVP_CIPHER_block_size (CIPHER); // round
52			mtu -= ETH_OVERHEAD - 6 - 6; // and get interface mtu again
53
54			char *env;
55			asprintf (&env, "CONFBASE=%s", confbase);
56			putenv (env);
57			asprintf (&env, "NODENAME=%s", THISNODE->nodename);
58			putenv (env);
59			asprintf (&env, "NODEID=%d", THISNODE->id);
60			putenv (env);
61			asprintf (&env, "IFNAME=%s", tap->interface ());
62			putenv (env);
63			asprintf (&env, "MTU=%d", mtu);
64			putenv (env);
65			asprintf (&env, "MAC=%02x:%02x:%02x:%02x:%02x:%02x",
66			0xfe, 0xfd, 0x80, 0x00, THISNODE->id >> 8,
67			THISNODE->id & 0xff);
68			putenv (env);
69
70			return ::conf.script_if_up ? ::conf.script_if_up : "if-up";
71			}
72
73			int
74	pcg	1.21	vpn::setup ()
75	pcg	1.1	{
76	pcg	1.21	sockinfo si;
77	pcg	1.1
78	pcg	1.21	si.set (THISNODE);
79
80			udpv4_fd = -1;
81
82	pcg	1.24	if (THISNODE->protocols & PROT_UDPv4)
83	pcg	1.1	{
84	pcg	1.21	udpv4_fd = socket (PF_INET, SOCK_DGRAM, IPPROTO_UDP);
85
86			if (udpv4_fd < 0)
87			return -1;
88
89			if (bind (udpv4_fd, si.sav4 (), si.salenv4 ()))
90			{
91			slog (L_ERR, _("can't bind udpv4 to %s: %s"), (const char *)si, strerror (errno));
92			exit (1);
93			}
94
95			#ifdef IP_MTU_DISCOVER
96			// this I really consider a linux bug. I am neither connected
97			// nor do I fragment myself. Linux still sets DF and doesn't
98			// fragment for me sometimes.
99			{
100			int oval = IP_PMTUDISC_DONT;
101			setsockopt (udpv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
102			}
103			#endif
104
105			// standard daemon practise...
106			{
107			int oval = 1;
108			setsockopt (udpv4_fd, SOL_SOCKET, SO_REUSEADDR, &oval, sizeof oval);
109			}
110
111			udpv4_ev_watcher.start (udpv4_fd, POLLIN);
112	pcg	1.1	}
113
114	pcg	1.21	ipv4_fd = -1;
115	pcg	1.24	if (THISNODE->protocols & PROT_IPv4)
116	pcg	1.21	{
117			ipv4_fd = socket (PF_INET, SOCK_RAW, ::conf.ip_proto);
118
119			if (ipv4_fd < 0)
120			return -1;
121
122			if (bind (ipv4_fd, si.sav4 (), si.salenv4 ()))
123			{
124			slog (L_ERR, _("can't bind ipv4 socket to %s: %s"), (const char *)si, strerror (errno));
125			exit (1);
126			}
127
128	pcg	1.1	#ifdef IP_MTU_DISCOVER
129	pcg	1.21	// this I really consider a linux bug. I am neither connected
130			// nor do I fragment myself. Linux still sets DF and doesn't
131			// fragment for me sometimes.
132			{
133			int oval = IP_PMTUDISC_DONT;
134			setsockopt (ipv4_fd, SOL_IP, IP_MTU_DISCOVER, &oval, sizeof oval);
135			}
136	pcg	1.1	#endif
137
138	pcg	1.21	ipv4_ev_watcher.start (ipv4_fd, POLLIN);
139			}
140	pcg	1.9
141	pcg	1.1	tap = new tap_device ();
142			if (!tap) //D this, of course, never catches
143			{
144			slog (L_ERR, _("cannot create network interface '%s'"), conf.ifname);
145			exit (1);
146			}
147	pcg	1.9
148	pcg	1.17	run_script (run_script_cb (this, &vpn::script_if_up), true);
149	pcg	1.9
150	pcg	1.21	tap_ev_watcher.start (tap->fd, POLLIN);
151	pcg	1.1
152	pcg	1.9	reconnect_all ();
153	pcg	1.1
154			return 0;
155			}
156
157			void
158	pcg	1.21	vpn::send_ipv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
159	pcg	1.1	{
160	pcg	1.21	setsockopt (ipv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);
161			sendto (ipv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
162	pcg	1.1	}
163
164			void
165	pcg	1.21	vpn::send_udpv4_packet (vpn_packet *pkt, const sockinfo &si, int tos)
166	pcg	1.1	{
167	pcg	1.21	setsockopt (udpv4_fd, SOL_IP, IP_TOS, &tos, sizeof tos);
168			sendto (udpv4_fd, &((*pkt)[0]), pkt->len, 0, si.sav4 (), si.salenv4 ());
169	pcg	1.1	}
170
171			void
172	pcg	1.21	vpn::recv_vpn_packet (vpn_packet *pkt, const sockinfo &rsi)
173	pcg	1.1	{
174	pcg	1.21	unsigned int src = pkt->src ();
175			unsigned int dst = pkt->dst ();
176
177			slog (L_NOISE, _("<<?/%s received possible vpn packet type %d from %d to %d, length %d"),
178			(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst (), pkt->len);
179	pcg	1.1
180	pcg	1.24	if (src == 0 \|\| src > conns.size ()
181			\|\| dst > conns.size ()
182			\|\| pkt->typ () >= vpn_packet::PT_MAX)
183			slog (L_WARN, _("(%s): received corrupted packet type %d (src %d, dst %d)"),
184			(const char *)rsi, pkt->typ (), pkt->src (), pkt->dst ());
185	pcg	1.21	else
186	pcg	1.24	{
187			connection *c = conns[src - 1];
188
189			if (dst == 0 && !THISNODE->routerprio)
190			slog (L_WARN, _("%s(%s): received broadcast, but we are no router"),
191			c->conf->nodename, (const char *)rsi);
192			else if (dst != 0 && dst != THISNODE->id)
193			// FORWARDING NEEDED ;)
194			slog (L_WARN,
195			_("received frame for node %d ('%s') from %s, but this is node %d ('%s')"),
196			dst, conns[dst - 1]->conf->nodename,
197			(const char *)rsi,
198			THISNODE->id, THISNODE->nodename);
199			else
200			c->recv_vpn_packet (pkt, rsi);
201			}
202	pcg	1.21	}
203	pcg	1.1
204	pcg	1.21	void
205			vpn::udpv4_ev (short revents)
206			{
207			if (revents & (POLLIN \| POLLERR))
208	pcg	1.1	{
209	pcg	1.21	vpn_packet *pkt = new vpn_packet;
210			struct sockaddr_in sa;
211			socklen_t sa_len = sizeof (sa);
212			int len;
213	pcg	1.1
214	pcg	1.21	len = recvfrom (udpv4_fd, &((pkt)[0]), MAXSIZE, 0, (sockaddr )&sa, &sa_len);
215	pcg	1.1
216	pcg	1.21	sockinfo si(sa);
217	pcg	1.1
218	pcg	1.21	if (len > 0)
219			{
220			pkt->len = len;
221	pcg	1.1
222	pcg	1.21	recv_vpn_packet (pkt, si);
223			}
224			else
225	pcg	1.1	{
226	pcg	1.21	// probably ECONNRESET or somesuch
227			slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));
228	pcg	1.1	}
229	pcg	1.21
230			delete pkt;
231			}
232			else if (revents & POLLHUP)
233			{
234			// this cannot ;) happen on udp sockets
235			slog (L_ERR, _("FATAL: POLLHUP on udp v4 fd, terminating."));
236			exit (1);
237			}
238			else
239			{
240			slog (L_ERR,
241			_("FATAL: unknown revents %08x in socket, terminating\n"),
242			revents);
243			exit (1);
244	pcg	1.1	}
245			}
246
247			void
248	pcg	1.21	vpn::ipv4_ev (short revents)
249	pcg	1.1	{
250	pcg	1.9	if (revents & (POLLIN \| POLLERR))
251			{
252			vpn_packet *pkt = new vpn_packet;
253			struct sockaddr_in sa;
254			socklen_t sa_len = sizeof (sa);
255			int len;
256	pcg	1.1
257	pcg	1.21	len = recvfrom (ipv4_fd, &((pkt)[0]), MAXSIZE, 0, (sockaddr )&sa, &sa_len);
258
259			sockinfo si(sa, PROT_IPv4);
260	pcg	1.1
261	pcg	1.9	if (len > 0)
262			{
263			pkt->len = len;
264
265	pcg	1.21	// raw sockets deliver the ipv4, but don't expect it on sends
266			// this is slow, but...
267			pkt->skip_hdr (IP_OVERHEAD);
268	pcg	1.1
269	pcg	1.21	recv_vpn_packet (pkt, si);
270	pcg	1.9	}
271			else
272	pcg	1.1	{
273	pcg	1.9	// probably ECONNRESET or somesuch
274	pcg	1.21	slog (L_DEBUG, _("%s: %s"), (const char *)si, strerror (errno));
275	pcg	1.9	}
276
277			delete pkt;
278			}
279			else if (revents & POLLHUP)
280			{
281			// this cannot ;) happen on udp sockets
282	pcg	1.21	slog (L_ERR, _("FATAL: POLLHUP on ipv4 fd, terminating."));
283	pcg	1.9	exit (1);
284			}
285			else
286			{
287			slog (L_ERR,
288			_("FATAL: unknown revents %08x in socket, terminating\n"),
289			revents);
290			exit (1);
291			}
292			}
293	pcg	1.1
294	pcg	1.9	void
295	pcg	1.21	vpn::tap_ev (short revents)
296	pcg	1.9	{
297			if (revents & POLLIN)
298			{
299			/* process data */
300			tap_packet *pkt;
301	pcg	1.1
302	pcg	1.9	pkt = tap->recv ();
303	pcg	1.1
304	pcg	1.9	int dst = mac2id (pkt->dst);
305			int src = mac2id (pkt->src);
306	pcg	1.1
307	pcg	1.9	if (src != THISNODE->id)
308			{
309			slog (L_ERR, _("FATAL: tap packet not originating on current node received, terminating."));
310			exit (1);
311			}
312	pcg	1.1
313	pcg	1.9	if (dst == THISNODE->id)
314			{
315			slog (L_ERR, _("FATAL: tap packet destined for current node received, terminating."));
316			exit (1);
317			}
318	pcg	1.1
319	pcg	1.9	if (dst > conns.size ())
320			slog (L_ERR, _("tap packet for unknown node %d received, ignoring."), dst);
321			else
322			{
323			if (dst)
324			{
325			// unicast
326			if (dst != THISNODE->id)
327			conns[dst - 1]->inject_data_packet (pkt);
328	pcg	1.1	}
329	pcg	1.9	else
330	pcg	1.1	{
331	pcg	1.9	// broadcast, first check router, then self, then english
332			connection *router = find_router ();
333	pcg	1.1
334	pcg	1.9	if (router)
335			router->inject_data_packet (pkt, true);
336	pcg	1.1	else
337	pcg	1.9	for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
338			if ((*c)->conf != THISNODE)
339			(*c)->inject_data_packet (pkt);
340	pcg	1.1	}
341			}
342
343	pcg	1.9	delete pkt;
344			}
345			else if (revents & (POLLHUP \| POLLERR))
346			{
347			slog (L_ERR, _("FATAL: POLLHUP or POLLERR on network device fd, terminating."));
348			exit (1);
349			}
350			else
351			abort ();
352			}
353
354			void
355			vpn::event_cb (tstamp &ts)
356			{
357			if (events)
358			{
359			if (events & EVENT_SHUTDOWN)
360	pcg	1.1	{
361	pcg	1.21	slog (L_INFO, _("preparing shutdown..."));
362
363	pcg	1.9	shutdown_all ();
364	pcg	1.1
365	pcg	1.9	remove_pid (pidfilename);
366	pcg	1.1
367	pcg	1.21	slog (L_INFO, _("terminating"));
368	pcg	1.1
369	pcg	1.9	exit (0);
370			}
371	pcg	1.1
372	pcg	1.9	if (events & EVENT_RECONNECT)
373	pcg	1.21	{
374			slog (L_INFO, _("forced reconnect"));
375
376			reconnect_all ();
377			}
378	pcg	1.1
379	pcg	1.9	events = 0;
380			}
381	pcg	1.1
382	pcg	1.9	ts = TSTAMP_CANCEL;
383			}
384	pcg	1.1
385	pcg	1.21	void
386			vpn::shutdown_all ()
387			{
388			for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
389			(*c)->shutdown ();
390			}
391
392			void
393			vpn::reconnect_all ()
394			{
395			for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
396			delete *c;
397
398			conns.clear ();
399
400	pcg	1.26	connection_init ();
401	pcg	1.21
402			for (configuration::node_vector::iterator i = conf.nodes.begin ();
403			i != conf.nodes.end (); ++i)
404			{
405			connection *conn = new connection (this);
406
407			conn->conf = *i;
408			conns.push_back (conn);
409
410			conn->establish_connection ();
411			}
412			}
413
414			connection *vpn::find_router ()
415			{
416			u32 prio = 0;
417			connection *router = 0;
418
419			for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
420			{
421			connection c = i;
422
423			if (c->conf->routerprio > prio
424			&& c->connectmode == conf_node::C_ALWAYS
425			&& c->conf != THISNODE
426			&& c->ictx && c->octx)
427			{
428			prio = c->conf->routerprio;
429			router = c;
430			}
431			}
432
433			return router;
434			}
435
436			void vpn::connect_request (int id)
437			{
438			connection *c = find_router ();
439
440			if (c)
441			c->connect_request (id);
442			//else // does not work, because all others must connect to the same router
443			// // no router found, aggressively connect to all routers
444			// for (conns_vector::iterator i = conns.begin (); i != conns.end (); ++i)
445			// if ((*i)->conf->routerprio)
446			// (*i)->establish_connection ();
447			}
448
449			void
450			connection::dump_status ()
451			{
452			slog (L_NOTICE, _("node %s (id %d)"), conf->nodename, conf->id);
453			slog (L_NOTICE, _(" connectmode %d (%d) / sockaddr %s / minor %d"),
454			connectmode, conf->connectmode, (const char *)si, (int)prot_minor);
455			slog (L_NOTICE, _(" ictx/octx %08lx/%08lx / oseqno %d / retry_cnt %d"),
456			(long)ictx, (long)octx, (int)oseqno, (int)retry_cnt);
457			slog (L_NOTICE, _(" establish_conn %ld / rekey %ld / keepalive %ld"),
458			(long)(establish_connection.at), (long)(rekey.at), (long)(keepalive.at));
459			}
460
461			void
462			vpn::dump_status ()
463			{
464			slog (L_NOTICE, _("BEGIN status dump (%ld)"), (long)NOW);
465
466			for (conns_vector::iterator c = conns.begin (); c != conns.end (); ++c)
467			(*c)->dump_status ();
468
469			slog (L_NOTICE, _("END status dump"));
470			}
471
472	pcg	1.9	vpn::vpn (void)
473	pcg	1.21	: udpv4_ev_watcher(this, &vpn::udpv4_ev)
474			, ipv4_ev_watcher(this, &vpn::ipv4_ev)
475			, tap_ev_watcher(this, &vpn::tap_ev)
476			, event(this, &vpn::event_cb)
477	pcg	1.9	{
478	pcg	1.1	}
479
480			vpn::~vpn ()
481	pcg	1.9	{
482			}
483	pcg	1.1