aboutsummaryrefslogtreecommitdiffstats
path: root/sgsnemu
diff options
context:
space:
mode:
authorjjako <jjako>2003-04-11 09:40:12 +0000
committerjjako <jjako>2003-04-11 09:40:12 +0000
commita7cd249501b869ed518746b301eb92230ec50f50 (patch)
tree685d542efae0d9e14c1bd21ecb64117521f8c5a9 /sgsnemu
parentafb2a970de8bcc78142bf0a40a8481012a6d2f34 (diff)
added ippool.h and ippool.c
Diffstat (limited to 'sgsnemu')
-rw-r--r--sgsnemu/Makefile.am4
-rw-r--r--sgsnemu/Makefile.in12
-rw-r--r--sgsnemu/cmdline.c96
-rw-r--r--sgsnemu/cmdline.ggo87
-rw-r--r--sgsnemu/cmdline.h8
-rw-r--r--sgsnemu/ippool.c416
-rw-r--r--sgsnemu/ippool.h105
-rw-r--r--sgsnemu/sgsnemu.c1141
-rw-r--r--sgsnemu/tun.c490
-rw-r--r--sgsnemu/tun.h76
10 files changed, 1666 insertions, 769 deletions
diff --git a/sgsnemu/Makefile.am b/sgsnemu/Makefile.am
index 49b4588..b72604e 100644
--- a/sgsnemu/Makefile.am
+++ b/sgsnemu/Makefile.am
@@ -2,9 +2,9 @@ bin_PROGRAMS = sgsnemu
LDFLAGS = -Wl,--rpath -Wl,/usr/local/lib
-CFLAGS = -O2 -D_GNU_SOURCE -fno-builtin -Wall -ansi -DSBINDIR='"$(sbindir)"' -lgtp -L../gtp
+CFLAGS = -O2 -D_GNU_SOURCE -fno-builtin -Wall -ansi -DSBINDIR='"$(sbindir)"' -ggdb -lgtp -L../gtp
-sgsnemu_SOURCES = sgsnemu.c tun.c tun.h cmdline.c cmdline.h
+sgsnemu_SOURCES = sgsnemu.c tun.c tun.h cmdline.c cmdline.h ippool.h ippool.c syserr.h syserr.c
diff --git a/sgsnemu/Makefile.in b/sgsnemu/Makefile.in
index 9407ca0..9a6d74e 100644
--- a/sgsnemu/Makefile.in
+++ b/sgsnemu/Makefile.in
@@ -89,9 +89,9 @@ bin_PROGRAMS = sgsnemu
LDFLAGS = -Wl,--rpath -Wl,/usr/local/lib
-CFLAGS = -O2 -D_GNU_SOURCE -fno-builtin -Wall -ansi -DSBINDIR='"$(sbindir)"' -lgtp -L../gtp
+CFLAGS = -O2 -D_GNU_SOURCE -fno-builtin -Wall -ansi -DSBINDIR='"$(sbindir)"' -ggdb -lgtp -L../gtp
-sgsnemu_SOURCES = sgsnemu.c tun.c tun.h cmdline.c cmdline.h
+sgsnemu_SOURCES = sgsnemu.c tun.c tun.h cmdline.c cmdline.h ippool.h ippool.c syserr.h syserr.c
subdir = sgsnemu
mkinstalldirs = $(SHELL) $(top_srcdir)/mkinstalldirs
CONFIG_HEADER = $(top_builddir)/config.h
@@ -99,7 +99,8 @@ CONFIG_CLEAN_FILES =
bin_PROGRAMS = sgsnemu$(EXEEXT)
PROGRAMS = $(bin_PROGRAMS)
-am_sgsnemu_OBJECTS = sgsnemu.$(OBJEXT) tun.$(OBJEXT) cmdline.$(OBJEXT)
+am_sgsnemu_OBJECTS = sgsnemu.$(OBJEXT) tun.$(OBJEXT) cmdline.$(OBJEXT) \
+ ippool.$(OBJEXT) syserr.$(OBJEXT)
sgsnemu_OBJECTS = $(am_sgsnemu_OBJECTS)
sgsnemu_LDADD = $(LDADD)
sgsnemu_DEPENDENCIES =
@@ -111,7 +112,8 @@ CPPFLAGS = @CPPFLAGS@
LIBS = @LIBS@
depcomp = $(SHELL) $(top_srcdir)/depcomp
am__depfiles_maybe = depfiles
-@AMDEP_TRUE@DEP_FILES = ./$(DEPDIR)/cmdline.Po ./$(DEPDIR)/sgsnemu.Po \
+@AMDEP_TRUE@DEP_FILES = ./$(DEPDIR)/cmdline.Po ./$(DEPDIR)/ippool.Po \
+@AMDEP_TRUE@ ./$(DEPDIR)/sgsnemu.Po ./$(DEPDIR)/syserr.Po \
@AMDEP_TRUE@ ./$(DEPDIR)/tun.Po
COMPILE = $(CC) $(DEFS) $(DEFAULT_INCLUDES) $(INCLUDES) $(AM_CPPFLAGS) \
$(CPPFLAGS) $(AM_CFLAGS) $(CFLAGS)
@@ -173,7 +175,9 @@ distclean-compile:
-rm -f *.tab.c
@AMDEP_TRUE@@am__include@ @am__quote@./$(DEPDIR)/cmdline.Po@am__quote@
+@AMDEP_TRUE@@am__include@ @am__quote@./$(DEPDIR)/ippool.Po@am__quote@
@AMDEP_TRUE@@am__include@ @am__quote@./$(DEPDIR)/sgsnemu.Po@am__quote@
+@AMDEP_TRUE@@am__include@ @am__quote@./$(DEPDIR)/syserr.Po@am__quote@
@AMDEP_TRUE@@am__include@ @am__quote@./$(DEPDIR)/tun.Po@am__quote@
distclean-depend:
diff --git a/sgsnemu/cmdline.c b/sgsnemu/cmdline.c
index a781b18..2240c56 100644
--- a/sgsnemu/cmdline.c
+++ b/sgsnemu/cmdline.c
@@ -1,7 +1,7 @@
/*
- File autogenerated by gengetopt version 2.8rc
+ File autogenerated by gengetopt version 2.8
generated with the following command:
- ../../gengetopt-2.8rc/src/gengetopt --conf-parser
+ gengetopt --conf-parser
The developers of gengetopt consider the fixed text that goes in all
gengetopt output files to be in the public domain:
@@ -61,10 +61,9 @@ cmdline_parser_print_help (void)
printf(" -uSTRING --uid=STRING Login user ID (default='mig')\n");
printf(" -pSTRING --pwd=STRING Login password (default='hemmelig')\n");
printf(" --createif Create local network interface (default=off)\n");
+ printf(" --defaultroute Create default route (default=off)\n");
printf(" --ipup=STRING Script to run after link-up\n");
printf(" --ipdown=STRING Script to run after link-down\n");
- printf(" --net=STRING Network (default='0.0.0.0')\n");
- printf(" --mask=STRING Network mask (default='0.0.0.0')\n");
printf(" --pinghost=STRING Ping remote host\n");
printf(" --pingrate=INT Number of ping req per second (default='1')\n");
printf(" --pingsize=INT Number of ping data bytes (default='56')\n");
@@ -112,10 +111,9 @@ cmdline_parser (int argc, char * const *argv, struct gengetopt_args_info *args_i
args_info->uid_given = 0 ;
args_info->pwd_given = 0 ;
args_info->createif_given = 0 ;
+ args_info->defaultroute_given = 0 ;
args_info->ipup_given = 0 ;
args_info->ipdown_given = 0 ;
- args_info->net_given = 0 ;
- args_info->mask_given = 0 ;
args_info->pinghost_given = 0 ;
args_info->pingrate_given = 0 ;
args_info->pingsize_given = 0 ;
@@ -139,10 +137,9 @@ cmdline_parser (int argc, char * const *argv, struct gengetopt_args_info *args_i
args_info->uid_arg = strdup("mig") ;\
args_info->pwd_arg = strdup("hemmelig") ;\
args_info->createif_flag = 0;\
+ args_info->defaultroute_flag = 0;\
args_info->ipup_arg = NULL; \
args_info->ipdown_arg = NULL; \
- args_info->net_arg = strdup("0.0.0.0") ;\
- args_info->mask_arg = strdup("0.0.0.0") ;\
args_info->pinghost_arg = NULL; \
args_info->pingrate_arg = 1 ;\
args_info->pingsize_arg = 56 ;\
@@ -181,10 +178,9 @@ cmdline_parser (int argc, char * const *argv, struct gengetopt_args_info *args_i
{ "uid", 1, NULL, 'u' },
{ "pwd", 1, NULL, 'p' },
{ "createif", 0, NULL, 0 },
+ { "defaultroute", 0, NULL, 0 },
{ "ipup", 1, NULL, 0 },
{ "ipdown", 1, NULL, 0 },
- { "net", 1, NULL, 0 },
- { "mask", 1, NULL, 0 },
{ "pinghost", 1, NULL, 0 },
{ "pingrate", 1, NULL, 0 },
{ "pingsize", 1, NULL, 0 },
@@ -410,6 +406,19 @@ cmdline_parser (int argc, char * const *argv, struct gengetopt_args_info *args_i
args_info->createif_flag = !(args_info->createif_flag);
break;
}
+ /* Create default route. */
+ else if (strcmp (long_options[option_index].name, "defaultroute") == 0)
+ {
+ if (args_info->defaultroute_given)
+ {
+ fprintf (stderr, "%s: `--defaultroute' option given more than once\n", PACKAGE);
+ clear_args ();
+ exit (EXIT_FAILURE);
+ }
+ args_info->defaultroute_given = 1;
+ args_info->defaultroute_flag = !(args_info->defaultroute_flag);
+ break;
+ }
/* Script to run after link-up. */
else if (strcmp (long_options[option_index].name, "ipup") == 0)
{
@@ -436,32 +445,6 @@ cmdline_parser (int argc, char * const *argv, struct gengetopt_args_info *args_i
args_info->ipdown_arg = strdup (optarg);
break;
}
- /* Network. */
- else if (strcmp (long_options[option_index].name, "net") == 0)
- {
- if (args_info->net_given)
- {
- fprintf (stderr, "%s: `--net' option given more than once\n", PACKAGE);
- clear_args ();
- exit (EXIT_FAILURE);
- }
- args_info->net_given = 1;
- args_info->net_arg = strdup (optarg);
- break;
- }
- /* Network mask. */
- else if (strcmp (long_options[option_index].name, "mask") == 0)
- {
- if (args_info->mask_given)
- {
- fprintf (stderr, "%s: `--mask' option given more than once\n", PACKAGE);
- clear_args ();
- exit (EXIT_FAILURE);
- }
- args_info->mask_given = 1;
- args_info->mask_arg = strdup (optarg);
- break;
- }
/* Ping remote host. */
else if (strcmp (long_options[option_index].name, "pinghost") == 0)
{
@@ -851,6 +834,15 @@ cmdline_parser_configfile (char * const filename, struct gengetopt_args_info *ar
}
continue;
}
+ if (!strcmp(fopt, "defaultroute"))
+ {
+ if (override || !args_info->defaultroute_given)
+ {
+ args_info->defaultroute_given = 1;
+ args_info->defaultroute_flag = !(args_info->defaultroute_flag);
+ }
+ continue;
+ }
if (!strcmp(fopt, "ipup"))
{
if (override || !args_info->ipup_given)
@@ -883,38 +875,6 @@ cmdline_parser_configfile (char * const filename, struct gengetopt_args_info *ar
}
continue;
}
- if (!strcmp(fopt, "net"))
- {
- if (override || !args_info->net_given)
- {
- args_info->net_given = 1;
- if (fnum == 2)
- args_info->net_arg = strdup (farg);
- else
- {
- fprintf (stderr, "%s:%d: required <option_name> <option_val>\n",
- filename, line_num);
- exit (EXIT_FAILURE);
- }
- }
- continue;
- }
- if (!strcmp(fopt, "mask"))
- {
- if (override || !args_info->mask_given)
- {
- args_info->mask_given = 1;
- if (fnum == 2)
- args_info->mask_arg = strdup (farg);
- else
- {
- fprintf (stderr, "%s:%d: required <option_name> <option_val>\n",
- filename, line_num);
- exit (EXIT_FAILURE);
- }
- }
- continue;
- }
if (!strcmp(fopt, "pinghost"))
{
if (override || !args_info->pinghost_given)
diff --git a/sgsnemu/cmdline.ggo b/sgsnemu/cmdline.ggo
index 8a7bf4e..0b562ec 100644
--- a/sgsnemu/cmdline.ggo
+++ b/sgsnemu/cmdline.ggo
@@ -1,46 +1,49 @@
-# OpenGGSN - Gateway GPRS Support Node
-# Copyright (C) 2002 Mondru AB.
+# OpenGGSN - Gateway GPRS Support Node
+# Copyright (C) 2002, 2003 Mondru AB.
#
-# The contents of this file may be used under the terms of the GNU
-# General Public License Version 2, provided that the above copyright
-# notice and this permission notice is included in all copies or
-# substantial portions of the software.
+# The contents of this file may be used under the terms of the GNU
+# General Public License Version 2, provided that the above copyright
+# notice and this permission notice is included in all copies or
+# substantial portions of the software.
#
-# The initial developer of the original code is
-# Jens Jakobsen <jj@openggsn.org>
+# The initial developer of the original code is
+# Jens Jakobsen <jj@openggsn.org>
#
-# Contributor(s):
-
-option "fg" f "Run in foreground" flag off
-option "debug" d "Run in debug mode" flag off
-
-option "conf" c "Read configuration file" string no
-option "pidfile" - "Filename of process id file" string default="./sgsnemu.pid" no
-option "statedir" - "Directory of nonvolatile data" string default="./" no
-
-option "dns" - "DNS Server to use" string no
-option "listen" l "Local interface" string no
-option "remote" r "Remote host" string no
-
-option "contexts" - "Number of contexts" int default="1" no
-option "timelimit" - "Exit after timelimit seconds" int default="0" no
-
-option "apn" a "Access point name" string default="internet" no
-option "imsi" i "IMSI" string default="240010123456789" no
-option "msisdn" m "Mobile Station ISDN number" string default="46702123456" no
-option "qos" q "Requested quality of service" int default="0x0b921f" no
-option "uid" u "Login user ID" string default="mig" no
-option "pwd" p "Login password" string default="hemmelig" no
-
-option "createif" - "Create local network interface" flag off
-option "ipup" - "Script to run after link-up" string no
-option "ipdown" - "Script to run after link-down" string no
-option "net" - "Network" string default="0.0.0.0" no
-option "mask" - "Network mask" string default="0.0.0.0" no
-
-option "pinghost" - "Ping remote host" string no
-option "pingrate" - "Number of ping req per second" int default="1" no
-option "pingsize" - "Number of ping data bytes" int default="56" no
-option "pingcount" - "Number of ping req to send" int default="0" no
-option "pingquiet" - "Do not print ping packet info" flag off
+# Contributor(s):
+#
+#
+# Use "gengetopt --conf-parser < cmdline.ggo"
+# to generate cmdline.c and cmdline.h
+
+option "fg" f "Run in foreground" flag off
+option "debug" d "Run in debug mode" flag off
+
+option "conf" c "Read configuration file" string no
+option "pidfile" - "Filename of process id file" string default="./sgsnemu.pid" no
+option "statedir" - "Directory of nonvolatile data" string default="./" no
+
+option "dns" - "DNS Server to use" string no
+option "listen" l "Local interface" string no
+option "remote" r "Remote host" string no
+
+option "contexts" - "Number of contexts" int default="1" no
+option "timelimit" - "Exit after timelimit seconds" int default="0" no
+
+option "apn" a "Access point name" string default="internet" no
+option "imsi" i "IMSI" string default="240010123456789" no
+option "msisdn" m "Mobile Station ISDN number" string default="46702123456" no
+option "qos" q "Requested quality of service" int default="0x0b921f" no
+option "uid" u "Login user ID" string default="mig" no
+option "pwd" p "Login password" string default="hemmelig" no
+
+option "createif" - "Create local network interface" flag off
+option "defaultroute" - "Create default route" flag off
+option "ipup" - "Script to run after link-up" string no
+option "ipdown" - "Script to run after link-down" string no
+
+option "pinghost" - "Ping remote host" string no
+option "pingrate" - "Number of ping req per second" int default="1" no
+option "pingsize" - "Number of ping data bytes" int default="56" no
+option "pingcount" - "Number of ping req to send" int default="0" no
+option "pingquiet" - "Do not print ping packet info" flag off
diff --git a/sgsnemu/cmdline.h b/sgsnemu/cmdline.h
index bf4e78d..0c03629 100644
--- a/sgsnemu/cmdline.h
+++ b/sgsnemu/cmdline.h
@@ -1,6 +1,6 @@
/* cmdline.h */
-/* File autogenerated by gengetopt version 2.8rc */
+/* File autogenerated by gengetopt version 2.8 */
#ifndef _cmdline_h
#define _cmdline_h
@@ -37,10 +37,9 @@ struct gengetopt_args_info
char * uid_arg; /* Login user ID (default='mig'). */
char * pwd_arg; /* Login password (default='hemmelig'). */
int createif_flag; /* Create local network interface (default=off). */
+ int defaultroute_flag; /* Create default route (default=off). */
char * ipup_arg; /* Script to run after link-up. */
char * ipdown_arg; /* Script to run after link-down. */
- char * net_arg; /* Network (default='0.0.0.0'). */
- char * mask_arg; /* Network mask (default='0.0.0.0'). */
char * pinghost_arg; /* Ping remote host. */
int pingrate_arg; /* Number of ping req per second (default='1'). */
int pingsize_arg; /* Number of ping data bytes (default='56'). */
@@ -66,10 +65,9 @@ struct gengetopt_args_info
int uid_given ; /* Whether uid was given. */
int pwd_given ; /* Whether pwd was given. */
int createif_given ; /* Whether createif was given. */
+ int defaultroute_given ; /* Whether defaultroute was given. */
int ipup_given ; /* Whether ipup was given. */
int ipdown_given ; /* Whether ipdown was given. */
- int net_given ; /* Whether net was given. */
- int mask_given ; /* Whether mask was given. */
int pinghost_given ; /* Whether pinghost was given. */
int pingrate_given ; /* Whether pingrate was given. */
int pingsize_given ; /* Whether pingsize was given. */
diff --git a/sgsnemu/ippool.c b/sgsnemu/ippool.c
new file mode 100644
index 0000000..3ad5c04
--- /dev/null
+++ b/sgsnemu/ippool.c
@@ -0,0 +1,416 @@
+/*
+ * IP address pool functions.
+ * Copyright (C) 2003 Mondru AB.
+ *
+ * The contents of this file may be used under the terms of the GNU
+ * General Public License Version 2, provided that the above copyright
+ * notice and this permission notice is included in all copies or
+ * substantial portions of the software.
+ *
+ * The initial developer of the original code is
+ * Jens Jakobsen <jj@openggsn.org>
+ *
+ * Contributor(s):
+ *
+ */
+
+#include <netinet/in.h> /* in_addr */
+#include <stdlib.h> /* calloc */
+#include <stdio.h> /* sscanf */
+
+#include "ippool.h"
+
+
+/*
+--------------------------------------------------------------------
+Public domain by From Bob Jenkins, December 1996.
+mix -- mix 3 32-bit values reversibly.
+For every delta with one or two bit set, and the deltas of all three
+ high bits or all three low bits, whether the original value of a,b,c
+ is almost all zero or is uniformly distributed,
+* If mix() is run forward or backward, at least 32 bits in a,b,c
+ have at least 1/4 probability of changing.
+* If mix() is run forward, every bit of c will change between 1/3 and
+ 2/3 of the time. (Well, 22/100 and 78/100 for some 2-bit deltas.)
+mix() was built out of 36 single-cycle latency instructions in a
+ structure that could supported 2x parallelism, like so:
+ a -= b;
+ a -= c; x = (c>>13);
+ b -= c; a ^= x;
+ b -= a; x = (a<<8);
+ c -= a; b ^= x;
+ c -= b; x = (b>>13);
+ ...
+ Unfortunately, superscalar Pentiums and Sparcs can't take advantage
+ of that parallelism. They've also turned some of those single-cycle
+ latency instructions into multi-cycle latency instructions. Still,
+ this is the fastest good hash I could find. There were about 2^^68
+ to choose from. I only looked at a billion or so.
+--------------------------------------------------------------------
+*/
+#define mix(a,b,c) \
+{ \
+ a -= b; a -= c; a ^= (c>>13); \
+ b -= c; b -= a; b ^= (a<<8); \
+ c -= a; c -= b; c ^= (b>>13); \
+ a -= b; a -= c; a ^= (c>>12); \
+ b -= c; b -= a; b ^= (a<<16); \
+ c -= a; c -= b; c ^= (b>>5); \
+ a -= b; a -= c; a ^= (c>>3); \
+ b -= c; b -= a; b ^= (a<<10); \
+ c -= a; c -= b; c ^= (b>>15); \
+}
+/*
+--------------------------------------------------------------------
+lookup() -- hash a variable-length key into a 32-bit value
+ k : the key (the unaligned variable-length array of bytes)
+ len : the length of the key, counting by bytes
+ level : can be any 4-byte value
+Returns a 32-bit value. Every bit of the key affects every bit of
+the return value. Every 1-bit and 2-bit delta achieves avalanche.
+About 6len+35 instructions.
+
+The best hash table sizes are powers of 2. There is no need to do
+mod a prime (mod is sooo slow!). If you need less than 32 bits,
+use a bitmask. For example, if you need only 10 bits, do
+ h = (h & hashmask(10));
+In which case, the hash table should have hashsize(10) elements.
+
+If you are hashing n strings (ub1 **)k, do it like this:
+ for (i=0, h=0; i<n; ++i) h = lookup( k[i], len[i], h);
+
+By Bob Jenkins, 1996. bob_jenkins@burtleburtle.net. You may use this
+code any way you wish, private, educational, or commercial.
+
+See http://burtleburtle.net/bob/hash/evahash.html
+Use for hash table lookup, or anything where one collision in 2^32 is
+acceptable. Do NOT use for cryptographic purposes.
+--------------------------------------------------------------------
+*/
+
+unsigned long int lookup( k, length, level)
+register unsigned char *k; /* the key */
+register unsigned long int length; /* the length of the key */
+register unsigned long int level; /* the previous hash, or an arbitrary value */
+{
+ register unsigned long int a,b,c,len;
+
+ /* Set up the internal state */
+ len = length;
+ a = b = 0x9e3779b9; /* the golden ratio; an arbitrary value */
+ c = level; /* the previous hash value */
+
+ /*---------------------------------------- handle most of the key */
+ while (len >= 12)
+ {
+ a += (k[0] +((ub4)k[1]<<8) +((ub4)k[2]<<16) +((ub4)k[3]<<24));
+ b += (k[4] +((ub4)k[5]<<8) +((ub4)k[6]<<16) +((ub4)k[7]<<24));
+ c += (k[8] +((ub4)k[9]<<8) +((ub4)k[10]<<16)+((ub4)k[11]<<24));
+ mix(a,b,c);
+ k += 12; len -= 12;
+ }
+
+ /*------------------------------------- handle the last 11 bytes */
+ c += length;
+ switch(len) /* all the case statements fall through */
+ {
+ case 11: c+=((ub4)k[10]<<24);
+ case 10: c+=((ub4)k[9]<<16);
+ case 9 : c+=((ub4)k[8]<<8);
+ /* the first byte of c is reserved for the length */
+ case 8 : b+=((ub4)k[7]<<24);
+ case 7 : b+=((ub4)k[6]<<16);
+ case 6 : b+=((ub4)k[5]<<8);
+ case 5 : b+=k[4];
+ case 4 : a+=((ub4)k[3]<<24);
+ case 3 : a+=((ub4)k[2]<<16);
+ case 2 : a+=((ub4)k[1]<<8);
+ case 1 : a+=k[0];
+ /* case 0: nothing left to add */
+ }
+ mix(a,b,c);
+ /*-------------------------------------------- report the result */
+ return c;
+}
+
+/*
+End of public domain code by From Bob Jenkins, December 1996.
+--------------------------------------------------------------------
+*/
+
+int ippool_printaddr(struct ippool_t *this) {
+ int n;
+ printf("ippool_printaddr\n");
+ printf("First %d\n", this->first - this->member);
+ printf("Last %d\n", this->last - this->member);
+ printf("Listsize %d\n", this->listsize);
+
+ for (n=0; n<this->listsize; n++) {
+ printf("Unit %d inuse %d prev %d next %d addr %x\n",
+ n,
+ this->member[n].inuse,
+ this->member[n].prev - this->member,
+ this->member[n].next - this->member,
+ this->member[n].addr.s_addr
+ );
+ }
+ return 0;
+}
+
+
+unsigned long int ippool_hash4(struct in_addr *addr) {
+ return lookup(&addr->s_addr, sizeof(addr->s_addr), 0);
+}
+
+#ifndef IPPOOL_NOIP6
+unsigned long int ippool_hash6(struct in6_addr *addr) {
+ return lookup(addr->u6_addr8, sizeof(addr->u6_addr8), 0);
+}
+#endif
+
+
+/* Get IP address and mask */
+int ippool_aton(struct in_addr *addr, struct in_addr *mask,
+ char *pool, int number) {
+
+ /* Parse only first instance of network for now */
+ /* Eventually "number" will indicate the token which we want to parse */
+
+ unsigned int a1, a2, a3, a4;
+ unsigned int m1, m2, m3, m4;
+ int c;
+ unsigned int m;
+ int masklog;
+
+ c = sscanf(pool, "%u.%u.%u.%u/%u.%u.%u.%u",
+ &a1, &a2, &a3, &a4,
+ &m1, &m2, &m3, &m4);
+ switch (c) {
+ case 4:
+ if (a1 == 0 && a2 == 0 && a3 == 0 && a4 == 0) /* Full Internet */
+ mask->s_addr = 0x00000000;
+ else if (a2 == 0 && a3 == 0 && a4 == 0) /* class A */
+ mask->s_addr = htonl(0xff000000);
+ else if (a3 == 0 && a4 == 0) /* class B */
+ mask->s_addr = htonl(0xffff0000);
+ else if (a4 == 0) /* class C */
+ mask->s_addr = htonl(0xffffff00);
+ else
+ mask->s_addr = 0xffffffff;
+ break;
+ case 5:
+ if (m1 < 0 || m1 > 32) {
+ return -1; /* Invalid mask */
+ }
+ mask->s_addr = htonl(0xffffffff << (32 - m1));
+ break;
+ case 8:
+ if (m1 >= 256 || m2 >= 256 || m3 >= 256 || m4 >= 256)
+ return -1; /* Wrong mask format */
+ m = m1 * 0x1000000 + m2 * 0x10000 + m3 * 0x100 + m4;
+ for (masklog = 0; ((1 << masklog) < ((~m)+1)); masklog++);
+ if (((~m)+1) != (1 << masklog))
+ return -1; /* Wrong mask format (not all ones followed by all zeros)*/
+ mask->s_addr = htonl(m);
+ break;
+ default:
+ return -1; /* Invalid mask */
+ }
+
+ if (a1 >= 256 || a2 >= 256 || a3 >= 256 || a4 >= 256)
+ return -1; /* Wrong IP address format */
+ else
+ addr->s_addr = htonl(a1 * 0x1000000 + a2 * 0x10000 + a3 * 0x100 + a4);
+
+ return 0;
+}
+
+/* Create new address pool */
+int ippool_new(struct ippool_t **this, char *pool, int flags) {
+
+ /* Parse only first instance of network for now */
+
+ int i;
+ struct ippoolm_t *p;
+ struct ippoolm_t *p_prev = NULL;
+ uint32_t hash;
+ struct in_addr addr;
+ struct in_addr mask;
+ unsigned int m;
+ unsigned int listsize;
+
+ if (ippool_aton(&addr, &mask, pool, 0))
+ return 0; /* Failed to parse pool */
+
+ m = ntohl(mask.s_addr);
+ listsize = ((~m)+1);
+ if (flags & IPPOOL_NONETWORK) /* Exclude network address from pool */
+ listsize--;
+ if (flags & IPPOOL_NOBROADCAST) /* Exclude broadcast address from pool */
+ listsize--;
+
+ if (!(*this = calloc(sizeof(struct ippool_t), 1))) {
+ /* Failed to allocate memory for ippool */
+ return -1;
+ }
+
+ (*this)->listsize += listsize;
+ if (!((*this)->member = calloc(sizeof(struct ippoolm_t), (*this)->listsize))){
+ /* Failed to allocate memory for members in ippool */
+ return -1;
+ }
+
+ for ((*this)->hashlog = 0;
+ ((1 << (*this)->hashlog) < listsize);
+ (*this)->hashlog++);
+
+ /* printf ("Hashlog %d %d %d\n", (*this)->hashlog, listsize, (1 << (*this)->hashlog)); */
+
+ /* Determine hashsize */
+ (*this)->hashsize = 1 << (*this)->hashlog; /* Fails if mask=0: All Internet*/
+ (*this)->hashmask = (*this)->hashsize -1;
+
+ /* Allocate hash table */
+ if (!((*this)->hash = calloc(sizeof(struct ippoolm_t), (*this)->hashsize))){
+ /* Failed to allocate memory for hash members in ippool */
+ return -1;
+ }
+
+ (*this)->first = NULL;
+ (*this)->last = NULL;
+ for (i = 0; i<(*this)->listsize; i++) {
+
+ if (flags & IPPOOL_NONETWORK)
+ (*this)->member[i].addr.s_addr = htonl(ntohl(addr.s_addr) + i + 1);
+ else
+ (*this)->member[i].addr.s_addr = htonl(ntohl(addr.s_addr) + i);
+
+ (*this)->member[i].inuse = 0;
+ (*this)->member[i].parent = *this;
+
+ /* Insert into list of unused */
+ (*this)->member[i].prev = (*this)->last;
+ if ((*this)->last) {
+ (*this)->last->next = &((*this)->member[i]);
+ }
+ else {
+ (*this)->first = &((*this)->member[i]);
+ }
+ (*this)->last = &((*this)->member[i]);
+ (*this)->member[i].next = NULL; /* Redundant */
+
+ /* Insert into hash table */
+ hash = ippool_hash4(&(*this)->member[i].addr) & (*this)->hashmask;
+ for (p = (*this)->hash[hash]; p; p = p->nexthash)
+ p_prev = p;
+ if (!p_prev)
+ (*this)->hash[hash] = &((*this)->member[i]);
+ else
+ p_prev->nexthash = &((*this)->member[i]);
+ }
+ /*ippool_printaddr(*this);*/
+ return 0;
+}
+
+/* Delete existing address pool */
+int ippool_free(struct ippool_t *this) {
+ free(this->hash);
+ free(this->member);
+ free(this);
+ return 0; /* Always OK */
+}
+
+/* Find an IP address in the pool */
+int ippool_getip(struct ippool_t *this, struct ippoolm_t **member,
+ struct in_addr *addr) {
+ struct ippoolm_t *p;
+ uint32_t hash;
+
+ /* Find in hash table */
+ hash = ippool_hash4(addr) & this->hashmask;
+ for (p = this->hash[hash]; p; p = p->nexthash) {
+ if ((p->addr.s_addr == addr->s_addr) && (p->inuse)) {
+ *member = p;
+ return 0;
+ }
+ }
+ *member = NULL;
+ return -1; /* Address could not be found */
+}
+
+
+/* Get an IP address. If addr = 0.0.0.0 get a dynamic IP address. Otherwise
+ check to see if the given address is available */
+int ippool_newip(struct ippool_t *this, struct ippoolm_t **member,
+ struct in_addr *addr) {
+ struct ippoolm_t *p;
+ struct ippoolm_t *p2 = NULL;
+ uint32_t hash;
+
+ /*ippool_printaddr(this);*/
+
+ if ((addr) && (addr->s_addr)) { /* IP address given */
+ /* Find in hash table */
+ hash = ippool_hash4(addr) & this->hashmask;
+ for (p = this->hash[hash]; p; p = p->nexthash) {
+ if ((p->addr.s_addr == addr->s_addr)) {
+ p2 = p;
+ break;
+ }
+ }
+ }
+ else { /* No ip address given */
+ p2 = this -> first;
+ }
+
+ if (!p2) return -1; /* Not found */
+ if (p2->inuse) return -1; /* Allready in use / Should not happen */
+
+ /* Found new address. Remove from queue */
+ if (p2->prev)
+ p2->prev->next = p2->next;
+ else
+ this->first = p2->next;
+ if (p2->next)
+ p2->next->prev = p2->prev;
+ else
+ this->last = p2->prev;
+ p2->next = NULL;
+ p2->prev = NULL;
+ p2->inuse = 1;
+
+ *member = p2;
+ /*ippool_printaddr(this);*/
+ return 0; /* Success */
+}
+
+
+int ippool_freeip(struct ippoolm_t *member) {
+ struct ippool_t *this = member->parent;
+
+ /*ippool_printaddr(this);*/
+
+ if (!member->inuse) return -1; /* Not in use: Should not happen */
+
+ /* Insert into list of unused */
+ member->prev = this->last;
+ if (this->last) {
+ this->last->next = member;
+ }
+ else {
+ this->first = member;
+ }
+ this->last = member;
+
+ member->inuse = 0;
+ /*ippool_printaddr(this);*/
+
+ return 0; /* Success */
+}
+
+
+#ifndef IPPOOL_NOIP6
+extern unsigned long int ippool_hash6(struct in6_addr *addr);
+extern int ippool_getip6(struct ippool_t *this, struct in6_addr *addr);
+extern int ippool_returnip6(struct ippool_t *this, struct in6_addr *addr);
+#endif
diff --git a/sgsnemu/ippool.h b/sgsnemu/ippool.h
new file mode 100644
index 0000000..2d3f575
--- /dev/null
+++ b/sgsnemu/ippool.h
@@ -0,0 +1,105 @@
+/*
+ * IP address pool functions.
+ * Copyright (C) 2003 Mondru AB.
+ *
+ * The contents of this file may be used under the terms of the GNU
+ * General Public License Version 2, provided that the above copyright
+ * notice and this permission notice is included in all copies or
+ * substantial portions of the software.
+ *
+ * The initial developer of the original code is
+ * Jens Jakobsen <jj@openggsn.org>
+ *
+ * Contributor(s):
+ *
+ */
+
+#ifndef _IPPOOL_H
+#define _IPPOOL_H
+
+/* Assuming that the address space is fragmented we need a hash table
+ in order to return the addresses.
+
+ The list pool should provide for both IPv4 and IPv6 addresses.
+
+ When initialising a new address pool it should be possible to pass
+ a string of CIDR format networks: "10.0.0.0/24 10.15.0.0/20" would
+ translate to 256 addresses starting at 10.0.0.0 and 1024 addresses
+ starting at 10.15.0.0.
+
+ The above also applies to IPv6 which can be specified as described
+ in RFC2373.
+*/
+
+typedef unsigned long int ub4; /* unsigned 4-byte quantities */
+typedef unsigned char ub1;
+
+#define IPPOOL_NOIP6
+
+#define IPPOOL_NONETWORK 0x01
+#define IPPOOL_NOBROADCAST 0x02
+
+struct ippoolm_t; /* Forward declaration */
+
+struct ippool_t {
+ int listsize; /* Total number of addresses */
+ struct ippoolm_t *member; /* Listsize array of members */
+ int hashsize; /* Size of hash table */
+ int hashlog; /* Log2 size of hash table */
+ int hashmask; /* Bitmask for calculating hash */
+ struct ippoolm_t **hash; /* Hashsize array of pointer to member */
+ struct ippoolm_t *first; /* Pointer to first available member */
+ struct ippoolm_t *last; /* Pointer to last available member */
+};
+
+struct ippoolm_t {
+#ifndef IPPOOL_NOIP6
+ struct in6_addr addr; /* IP address of this member */
+#else
+ struct in_addr addr; /* IP address of this member */
+#endif
+ int inuse; /* 0=available; 1= inuse */
+ struct ippoolm_t *nexthash; /* Linked list part of hash table */
+ struct ippoolm_t *prev, *next; /* Double linked list of available members */
+ struct ippool_t *parent; /* Pointer to parent */
+ void *peer; /* Pointer to peer protocol handler */
+};
+
+
+/* The above structures requires approximately 20+4 = 24 bytes for
+ each address (IPv4). For IPv6 the corresponding value is 32+4 = 36
+ bytes for each address. */
+
+/* Hash an IP address using code based on Bob Jenkins lookupa */
+extern unsigned long int ippool_hash4(struct in_addr *addr);
+
+/* Create new address pool */
+extern int ippool_new(struct ippool_t **this, char *pool, int flags);
+
+/* Delete existing address pool */
+extern int ippool_free(struct ippool_t *this);
+
+/* Find an IP address in the pool */
+extern int ippool_getip(struct ippool_t *this, struct ippoolm_t **member,
+ struct in_addr *addr);
+
+/* Get an IP address. If addr = 0.0.0.0 get a dynamic IP address. Otherwise
+ check to see if the given address is available */
+extern int ippool_newip(struct ippool_t *this, struct ippoolm_t **member,
+ struct in_addr *addr);
+
+/* Return a previously allocated IP address */
+extern int ippool_freeip(struct ippoolm_t *member);
+
+/* Get net and mask based on ascii string */
+extern int ippool_aton(struct in_addr *addr, struct in_addr *mask,
+ char *pool, int number);
+
+
+#ifndef IPPOOL_NOIP6
+extern unsigned long int ippool_hash6(struct in6_addr *addr);
+extern int ippool_getip6(struct ippool_t *this, struct in6_addr *addr);
+extern int ippool_returnip6(struct ippool_t *this, struct in6_addr *addr);
+#endif
+
+#endif /* !_IPPOOL_H */
diff --git a/sgsnemu/sgsnemu.c b/sgsnemu/sgsnemu.c
index 1cdfcac..99f0366 100644
--- a/sgsnemu/sgsnemu.c
+++ b/sgsnemu/sgsnemu.c
@@ -1,6 +1,6 @@
/*
* OpenGGSN - Gateway GPRS Support Node
- * Copyright (C) 2002 Mondru AB.
+ * Copyright (C) 2002, 2003 Mondru AB.
*
* The contents of this file may be used under the terms of the GNU
* General Public License Version 2, provided that the above copyright
@@ -21,7 +21,7 @@
#ifdef __linux__
-#define _GNU_SOURCE 1 /* strdup() prototype, broken arpa/inet.h */
+#define _GNU_SOURCE 1 /* strdup() prototype, broken arpa/inet.h */
#endif
@@ -52,38 +52,59 @@
#include <time.h>
#include "tun.h"
+#include "ippool.h"
+#include "syserr.h"
#include "../gtp/pdp.h"
#include "../gtp/gtp.h"
#include "cmdline.h"
-#define SGSNEMU_BUFSIZE 1024
+#define IPADDRLEN 256 /* Character length of addresses */
+#define MAXCONTEXTS 16 /* Max number of allowed contexts */
-/* State variable */
-/* 0: Idle */
-/* 1: Wait_connect */
-/* 2: Connected */
-/* 3: Wait_disconnect */
+/* HASH tables for IP address allocation */
+struct iphash_t {
+ uint8_t inuse; /* 0=free. 1=used by somebody */
+ struct iphash_t *ipnext;
+ struct pdp_t *pdp;
+ struct in_addr addr;
+};
+struct iphash_t iparr[MAXCONTEXTS];
+struct iphash_t *iphash[MAXCONTEXTS];
+
+/* State variable used for ping */
+/* 0: Idle */
+/* 1: Wait_connect */
+/* 2: Connected */
+/* 3: Wait_disconnect */
int state = 0;
+struct gsn_t *gsn = NULL; /* GSN instance */
+struct tun_t *tun = NULL; /* TUN instance */
int maxfd = 0; /* For select() */
-int tun_fd = -1; /* Network file descriptor */
-struct tun_t *tun; /* TUN instance */
-struct tun_t *tun1, *tun2; /* TUN instance for client */
-int tun_fd1 = -1; /* Network file descriptor */
-int tun_fd2 = -1; /* Network file descriptor */
-
-/* Variables matching program configuration parameters */
-int debug; /* Print debug messages */
-struct in_addr net, mask; /* Network interface */
-int createif; /* Create local network interface */
-char *ipup, *ipdown; /* Filename of scripts */
-/* int defaultroute; Set up default route */
-struct in_addr pinghost; /* Remote ping host */
-int pingrate, pingsize, pingcount, pingquiet;
-struct in_addr listen_, remote;
-struct in_addr dns;
-int contexts; /* Number of contexts to create */
-int timelimit; /* Number of seconds to be connected */
+
+/* Struct with local versions of gengetopt options */
+struct {
+ int debug; /* Print debug messages */
+ int createif; /* Create local network interface */
+ char *ipup, *ipdown; /* Filename of scripts */
+ int defaultroute; /* Set up default route */
+ struct in_addr pinghost; /* Remote ping host */
+ int pingrate;
+ int pingsize;
+ int pingcount;
+ int pingquiet;
+ struct in_addr listen;
+ struct in_addr remote;
+ struct in_addr dns;
+ int contexts; /* Number of contexts to create */
+ int timelimit; /* Number of seconds to be connected */
+ char *statedir;
+ uint64_t imsi;
+ struct ul255_t pco;
+ struct ul255_t qos;
+ struct ul255_t apn;
+ struct ul16_t msisdn;
+} options;
/* Definitions to use for PING. Most of the ping code was derived from */
@@ -123,6 +144,359 @@ int tsum = 0;
int pingseq = 0; /* Ping sequence counter */
struct timeval firstping;
+int ipset(struct iphash_t *ipaddr, struct in_addr *addr) {
+ int hash = ippool_hash4(addr) % MAXCONTEXTS;
+ struct iphash_t *h;
+ struct iphash_t *prev = NULL;
+ ipaddr->ipnext = NULL;
+ ipaddr->addr.s_addr = addr->s_addr;
+ for (h = iphash[hash]; h; h = h->ipnext)
+ prev = h;
+ if (!prev)
+ iphash[hash] = ipaddr;
+ else
+ prev->ipnext = ipaddr;
+ return 0;
+}
+
+int ipdel(struct iphash_t *ipaddr) {
+ int hash = ippool_hash4(&ipaddr->addr) % MAXCONTEXTS;
+ struct iphash_t *h;
+ struct iphash_t *prev = NULL;
+ for (h = iphash[hash]; h; h = h->ipnext) {
+ if (h == ipaddr) {
+ if (!prev)
+ iphash[hash] = h->ipnext;
+ else
+ prev->ipnext = h->ipnext;
+ return 0;
+ }
+ prev = h;
+ }
+ return EOF; /* End of linked list and not found */
+}
+
+int ipget(struct iphash_t **ipaddr, struct in_addr *addr) {
+ int hash = ippool_hash4(addr) % MAXCONTEXTS;
+ struct iphash_t *h;
+ for (h = iphash[hash]; h; h = h->ipnext) {
+ if ((h->addr.s_addr == addr->s_addr)) {
+ *ipaddr = h;
+ return 0;
+ }
+ }
+ return EOF; /* End of linked list and not found */
+}
+
+
+/* Used to write process ID to file. Assume someone else will delete */
+void log_pid(char *pidfile) {
+ FILE *file;
+ mode_t oldmask;
+
+ oldmask = umask(022);
+ file = fopen(pidfile, "w");
+ umask(oldmask);
+ if(!file)
+ return;
+ fprintf(file, "%d\n", getpid());
+ fclose(file);
+}
+
+
+int process_options(int argc, char **argv) {
+ /* gengeopt declarations */
+ struct gengetopt_args_info args_info;
+
+ struct hostent *host;
+ int n;
+
+ if (cmdline_parser (argc, argv, &args_info) != 0)
+ return -1;
+ if (args_info.debug_flag) {
+ printf("remote: %s\n", args_info.remote_arg);
+ printf("listen: %s\n", args_info.listen_arg);
+ printf("conf: %s\n", args_info.conf_arg);
+ printf("fg: %d\n", args_info.fg_flag);
+ printf("debug: %d\n", args_info.debug_flag);
+ printf("imsi: %s\n", args_info.imsi_arg);
+ printf("qos: %#08x\n", args_info.qos_arg);
+ printf("apn: %s\n", args_info.apn_arg);
+ printf("msisdn: %s\n", args_info.msisdn_arg);
+ printf("uid: %s\n", args_info.uid_arg);
+ printf("pwd: %s\n", args_info.pwd_arg);
+ printf("pidfile: %s\n", args_info.pidfile_arg);
+ printf("statedir: %s\n", args_info.statedir_arg);
+ printf("dns: %s\n", args_info.dns_arg);
+ printf("contexts: %d\n", args_info.contexts_arg);
+ printf("timelimit: %d\n", args_info.timelimit_arg);
+ printf("createif: %d\n", args_info.createif_flag);
+ printf("ipup: %s\n", args_info.ipup_arg);
+ printf("ipdown: %s\n", args_info.ipdown_arg);
+ printf("defaultroute: %d\n", args_info.defaultroute_flag);
+ printf("pinghost: %s\n", args_info.pinghost_arg);
+ printf("pingrate: %d\n", args_info.pingrate_arg);
+ printf("pingsize: %d\n", args_info.pingsize_arg);
+ printf("pingcount: %d\n", args_info.pingcount_arg);
+ printf("pingquiet: %d\n", args_info.pingquiet_flag);
+ }
+
+ /* Try out our new parser */
+
+ if (args_info.conf_arg) {
+ if (cmdline_parser_configfile (args_info.conf_arg, &args_info, 0) != 0)
+ return -1;
+ if (args_info.debug_flag) {
+ printf("cmdline_parser_configfile\n");
+ printf("remote: %s\n", args_info.remote_arg);
+ printf("listen: %s\n", args_info.listen_arg);
+ printf("conf: %s\n", args_info.conf_arg);
+ printf("fg: %d\n", args_info.fg_flag);
+ printf("debug: %d\n", args_info.debug_flag);
+ printf("imsi: %s\n", args_info.imsi_arg);
+ printf("qos: %#08x\n", args_info.qos_arg);
+ printf("apn: %s\n", args_info.apn_arg);
+ printf("msisdn: %s\n", args_info.msisdn_arg);
+ printf("uid: %s\n", args_info.uid_arg);
+ printf("pwd: %s\n", args_info.pwd_arg);
+ printf("pidfile: %s\n", args_info.pidfile_arg);
+ printf("statedir: %s\n", args_info.statedir_arg);
+ printf("dns: %s\n", args_info.dns_arg);
+ printf("contexts: %d\n", args_info.contexts_arg);
+ printf("timelimit: %d\n", args_info.timelimit_arg);
+ printf("createif: %d\n", args_info.createif_flag);
+ printf("ipup: %s\n", args_info.ipup_arg);
+ printf("ipdown: %s\n", args_info.ipdown_arg);
+ printf("defaultroute: %d\n", args_info.defaultroute_flag);
+ printf("pinghost: %s\n", args_info.pinghost_arg);
+ printf("pingrate: %d\n", args_info.pingrate_arg);
+ printf("pingsize: %d\n", args_info.pingsize_arg);
+ printf("pingcount: %d\n", args_info.pingcount_arg);
+ printf("pingquiet: %d\n", args_info.pingquiet_flag);
+ }
+ }
+
+ /* Handle each option */
+
+ /* foreground */
+ /* If fg flag not given run as a daemon */
+ if (!args_info.fg_flag)
+ {
+ closelog();
+ /* Close the standard file descriptors. Why? */
+ freopen("/dev/null", "w", stdout);
+ freopen("/dev/null", "w", stderr);
+ freopen("/dev/null", "r", stdin);
+ daemon(0, 0);
+ /* Open log again. This time with new pid */
+ openlog(PACKAGE, LOG_PID, LOG_DAEMON);
+ }
+
+ /* debug */
+ options.debug = args_info.debug_flag;
+
+ /* pidfile */
+ /* This has to be done after we have our final pid */
+ if (args_info.pidfile_arg) {
+ log_pid(args_info.pidfile_arg);
+ }
+
+ /* dns */
+ /* If no dns option is given use system default */
+ /* Do hostname lookup to translate hostname to IP address */
+ printf("\n");
+ if (args_info.dns_arg) {
+ if (!(host = gethostbyname(args_info.dns_arg))) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, 0,
+ "Invalid DNS address: %s!", args_info.dns_arg);
+ return -1;
+ }
+ else {
+ memcpy(&options.dns.s_addr, host->h_addr, host->h_length);
+ _res.nscount = 1;
+ _res.nsaddr_list[0].sin_addr = options.dns;
+ printf("Using DNS server: %s (%s)\n",
+ args_info.dns_arg, inet_ntoa(options.dns));
+ }
+ }
+ else {
+ options.dns.s_addr= 0;
+ printf("Using default DNS server\n");
+ }
+
+ /* listen */
+ /* If no listen option is specified listen to any local port */
+ /* Do hostname lookup to translate hostname to IP address */
+ if (args_info.listen_arg) {
+ if (!(host = gethostbyname(args_info.listen_arg))) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, 0,
+ "Invalid listening address: %s!", args_info.listen_arg);
+ return -1;
+ }
+ else {
+ memcpy(&options.listen.s_addr, host->h_addr, host->h_length);
+ printf("Local IP address is: %s (%s)\n",
+ args_info.listen_arg, inet_ntoa(options.listen));
+ }
+ }
+ else {
+ sys_err(LOG_ERR, __FILE__, __LINE__, 0,
+ "Listening address must be specified: %s!", args_info.listen_arg);
+ return -1;
+ }
+
+
+ /* remote */
+ /* If no remote option is specified terminate */
+ /* Do hostname lookup to translate hostname to IP address */
+ if (args_info.remote_arg) {
+ if (!(host = gethostbyname(args_info.remote_arg))) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, 0,
+ "Invalid remote address: %s!", args_info.remote_arg);
+ return -1;
+ }
+ else {
+ memcpy(&options.remote.s_addr, host->h_addr, host->h_length);
+ printf("Remote IP address is: %s (%s)\n",
+ args_info.remote_arg, inet_ntoa(options.remote));
+ }
+ }
+ else {
+ sys_err(LOG_ERR, __FILE__, __LINE__, 0,
+ "No remote address given!");
+ return -1;
+ }
+
+
+ /* imsi */
+ if (strlen(args_info.imsi_arg)!=15) {
+ printf("Invalid IMSI\n");
+ return -1;
+ }
+ options.imsi = ((uint64_t) (args_info.imsi_arg[ 0]-48));
+ options.imsi |= ((uint64_t) (args_info.imsi_arg[ 1]-48)) << 4;
+ options.imsi |= ((uint64_t) (args_info.imsi_arg[ 2]-48)) << 8;
+ options.imsi |= ((uint64_t) (args_info.imsi_arg[ 3]-48)) << 12;
+ options.imsi |= ((uint64_t) (args_info.imsi_arg[ 4]-48)) << 16;
+ options.imsi |= ((uint64_t) (args_info.imsi_arg[ 5]-48)) << 20;
+ options.imsi |= ((uint64_t) (args_info.imsi_arg[ 6]-48)) << 24;
+ options.imsi |= ((uint64_t) (args_info.imsi_arg[ 7]-48)) << 28;
+ options.imsi |= ((uint64_t) (args_info.imsi_arg[ 8]-48)) << 32;
+ options.imsi |= ((uint64_t) (args_info.imsi_arg[ 9]-48)) << 36;
+ options.imsi |= ((uint64_t) (args_info.imsi_arg[10]-48)) << 40;
+ options.imsi |= ((uint64_t) (args_info.imsi_arg[11]-48)) << 44;
+ options.imsi |= ((uint64_t) (args_info.imsi_arg[12]-48)) << 48;
+ options.imsi |= ((uint64_t) (args_info.imsi_arg[13]-48)) << 52;
+ options.imsi |= ((uint64_t) (args_info.imsi_arg[14]-48)) << 56;
+
+ printf("IMSI is: %s (%#08llx)\n",
+ args_info.imsi_arg, options.imsi);
+
+
+ /* qos */
+ options.qos.l = 3;
+ options.qos.v[2] = (args_info.qos_arg) & 0xff;
+ options.qos.v[1] = ((args_info.qos_arg) >> 8) & 0xff;
+ options.qos.v[0] = ((args_info.qos_arg) >> 16) & 0xff;
+
+ /* contexts */
+ if (args_info.contexts_arg > MAXCONTEXTS) {
+ printf("Contexts has to be less than %d\n", MAXCONTEXTS);
+ return -1;
+ }
+ options.contexts = args_info.contexts_arg;
+
+ /* Timelimit */
+ options.timelimit = args_info.timelimit_arg;
+
+ /* apn */
+ if (strlen(args_info.apn_arg) > (sizeof(options.apn.v)-1)) {
+ printf("Invalid APN\n");
+ return -1;
+ }
+ options.apn.l = strlen(args_info.apn_arg) + 1;
+ options.apn.v[0] = (char) strlen(args_info.apn_arg);
+ strncpy(&options.apn.v[1], args_info.apn_arg, sizeof(options.apn.v)-1);
+ printf("Using APN: %s\n", args_info.apn_arg);
+
+ /* msisdn */
+ if (strlen(args_info.msisdn_arg)>(sizeof(options.msisdn.v)-1)) {
+ printf("Invalid MSISDN\n");
+ return -1;
+ }
+ options.msisdn.l = 1;
+ options.msisdn.v[0] = 0x91; /* International format */
+ for(n=0; n<strlen(args_info.msisdn_arg); n++) {
+ if ((n%2) == 0) {
+ options.msisdn.v[((int)n/2)+1] = args_info.msisdn_arg[n] - 48 + 0xf0;
+ options.msisdn.l += 1;
+ }
+ else {
+ options.msisdn.v[((int)n/2)+1] =
+ (options.msisdn.v[((int)n/2)+1] & 0x0f) +
+ (args_info.msisdn_arg[n] - 48) * 16;
+ }
+ }
+ printf("Using MSISDN: %s\n", args_info.msisdn_arg);
+
+ /* UID and PWD */
+ /* Might need to also insert stuff like DNS etc. */
+ if ((strlen(args_info.uid_arg) + strlen(args_info.pwd_arg) + 10)>
+ (sizeof(options.pco.v)-1)) {
+ printf("invalid UID and PWD\n");
+ return -1;
+ }
+ options.pco.l = strlen(args_info.uid_arg) + strlen(args_info.pwd_arg) + 10;
+ options.pco.v[0] = 0x80; /* PPP */
+ options.pco.v[1] = 0xc0; /* PAP */
+ options.pco.v[2] = 0x23;
+ options.pco.v[3] = 0x12; /* Length of protocol contents */
+ options.pco.v[4] = 0x01; /* Authenticate request */
+ options.pco.v[5] = 0x01;
+ options.pco.v[6] = 0x00; /* MSB of length */
+ options.pco.v[7] = strlen(args_info.uid_arg) + strlen(args_info.pwd_arg) + 6;
+ options.pco.v[8] = strlen(args_info.uid_arg);
+ memcpy(&options.pco.v[9], args_info.uid_arg, strlen(args_info.uid_arg));
+ options.pco.v[9+strlen(args_info.uid_arg)] = strlen(args_info.pwd_arg);
+ memcpy(&options.pco.v[10+strlen(args_info.uid_arg)],
+ args_info.pwd_arg, strlen(args_info.pwd_arg));
+
+ /* createif */
+ options.createif = args_info.createif_flag;
+
+ /* ipup */
+ options.ipup = args_info.ipup_arg;
+
+ /* ipdown */
+ options.ipdown = args_info.ipdown_arg;
+
+ /* statedir */
+ options.statedir = args_info.statedir_arg;
+
+ /* defaultroute */
+ options.defaultroute = args_info.defaultroute_flag;
+
+
+ /* pinghost */
+ /* Store ping host as in_addr */
+ if (args_info.pinghost_arg) {
+ if (!inet_aton(args_info.pinghost_arg, &options.pinghost)) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, 0,
+ "Invalid ping host: %s!", args_info.pinghost_arg);
+ return -1;
+ }
+ }
+
+ /* Other ping parameters */
+ options.pingrate = args_info.pingrate_arg;
+ options.pingsize = args_info.pingsize_arg;
+ options.pingcount = args_info.pingcount_arg;
+ options.pingquiet = args_info.pingquiet_flag;
+
+ return 0;
+
+}
+
int encaps_printf(struct pdp_t *pdp, void *pack, unsigned len) {
int i;
@@ -175,18 +549,20 @@ int ping_timeout(struct timeval *tp) {
struct timezone tz;
struct timeval tv;
int diff;
- if ((pinghost.s_addr) && (2 == state) &&
- ((pingseq < pingcount) || (pingcount == 0))) {
+ if ((options.pinghost.s_addr) && (2 == state) &&
+ ((pingseq < options.pingcount) || (options.pingcount == 0))) {
gettimeofday(&tv, &tz);
- diff = 1000000 / pingrate * pingseq -
+ diff = 1000000 / options.pingrate * pingseq -
1000000 * (tv.tv_sec - firstping.tv_sec) -
(tv.tv_usec - firstping.tv_usec); /* Microseconds safe up to 500 sec */
tp->tv_sec = 0;
if (diff > 0)
tp->tv_usec = diff;
- else
+ else {
/* For some reason we get packet loss if set to zero */
- tp->tv_usec = 100000 / pingrate; /* 10 times pingrate */
+ tp->tv_usec = 100000 / options.pingrate; /* 10 times pingrate */
+ tp->tv_usec = 0;
+ }
}
return 0;
}
@@ -201,7 +577,7 @@ int ping_finish()
elapsed = 1000000 * (tv.tv_sec - firstping.tv_sec) +
(tv.tv_usec - firstping.tv_usec); /* Microseconds */
printf("\n");
- printf("\n----%s PING Statistics----\n", inet_ntoa(pinghost));
+ printf("\n----%s PING Statistics----\n", inet_ntoa(options.pinghost));
printf("%d packets transmitted in %.3f seconds, ", ntransmitted,
elapsed / 1000000.0);
printf("%d packets received, ", nreceived );
@@ -214,7 +590,7 @@ int ping_finish()
ntransmitted));
}
printf("\n");
- if (debug) printf("%d packets received in total\n", ntreceived );
+ if (options.debug) printf("%d packets received in total\n", ntreceived );
if (nreceived && tsum)
printf("round-trip (ms) min/avg/max = %.3f/%.3f/%.3f\n\n",
tmin/1000.0,
@@ -238,7 +614,7 @@ int encaps_ping(struct pdp_t *pdp, void *pack, unsigned len) {
src.s_addr = pingpack->src;
gettimeofday(&tv, &tz);
- if (debug) printf("%d.%6d ", (int) tv.tv_sec, (int) tv.tv_usec);
+ if (options.debug) printf("%d.%6d ", (int) tv.tv_sec, (int) tv.tv_usec);
if (len < CREATEPING_IP + CREATEPING_ICMP) {
printf("packet too short (%d bytes) from %s\n", len,
@@ -248,21 +624,21 @@ int encaps_ping(struct pdp_t *pdp, void *pack, unsigned len) {
ntreceived++;
if (pingpack->protocol != 1) {
- if (!pingquiet) printf("%d bytes from %s: ip_protocol=%d (%s)\n",
+ if (!options.pingquiet) printf("%d bytes from %s: ip_protocol=%d (%s)\n",
len, inet_ntoa(src), pingpack->protocol,
print_ipprot(pingpack->protocol));
return 0;
}
if (pingpack->type != 0) {
- if (!pingquiet) printf("%d bytes from %s: icmp_type=%d (%s) icmp_code=%d\n",
+ if (!options.pingquiet) printf("%d bytes from %s: icmp_type=%d (%s) icmp_code=%d\n",
len, inet_ntoa(src), pingpack->type,
print_icmptype(pingpack->type), pingpack->code);
return 0;
}
nreceived++;
- if (!pingquiet) printf("%d bytes from %s: icmp_seq=%d", len,
+ if (!options.pingquiet) printf("%d bytes from %s: icmp_seq=%d", len,
inet_ntoa(src), ntohs(pingpack->seq));
if (len >= sizeof(struct timeval) + CREATEPING_IP + CREATEPING_ICMP) {
@@ -281,11 +657,11 @@ int encaps_ping(struct pdp_t *pdp, void *pack, unsigned len) {
if( triptime > tmax )
tmax = triptime;
- if (!pingquiet) printf(" time=%.3f ms\n", triptime/1000.0);
+ if (!options.pingquiet) printf(" time=%.3f ms\n", triptime/1000.0);
}
else
- if (!pingquiet) printf("\n");
+ if (!options.pingquiet) printf("\n");
return 0;
}
@@ -305,11 +681,9 @@ int create_ping(void *gsn, struct pdp_t *pdp,
struct timeval *tp = (struct timeval *) &p8[CREATEPING_IP + CREATEPING_ICMP];
if (datasize > CREATEPING_MAX) {
- fprintf(stderr, "%s: Ping size to large: %d!\n",
- PACKAGE, datasize);
- syslog(LOG_ERR, "Ping size to large: %d!",
- datasize);
- exit(1);
+ sys_err(LOG_ERR, __FILE__, __LINE__, 0,
+ "Ping size to large: %d!", datasize);
+ return -1;
}
memcpy(&src, &(pdp->eua.v[2]), 4); /* Copy a 4 byte address */
@@ -366,130 +740,72 @@ int create_ping(void *gsn, struct pdp_t *pdp,
pack.checksum = ~sum;
ntransmitted++;
-
return gtp_gpdu(gsn, pdp, &pack, 28 + datasize);
}
-/* Used to write process ID to file. Assume someone else will delete */
-void log_pid(char *pidfile) {
- FILE *file;
- mode_t oldmask;
-
- oldmask = umask(022);
- file = fopen(pidfile, "w");
- umask(oldmask);
- if(!file)
- return;
- fprintf(file, "%d\n", getpid());
- fclose(file);
+int delete_context(struct pdp_t *pdp) {
+
+ if (tun && options.ipdown) tun_runscript(tun, options.ipdown);
+
+ ipdel((struct iphash_t*) pdp->peer);
+ memset(pdp->peer, 0, sizeof(struct iphash_t)); /* To be sure */
+ return 0;
}
-int delete_context(struct pdp_t *pdp) {
- char buf[SGSNEMU_BUFSIZE];
- if ((createif) && (pdp->ipif!=0)) {
- tun_freetun((struct tun_t*) pdp->ipif);
-
- /* Clean up locally */
- if (pdp->ipif == tun1) {
- printf("Deleting tun interface\n");
- tun_fd1=-1;
- }
- if (pdp->ipif == tun2) {
- printf("Deleting tun interface\n");
- tun_fd2=-1;
- }
+
+/* Callback for receiving messages from tun */
+int cb_tun_ind(struct tun_t *tun, void *pack, unsigned len) {
+ struct iphash_t *ipm;
+ struct in_addr src;
+ struct tun_packet_t *iph = (struct tun_packet_t*) pack;
+
+ src.s_addr = iph->src;
+
+ if (ipget(&ipm, &src)) {
+ printf("Received packet without a valid source address!!!\n");
+ return 0;
}
- if (ipdown) {
- /* system("ipdown /dev/tun0 192.168.0.10"); */
- snprintf(buf, sizeof(buf), "%s %s %hu.%hu.%hu.%hu",
- ipdown,
- ((struct tun_t*) pdp->ipif)->devname,
- pdp->eua.v[2], pdp->eua.v[3], pdp->eua.v[4], pdp->eua.v[5]);
- if (debug) printf("%s\n", buf);
- system(buf);
- }
-
- pdp_ipdel(pdp);
+ if (ipm->pdp) /* Check if a peer protocol is defined */
+ gtp_gpdu(gsn, ipm->pdp, pack, len);
return 0;
}
int create_pdp_conf(struct pdp_t *pdp, int cause) {
- char buf[SGSNEMU_BUFSIZE];
- char snet[SGSNEMU_BUFSIZE];
- char smask[SGSNEMU_BUFSIZE];
-
- printf("Received create PDP context response. Cause value: %d\n", cause);
- if ((cause == 128) && (pdp->eua.l == 6)) {
-
- if (!createif) {
- pdp->ipif = tun1;
- }
- else {
- printf("Setting up interface and routing\n");
- if ((tun_fd = tun_newtun((struct tun_t**) &pdp->ipif)) > maxfd)
- maxfd = tun_fd;
-
- /* HACK: Only support select of up to two tun interfaces */
- if (NULL == tun1) {
- tun1 = pdp->ipif;
- tun_fd1 = tun1->fd;
- }
- else {
- tun2 = pdp->ipif;
- tun_fd2 = tun2->fd;
- }
-
- /*system("/sbin/ifconfig tun0 192.168.0.10");*/
- snprintf(buf, sizeof(buf), "/sbin/ifconfig %s %hu.%hu.%hu.%hu",
- ((struct tun_t*) pdp->ipif)->devname,
- pdp->eua.v[2], pdp->eua.v[3], pdp->eua.v[4], pdp->eua.v[5]);
- /* if (debug) */ printf("%s\n", buf);
- system(buf);
-
- /* system("route add -host 192.168.0.10 dev tun0"); */
- /* It seams as if we do not need to set up a route to a p-t-p interface
- snprintf(buf, sizeof(buf),
- "/sbin/route add -host %hu.%hu.%hu.%hu dev %s",
- pdp->eua.v[2], pdp->eua.v[3], pdp->eua.v[4], pdp->eua.v[5],
- ((struct tun_t*) pdp->ipif)->devname);
- if (debug) printf("%s\n", buf);
- system(buf);*/
-
- /*if (defaultroute) {*/
- strncpy(snet, inet_ntoa(net), sizeof(snet));
- strncpy(smask, inet_ntoa(mask), sizeof(smask));
- /* system("route add -net 0.0.0.0 netmask 0.0.0.0 gw 192.168.0.1"); */
- snprintf(buf, sizeof(buf),
- "/sbin/route add -net %s netmask %s gw %hu.%hu.%hu.%hu",
- snet, smask,
- pdp->eua.v[2], pdp->eua.v[3], pdp->eua.v[4], pdp->eua.v[5]);
- /* if (debug) */ printf("%s\n", buf);
- system(buf);
- /*}*/
-
- if (ipup) {
- /* system("ipup /dev/tun0 192.168.0.10"); */
- snprintf(buf, sizeof(buf), "%s %s %hu.%hu.%hu.%hu",
- ipup,
- ((struct tun_t*) pdp->ipif)->devname,
- pdp->eua.v[2], pdp->eua.v[3], pdp->eua.v[4], pdp->eua.v[5]);
- if (debug) printf("%s\n", buf);
- system(buf);
- }
-
- }
-
- pdp_ipset(pdp, pdp->ipif, &pdp->eua);
+ struct in_addr addr;
- state = 2; /* Connected */
+ if (cause != 128) {
+ printf("Received create PDP context response. Cause value: %d\n", cause);
+ state = 0;
+ return EOF; /* Not what we expected */
}
- else {
+
+ if (pdp_euaton(&pdp->eua, &addr)) {
+ printf("Received create PDP context response. Cause value: %d\n", cause);
state = 0;
+ return EOF; /* Not a valid IP address */
}
- printf("\n");
+ printf("Received create PDP context response. IP address: %s\n",
+ inet_ntoa(addr));
+
+ if (options.createif) {
+ struct in_addr m;
+ inet_aton("255.255.255.255", &m);
+ /* printf("Setting up interface and routing\n");*/
+ tun_addaddr(tun, &addr, &addr, &m);
+ if (options.defaultroute) {
+ struct in_addr rm;
+ rm.s_addr = 0;
+ tun_addroute(tun, &rm, &addr, &rm);
+ }
+ if (options.ipup) tun_runscript(tun, options.ipup);
+ }
+
+ ipset((struct iphash_t*) pdp->peer, &addr);
+
+ state = 2; /* Connected */
return 0;
}
@@ -524,23 +840,6 @@ int conf(int type, int cause, struct pdp_t* pdp, void *aid) {
}
}
-int encaps_gtp_client(void *gsn, struct tun_t *tun, void *pack, unsigned len) {
- /* Special client version which checks for source address instead */
- struct pdp_t *pdp;
- struct in_addr addr;
- struct ul66_t eua;
- /*printf("encaps_gtp. Packet received: forwarding to gtp.\n");*/
- /* First we need to extract the IP destination address */
- memcpy(&addr.s_addr, pack+12, 4); /* This ought to be dest addr */
- pdp_ntoeua(&addr, &eua);
- if (pdp_ipget(&pdp, tun, &eua) == 0) {
- return gtp_gpdu((struct gsn_t*) gsn, pdp, pack, len);
- }
- else {
- printf("Received packet without a valid source address!!!\n");
- return 0;
- }
-}
int encaps_tun(struct pdp_t *pdp, void *pack, unsigned len) {
/* printf("encaps_tun. Packet received: forwarding to tun\n");*/
@@ -549,420 +848,119 @@ int encaps_tun(struct pdp_t *pdp, void *pack, unsigned len) {
int main(int argc, char **argv)
{
- /* gengeopt declarations */
- struct gengetopt_args_info args_info;
-
-
- struct hostent *host;
- int gtpfd = -1; /* Network file descriptor */
- struct gsn_t *gsn; /* GSN instance */
fd_set fds; /* For select() */
struct timeval idleTime; /* How long to select() */
- struct pdp_t *pdp[50];
- int n; /* For counter */
- int starttime; /* Time program was started */
+ struct pdp_t *pdp;
+ int n;
+ int starttime = time(NULL); /* Time program was started */
struct timezone tz; /* Used for calculating ping times */
struct timeval tv;
int diff;
- /* function-local options */
- struct ul_t imsi, qos, apn, msisdn;
- unsigned char qosh[3], imsih[8], apnh[256], msisdnh[256];
- struct ul255_t pco;
- uint64_t imsi3;
-
/* open a connection to the syslog daemon */
/*openlog(PACKAGE, LOG_PID, LOG_DAEMON);*/
openlog(PACKAGE, (LOG_PID | LOG_PERROR), LOG_DAEMON);
- if (cmdline_parser (argc, argv, &args_info) != 0)
+ /* Process options given in configuration file and command line */
+ if (process_options(argc, argv))
exit(1);
- if (args_info.debug_flag) {
- printf("remote: %s\n", args_info.remote_arg);
- printf("listen: %s\n", args_info.listen_arg);
- printf("conf: %s\n", args_info.conf_arg);
- printf("fg: %d\n", args_info.fg_flag);
- printf("debug: %d\n", args_info.debug_flag);
- printf("imsi: %s\n", args_info.imsi_arg);
- printf("qos: %#08x\n", args_info.qos_arg);
- printf("apn: %s\n", args_info.apn_arg);
- printf("msisdn: %s\n", args_info.msisdn_arg);
- printf("uid: %s\n", args_info.uid_arg);
- printf("pwd: %s\n", args_info.pwd_arg);
- printf("pidfile: %s\n", args_info.pidfile_arg);
- printf("statedir: %s\n", args_info.statedir_arg);
- printf("dns: %s\n", args_info.dns_arg);
- printf("contexts: %d\n", args_info.contexts_arg);
- printf("timelimit: %d\n", args_info.timelimit_arg);
- printf("createif: %d\n", args_info.createif_flag);
- printf("ipup: %s\n", args_info.ipup_arg);
- printf("ipdown: %s\n", args_info.ipdown_arg);
- /*printf("defaultroute: %d\n", args_info.defaultroute_flag);*/
- printf("net: %s\n", args_info.net_arg);
- printf("mask: %s\n", args_info.mask_arg);
- printf("pinghost: %s\n", args_info.pinghost_arg);
- printf("pingrate: %d\n", args_info.pingrate_arg);
- printf("pingsize: %d\n", args_info.pingsize_arg);
- printf("pingcount: %d\n", args_info.pingcount_arg);
- printf("pingquiet: %d\n", args_info.pingquiet_flag);
- }
- /* Try out our new parser */
-
- if (args_info.conf_arg) {
- if (cmdline_parser_configfile (args_info.conf_arg, &args_info, 0) != 0)
- exit(1);
- if (args_info.debug_flag) {
- printf("cmdline_parser_configfile\n");
- printf("remote: %s\n", args_info.remote_arg);
- printf("listen: %s\n", args_info.listen_arg);
- printf("conf: %s\n", args_info.conf_arg);
- printf("fg: %d\n", args_info.fg_flag);
- printf("debug: %d\n", args_info.debug_flag);
- printf("imsi: %s\n", args_info.imsi_arg);
- printf("qos: %#08x\n", args_info.qos_arg);
- printf("apn: %s\n", args_info.apn_arg);
- printf("msisdn: %s\n", args_info.msisdn_arg);
- printf("uid: %s\n", args_info.uid_arg);
- printf("pwd: %s\n", args_info.pwd_arg);
- printf("pidfile: %s\n", args_info.pidfile_arg);
- printf("statedir: %s\n", args_info.statedir_arg);
- printf("dns: %s\n", args_info.dns_arg);
- printf("contexts: %d\n", args_info.contexts_arg);
- printf("timelimit: %d\n", args_info.timelimit_arg);
- printf("createif: %d\n", args_info.createif_flag);
- printf("ipup: %s\n", args_info.ipup_arg);
- printf("ipdown: %s\n", args_info.ipdown_arg);
- /*printf("defaultroute: %d\n", args_info.defaultroute_flag);*/
- printf("net: %s\n", args_info.net_arg);
- printf("mask: %s\n", args_info.mask_arg);
- printf("pinghost: %s\n", args_info.pinghost_arg);
- printf("pingrate: %d\n", args_info.pingrate_arg);
- printf("pingsize: %d\n", args_info.pingsize_arg);
- printf("pingcount: %d\n", args_info.pingcount_arg);
- printf("pingquiet: %d\n", args_info.pingquiet_flag);
- }
- }
-
- /* Handle each option */
-
- /* foreground */
- /* If fg flag not given run as a daemon */
- if (!args_info.fg_flag)
- {
- closelog();
- /* Close the standard file descriptors. Why? */
- freopen("/dev/null", "w", stdout);
- freopen("/dev/null", "w", stderr);
- freopen("/dev/null", "r", stdin);
- daemon(0, 0);
- /* Open log again. This time with new pid */
- openlog(PACKAGE, LOG_PID, LOG_DAEMON);
- }
-
- /* debug */
- debug = args_info.debug_flag;
-
- /* pidfile */
- /* This has to be done after we have our final pid */
- if (args_info.pidfile_arg) {
- log_pid(args_info.pidfile_arg);
- }
-
- /* dns */
- /* If no dns option is given use system default */
- /* Do hostname lookup to translate hostname to IP address */
- printf("\n");
- if (args_info.dns_arg) {
- if (!(host = gethostbyname(args_info.dns_arg))) {
- fprintf(stderr, "%s: Invalid dns address: %s!\n",
- PACKAGE, args_info.dns_arg);
- syslog(LOG_ERR, "Invalid dns address: %s!",
- args_info.dns_arg);
- exit(1);
- }
- else {
- memcpy(&dns.s_addr, host->h_addr, host->h_length);
- _res.nscount = 1;
- _res.nsaddr_list[0].sin_addr = dns;
- printf("Using DNS server: %s (%s)\n", args_info.dns_arg, inet_ntoa(dns));
- }
- }
- else {
- dns.s_addr= 0;
- printf("Using default DNS server\n");
- }
-
- /* listen */
- /* If no listen option is specified listen to any local port */
- /* Do hostname lookup to translate hostname to IP address */
- if (args_info.listen_arg) {
- if (!(host = gethostbyname(args_info.listen_arg))) {
- fprintf(stderr, "%s: Invalid listening address: %s!\n",
- PACKAGE, args_info.listen_arg);
- syslog(LOG_ERR, "Invalid listening address: %s!",
- args_info.listen_arg);
- exit(1);
- }
- else {
- memcpy(&listen_.s_addr, host->h_addr, host->h_length);
- printf("Local IP address is: %s (%s)\n", args_info.listen_arg, inet_ntoa(listen_));
- }
- }
- else {
- fprintf(stderr, "%s: Listening address must be specified: %s!\n",
- PACKAGE, args_info.listen_arg);
- syslog(LOG_ERR, "Listening address must be specified: %s!",
- args_info.listen_arg);
- exit(1);
- }
-
-
- /* remote */
- /* If no remote option is specified terminate */
- /* Do hostname lookup to translate hostname to IP address */
- if (args_info.remote_arg) {
- if (!(host = gethostbyname(args_info.remote_arg))) {
- fprintf(stderr, "%s: Invalid remote address: %s!\n",
- PACKAGE, args_info.remote_arg);
- syslog(LOG_ERR, "Invalid remote address: %s!",
- args_info.remote_arg);
- exit(1);
- }
- else {
- memcpy(&remote.s_addr, host->h_addr, host->h_length);
- printf("Remote IP address is: %s (%s)\n", args_info.remote_arg, inet_ntoa(remote));
- }
- }
- else {
- fprintf(stderr, "%s: No remote address given!\n",
- PACKAGE);
- syslog(LOG_ERR, "No remote address given!");
- exit(1);
- }
-
-
- /* imsi */
- if (strlen(args_info.imsi_arg)!=15) {
- printf("Invalid IMSI\n");
- exit(1);
- }
- imsi.l = 8;
- imsi.v = imsih;
- imsi.v[0] = args_info.imsi_arg[0]-48 + (args_info.imsi_arg[1]-48)*16;
- imsi.v[1] = args_info.imsi_arg[2]-48 + (args_info.imsi_arg[3]-48)*16;
- imsi.v[2] = args_info.imsi_arg[4]-48 + (args_info.imsi_arg[5]-48)*16;
- imsi.v[3] = args_info.imsi_arg[6]-48 + (args_info.imsi_arg[7]-48)*16;
- imsi.v[4] = args_info.imsi_arg[8]-48 + (args_info.imsi_arg[9]-48)*16;
- imsi.v[5] = args_info.imsi_arg[10]-48 + (args_info.imsi_arg[11]-48)*16;
- imsi.v[6] = args_info.imsi_arg[12]-48 + (args_info.imsi_arg[13]-48)*16;
- imsi.v[7] = args_info.imsi_arg[14]-48 + 0*16;
-
- if (imsi.l > sizeof(imsi3)) {
- printf("Invalid IMSI\n");
- exit(1);
- }
- else {
- memcpy(&imsi3, imsi.v, imsi.l);
- printf("IMSI is: %s (%#08llx)\n", args_info.imsi_arg, imsi3);
- }
-
- /* qos */
- qos.l = 3;
- qos.v = qosh;
- qos.v[2] = (args_info.qos_arg) & 0xff;
- qos.v[1] = ((args_info.qos_arg) >> 8) & 0xff;
- qos.v[0] = ((args_info.qos_arg) >> 16) & 0xff;
-
- /* contexts */
- if (args_info.contexts_arg>16) {
- printf("Contexts has to be less than 16\n");
- exit(1);
- }
- contexts = args_info.contexts_arg;
-
- /* Timelimit */
- timelimit = args_info.timelimit_arg;
- starttime = time(NULL);
-
- /* apn */
- if (strlen(args_info.apn_arg)>255) {
- printf("Invalid APN\n");
- exit(1);
- }
- apn.l = strlen(args_info.apn_arg) + 1;
- apn.v = apnh;
- apn.v[0] = (char) strlen(args_info.apn_arg);
- strncpy(&apn.v[1], args_info.apn_arg, 255);
- printf("Using APN: %s\n", args_info.apn_arg);
-
- /* msisdn */
- if (strlen(args_info.msisdn_arg)>255) {
- printf("Invalid MSISDN\n");
- exit(1);
- }
- msisdn.l = 1;
- msisdn.v = msisdnh;
- msisdn.v[0] = 0x91; /* International format */
- for(n=0; n<strlen(args_info.msisdn_arg); n++) {
- if ((n%2) == 0) {
- msisdn.v[((int)n/2)+1] = args_info.msisdn_arg[n] - 48 + 0xf0;
- msisdn.l += 1;
- }
- else {
- msisdn.v[((int)n/2)+1] = (msisdn.v[((int)n/2)+1] & 0x0f) + (args_info.msisdn_arg[n] - 48) * 16;
- }
- }
- printf("Using MSISDN: %s\n", args_info.msisdn_arg);
-
- /* UID and PWD */
- /* Might need to also insert stuff like DNS etc. */
- if ((strlen(args_info.uid_arg) + strlen(args_info.pwd_arg) + 10)>255) {
- printf("invalid UID and PWD\n");
+ printf("\nInitialising GTP library\n");
+ if (gtp_new(&gsn, options.statedir, &options.listen)) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, 0,
+ "Failed to create gtp");
exit(1);
}
- pco.l = strlen(args_info.uid_arg) + strlen(args_info.pwd_arg) + 10;
- pco.v[0] = 0x80; /* PPP */
- pco.v[1] = 0xc0;
- pco.v[2] = 0x23; /* PAP */
- pco.v[3] = 0x12;
- pco.v[4] = 0x01; /* Authenticate request */
- pco.v[5] = 0x01;
- pco.v[6] = 0x00; /* MSB of length */
- pco.v[7] = strlen(args_info.uid_arg) + strlen(args_info.pwd_arg) + 6;
- pco.v[8] = strlen(args_info.uid_arg);
- memcpy(&pco.v[9], args_info.uid_arg, strlen(args_info.uid_arg));
- pco.v[9+strlen(args_info.uid_arg)] = strlen(args_info.pwd_arg);
- memcpy(&pco.v[10+strlen(args_info.uid_arg)], args_info.pwd_arg, strlen(args_info.pwd_arg));
-
- /* createif */
- createif = args_info.createif_flag;
-
- /* ipup */
- ipup = args_info.ipup_arg;
-
- /* ipdown */
- ipdown = args_info.ipdown_arg;
-
- /* defaultroute
- defaultroute = args_info.defaultroute_flag;*/
-
- /* net */
- /* Store net as in_addr */
- if (args_info.net_arg) {
- if (!inet_aton(args_info.net_arg, &net)) {
- fprintf(stderr, "%s: Invalid network address: %s!\n",
- PACKAGE, args_info.net_arg);
- syslog(LOG_ERR, "Invalid network address: %s!",
- args_info.net_arg);
- exit(1);
- }
- }
+ if (gsn->fd > maxfd) maxfd = gsn->fd;
- /* mask */
- /* Store mask as in_addr */
- if (args_info.mask_arg) {
- if (!inet_aton(args_info.mask_arg, &mask)) {
- fprintf(stderr, "%s: Invalid network mask: %s!\n",
- PACKAGE, args_info.mask_arg);
- syslog(LOG_ERR, "Invalid network mask: %s!",
- args_info.mask_arg);
- exit(1);
- }
- }
+ gtp_set_cb_delete_context(gsn, delete_context);
+ gtp_set_cb_conf(gsn, conf);
+ if (options.createif)
+ gtp_set_cb_gpdu(gsn, encaps_tun);
+ else
+ gtp_set_cb_gpdu(gsn, encaps_ping);
- /* pinghost */
- /* Store ping host as in_addr */
- if (args_info.pinghost_arg) {
- if (!inet_aton(args_info.pinghost_arg, &pinghost)) {
- fprintf(stderr, "%s: Invalid ping host: %s!\n",
- PACKAGE, args_info.pinghost_arg);
- syslog(LOG_ERR, "Invalid ping host: %s!",
- args_info.pinghost_arg);
+ if (options.createif) {
+ printf("Setting up interface\n");
+ /* Create a tunnel interface */
+ if (tun_new((struct tun_t**) &tun)) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, 0,
+ "Failed to create tun");
exit(1);
}
+ tun_set_cb_ind(tun, cb_tun_ind);
+ if (tun->fd > maxfd) maxfd = tun->fd;
}
- /* Other ping parameters */
- pingrate = args_info.pingrate_arg;
- pingsize = args_info.pingsize_arg;
- pingcount = args_info.pingcount_arg;
- pingquiet = args_info.pingquiet_flag;
-
- printf("\nInitialising GTP library\n");
- if ((gtpfd = gtp_new(&gsn, args_info.statedir_arg, &listen_)) > maxfd)
- maxfd = gtpfd;
+ /* Initialise hash tables */
+ memset(&iphash, 0, sizeof(iphash));
+ memset(&iparr, 0, sizeof(iparr));
- if ((gtpfd = gtp_fd(gsn)) > maxfd)
- maxfd = gtpfd;
-
- if (createif)
- gtp_set_cb_gpdu(gsn, encaps_tun);
- else
- gtp_set_cb_gpdu(gsn, encaps_ping);
-
- gtp_set_cb_delete_context(gsn, delete_context);
-
- gtp_set_cb_conf(gsn, conf);
printf("Done initialising GTP library\n\n");
/* See if anybody is there */
printf("Sending off echo request\n");
- if (gtpfd != -1) gtp_echo_req(gsn, &remote); /* See if remote is alive ? */
+ gtp_echo_req(gsn, &options.remote); /* See if remote is alive ? */
- for(n=0; n<contexts; n++) {
+ for(n=0; n<options.contexts; n++) {
printf("Setting up PDP context #%d\n", n);
+ iparr[n].inuse = 1; /* TODO */
- pdp_newpdp(&pdp[n], imsi3, n, NULL); /* Allocated here. Cleaned up in gtp.c: TODO Should be statically allocated! */
-
- /*
- if (qos.l > sizeof(pdp[n]->qos_req.v)) {
- exit(1);
- }
- else {
- pdp[n]->qos_req.l = qos.l;
- memcpy(pdp[n]->qos_req.v, qos.v, qos.l);
- }
- */
- memcpy(pdp[n]->qos_req0, qos.v, qos.l); /* TODO range check */
+ /* Allocated here. Cleaned up in gtp.c:*/
+ pdp_newpdp(&pdp, options.imsi, n, NULL);
+
+ pdp->peer = &iparr[n];
+ pdp->ipif = tun; /* TODO */
+ iparr[n].pdp = pdp;
+
+ if (options.qos.l > sizeof(pdp->qos_req0)) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, 0, "QoS length too big");
+ exit(1);
+ }
+ else {
+ memcpy(pdp->qos_req0, options.qos.v, options.qos.l);
+ }
- pdp[n]->selmode = 0x01; /* MS provided APN, subscription not verified */
+ pdp->selmode = 0x01; /* MS provided APN, subscription not verified */
- if (apn.l > sizeof(pdp[n]->apn_use.v)) {
+ if (options.apn.l > sizeof(pdp->apn_use.v)) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, 0, "APN length too big");
exit(1);
}
else {
- pdp[n]->apn_use.l = apn.l;
- memcpy(pdp[n]->apn_use.v, apn.v, apn.l);
+ pdp->apn_use.l = options.apn.l;
+ memcpy(pdp->apn_use.v, options.apn.v, options.apn.l);
}
- pdp[n]->gsnlc.l = 4;
- memcpy(pdp[n]->gsnlc.v, &listen_, 4);
- pdp[n]->gsnlu.l = 4;
- memcpy(pdp[n]->gsnlu.v, &listen_, 4);
+ pdp->gsnlc.l = sizeof(options.listen);
+ memcpy(pdp->gsnlc.v, &options.listen, sizeof(options.listen));
+ pdp->gsnlu.l = sizeof(options.listen);
+ memcpy(pdp->gsnlu.v, &options.listen, sizeof(options.listen));
- if (msisdn.l > sizeof(pdp[n]->msisdn.v)) {
+ if (options.msisdn.l > sizeof(pdp->msisdn.v)) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, 0, "MSISDN length too big");
exit(1);
}
else {
- pdp[n]->msisdn.l = msisdn.l;
- memcpy(pdp[n]->msisdn.v, msisdn.v, msisdn.l);
+ pdp->msisdn.l = options.msisdn.l;
+ memcpy(pdp->msisdn.v, options.msisdn.v, options.msisdn.l);
}
- ipv42eua(&pdp[n]->eua, NULL); /* Request dynamic IP address */
+ ipv42eua(&pdp->eua, NULL); /* Request dynamic IP address */
- if (pco.l > sizeof(pdp[n]->pco_req.v)) {
+ if (options.pco.l > sizeof(pdp->pco_req.v)) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, 0, "PCO length too big");
exit(1);
}
else {
- pdp[n]->pco_req.l = pco.l;
- memcpy(pdp[n]->pco_req.v, pco.v, pco.l);
+ pdp->pco_req.l = options.pco.l;
+ memcpy(pdp->pco_req.v, options.pco.v, options.pco.l);
}
/* Create context */
/* We send this of once. Retransmissions are handled by gtplib */
- if (gtpfd != -1) gtp_create_context(gsn, pdp[n], NULL, &remote);
+ gtp_create_context(gsn, pdp, NULL, &options.remote);
}
state = 1; /* Enter wait_connection state */
@@ -974,55 +972,58 @@ int main(int argc, char **argv)
/* Main select loop */
/******************************************************************/
- while ((((starttime + timelimit + 10) > time(NULL))
- || (0 == timelimit)) && (state!=0)) {
+ while ((((starttime + options.timelimit + 10) > time(NULL))
+ || (0 == options.timelimit)) && (state!=0)) {
/* Take down client connections at some stage */
- if (((starttime + timelimit) <= time(NULL)) && (0 != timelimit) && (2 == state)) {
+ if (((starttime + options.timelimit) <= time(NULL)) &&
+ (0 != options.timelimit) && (2 == state)) {
state = 3;
- for(n=0; n<contexts; n++) {
+ for(n=0; n<options.contexts; n++) {
/* Delete context */
printf("Disconnecting PDP context #%d\n", n);
- if (gtpfd != -1) gtp_delete_context(gsn, pdp[n], NULL);
- if ((pinghost.s_addr !=0) && ntransmitted) ping_finish();
+ gtp_delete_context(gsn, iparr[n].pdp, NULL);
+ if ((options.pinghost.s_addr !=0) && ntransmitted) ping_finish();
}
}
-
-
+
+ diff = 0;
+ while (( diff<=0 ) &&
/* Send off an ICMP ping packet */
- if ((pinghost.s_addr) && (2 == state) &&
- ((pingseq < pingcount) || (pingcount == 0))) {
+ /*if (*/(options.pinghost.s_addr) && (2 == state) &&
+ ((pingseq < options.pingcount) || (options.pingcount == 0))) {
if (!pingseq) gettimeofday(&firstping, &tz); /* Set time of first ping */
gettimeofday(&tv, &tz);
- diff = 1000000 / pingrate * pingseq -
+ diff = 1000000 / options.pingrate * pingseq -
1000000 * (tv.tv_sec - firstping.tv_sec) -
(tv.tv_usec - firstping.tv_usec); /* Microseconds safe up to 500 sec */
if (diff <=0) {
- if (debug) printf("Create_ping %d\n", diff);
- create_ping(gsn, pdp[pingseq % contexts],
- &pinghost, pingseq, pingsize);
+ if (options.debug) printf("Create_ping %d\n", diff);
+ create_ping(gsn, iparr[pingseq % options.contexts].pdp,
+ &options.pinghost, pingseq, options.pingsize);
pingseq++;
}
}
+
- if (ntransmitted && pingcount && nreceived >= pingcount)
+ if (ntransmitted && options.pingcount && nreceived >= options.pingcount)
ping_finish();
-
+
FD_ZERO(&fds);
- if (tun_fd1 != -1) FD_SET(tun_fd1, &fds);
- if (tun_fd2 != -1) FD_SET(tun_fd2, &fds);
- if (gtpfd != -1) FD_SET(gtpfd, &fds);
+ if (tun) FD_SET(tun->fd, &fds);
+ FD_SET(gsn->fd, &fds);
gtp_retranstimeout(gsn, &idleTime);
ping_timeout(&idleTime);
-
- if (debug) printf("idletime.tv_sec %d, idleTime.tv_usec %d\n",
- (int) idleTime.tv_sec, (int) idleTime.tv_usec);
-
+
+ if (options.debug) printf("idletime.tv_sec %d, idleTime.tv_usec %d\n",
+ (int) idleTime.tv_sec, (int) idleTime.tv_usec);
+
switch (select(maxfd + 1, &fds, NULL, NULL, &idleTime)) {
case -1:
- syslog(LOG_ERR, "sgsnemu: select = -1");
+ sys_err(LOG_ERR, __FILE__, __LINE__, 0,
+ "Select returned -1");
break;
case 0:
gtp_retrans(gsn); /* Only retransmit if nothing else */
@@ -1030,30 +1031,22 @@ int main(int argc, char **argv)
default:
break;
}
-
- if (tun_fd1 != -1 &&
- FD_ISSET(tun_fd1, &fds) &&
- tun_decaps(tun1, encaps_gtp_client, gsn) < 0) {
- syslog(LOG_ERR, "TUN read failed (fd)=(%d)", tun_fd1);
- }
-
- if (tun_fd2 != -1 &&
- FD_ISSET(tun_fd2, &fds) &&
- tun_decaps(tun2, encaps_gtp_client, gsn) < 0) {
- syslog(LOG_ERR, "TUN read failed (fd)=(%d)", tun_fd2);
- }
-
- if (gtpfd != -1 && FD_ISSET(gtpfd, &fds) &&
- gtp_decaps(gsn) < 0) {
- syslog(LOG_ERR, "GTP read failed (gtpfd)=(%d)", gtpfd);
+
+ if ((tun) && FD_ISSET(tun->fd, &fds) && tun_decaps(tun) < 0) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, 0,
+ "TUN decaps failed");
}
+ if (FD_ISSET(gsn->fd, &fds))
+ gtp_decaps(gsn);
}
-
+
gtp_free(gsn); /* Clean up the gsn instance */
- return 0;
+ if (options.createif)
+ tun_free(tun);
+ return 0;
}
diff --git a/sgsnemu/tun.c b/sgsnemu/tun.c
index 72ea264..5b8cc95 100644
--- a/sgsnemu/tun.c
+++ b/sgsnemu/tun.c
@@ -1,32 +1,24 @@
/*
- * OpenGGSN - Gateway GPRS Support Node
- * Copyright (C) 2002 Mondru AB.
+ * TUN interface functions.
+ * Copyright (C) 2002, 2003 Mondru AB.
*
- * The contents of this file may be used under the terms of the GNU
- * General Public License Version 2, provided that the above copyright
- * notice and this permission notice is included in all copies or
- * substantial portions of the software.
+ * The contents of this file may be used under the terms of the GNU
+ * General Public License Version 2, provided that the above copyright
+ * notice and this permission notice is included in all copies or
+ * substantial portions of the software.
*
- * The initial developer of the original code is
- * Jens Jakobsen <jj@openggsn.org>
+ * The initial developer of the original code is
+ * Jens Jakobsen <jj@openggsn.org>
*
- * Contributor(s):
+ * Contributor(s):
*
*/
/*
- * tun.c: Contains all TUN functionality. Should be able to handle multiple
- * tunnels in the same program. Each tunnel is identified by the socket.
- * I suppose that no other state information than the socket is needed.
+ * tun.c: Contains all TUN functionality. Is able to handle multiple
+ * tunnels in the same program. Each tunnel is identified by the struct,
+ * which is passed to functions.
*
- * - tun_newtun: Initialise TUN tunnel.
- * - tun_freetun: Free a device previously created with tun_newtun.
- * - tun_encaps: Encapsulate packet in TUN tunnel and send off
- * - tun_decaps: Extract packet from TUN tunnel and call function to
- * ship it off as GTP encapsulated packet.
- *
- * TODO:
- * - Do we need to handle fragmentation?
*/
@@ -54,75 +46,471 @@
#include <linux/if.h>
#include <errno.h>
#include <linux/if_tun.h>
+#include <net/route.h>
+#include <linux/netlink.h>
+#include <linux/rtnetlink.h>
#include "tun.h"
+#include "syserr.h"
+
-int tun_newtun(struct tun_t **tun)
+int tun_nlattr(struct nlmsghdr *n, int nsize, int type, void *d, int dlen)
{
+ int len = RTA_LENGTH(dlen);
+ int alen = NLMSG_ALIGN(n->nlmsg_len);
+ struct rtattr *rta = (struct rtattr*) (((void*)n) + alen);
+ if (alen + len > nsize)
+ return -1;
+ rta->rta_len = len;
+ rta->rta_type = type;
+ memcpy(RTA_DATA(rta), d, dlen);
+ n->nlmsg_len = alen + len;
+ return 0;
+}
+
+int tun_gifindex(struct tun_t *this, int *index) {
+ struct ifreq ifr;
+ int fd;
+
+ memset (&ifr, '\0', sizeof (ifr));
+ ifr.ifr_addr.sa_family = AF_INET;
+ ifr.ifr_dstaddr.sa_family = AF_INET;
+ ifr.ifr_netmask.sa_family = AF_INET;
+ strncpy(ifr.ifr_name, this->devname, IFNAMSIZ);
+ ifr.ifr_name[IFNAMSIZ-1] = 0; /* Make sure to terminate */
+ if ((fd = socket(AF_INET, SOCK_DGRAM, 0)) < 0) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, errno,
+ "socket() failed");
+ }
+ if (ioctl(fd, SIOCGIFINDEX, &ifr)) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, errno,
+ "ioctl() failed");
+ close(fd);
+ return -1;
+ }
+ close(fd);
+ *index = ifr.ifr_ifindex;
+ return 0;
+}
+
+int tun_sifflags(struct tun_t *this, int flags) {
struct ifreq ifr;
+ int fd;
+
+ memset (&ifr, '\0', sizeof (ifr));
+ ifr.ifr_flags = flags;
+ strncpy(ifr.ifr_name, this->devname, IFNAMSIZ);
+ ifr.ifr_name[IFNAMSIZ-1] = 0; /* Make sure to terminate */
+ if ((fd = socket(AF_INET, SOCK_DGRAM, 0)) < 0) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, errno,
+ "socket() failed");
+ }
+ if (ioctl(fd, SIOCSIFFLAGS, &ifr)) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, errno,
+ "ioctl(SIOCSIFFLAGS) failed");
+ close(fd);
+ return -1;
+ }
+ close(fd);
+ return 0;
+}
+
+
+/* Currently unused */
+int tun_addroute2(struct tun_t *this,
+ struct in_addr *dst,
+ struct in_addr *gateway,
+ struct in_addr *mask) {
+
+ struct {
+ struct nlmsghdr n;
+ struct rtmsg r;
+ char buf[TUN_NLBUFSIZE];
+ } req;
+
+ struct sockaddr_nl local;
+ int addr_len;
+ int fd;
+ int status;
+ struct sockaddr_nl nladdr;
+ struct iovec iov;
+ struct msghdr msg;
+
+ memset(&req, 0, sizeof(req));
+ req.n.nlmsg_len = NLMSG_LENGTH(sizeof(struct rtmsg));
+ req.n.nlmsg_flags = NLM_F_REQUEST | NLM_F_CREATE;
+ req.n.nlmsg_type = RTM_NEWROUTE;
+ req.r.rtm_family = AF_INET;
+ req.r.rtm_table = RT_TABLE_MAIN;
+ req.r.rtm_protocol = RTPROT_BOOT;
+ req.r.rtm_scope = RT_SCOPE_UNIVERSE;
+ req.r.rtm_type = RTN_UNICAST;
+ tun_nlattr(&req.n, sizeof(req), RTA_DST, dst, 4);
+ tun_nlattr(&req.n, sizeof(req), RTA_GATEWAY, gateway, 4);
+
+ if ((fd = socket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE)) < 0) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, errno,
+ "socket() failed");
+ return -1;
+ }
+
+ memset(&local, 0, sizeof(local));
+ local.nl_family = AF_NETLINK;
+ local.nl_groups = 0;
+
+ if (bind(fd, (struct sockaddr*)&local, sizeof(local)) < 0) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, errno,
+ "bind() failed");
+ close(fd);
+ return -1;
+ }
+
+ addr_len = sizeof(local);
+ if (getsockname(fd, (struct sockaddr*)&local, &addr_len) < 0) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, errno,
+ "getsockname() failed");
+ close(fd);
+ return -1;
+ }
+ if (addr_len != sizeof(local)) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, 0,
+ "Wrong address length %d", addr_len);
+ close(fd);
+ return -1;
+ }
+
+ if (local.nl_family != AF_NETLINK) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, 0,
+ "Wrong address family %d", local.nl_family);
+ close(fd);
+ return -1;
+ }
+
+ iov.iov_base = (void*)&req.n;
+ iov.iov_len = req.n.nlmsg_len;
+
+ msg.msg_name = (void*)&nladdr;
+ msg.msg_namelen = sizeof(nladdr),
+ msg.msg_iov = &iov;
+ msg.msg_iovlen = 1;
+ msg.msg_control = NULL;
+ msg.msg_controllen = 0;
+ msg.msg_flags = 0;
+
+ memset(&nladdr, 0, sizeof(nladdr));
+ nladdr.nl_family = AF_NETLINK;
+ nladdr.nl_pid = 0;
+ nladdr.nl_groups = 0;
+
+ req.n.nlmsg_seq = 0;
+ req.n.nlmsg_flags |= NLM_F_ACK;
+
+ status = sendmsg(fd, &msg, 0); /* TODO: Error check */
+ close(fd);
+ return 0;
+}
+
+
+int tun_addaddr(struct tun_t *this,
+ struct in_addr *addr,
+ struct in_addr *dstaddr,
+ struct in_addr *netmask) {
+ struct {
+ struct nlmsghdr n;
+ struct ifaddrmsg i;
+ char buf[TUN_NLBUFSIZE];
+ } req;
+
+ struct sockaddr_nl local;
+ int addr_len;
+ int fd;
+ int status;
+
+ struct sockaddr_nl nladdr;
+ struct iovec iov;
+ struct msghdr msg;
+
+ if (!this->addrs) /* Use ioctl for first addr to make ping work */
+ return tun_setaddr(this, addr, dstaddr, netmask);
+
+ memset(&req, 0, sizeof(req));
+ req.n.nlmsg_len = NLMSG_LENGTH(sizeof(struct ifaddrmsg));
+ req.n.nlmsg_flags = NLM_F_REQUEST | NLM_F_CREATE;
+ req.n.nlmsg_type = RTM_NEWADDR;
+ req.i.ifa_family = AF_INET;
+ req.i.ifa_prefixlen = 32; /* 32 FOR IPv4 */
+ req.i.ifa_flags = 0;
+ req.i.ifa_scope = RT_SCOPE_HOST; /* TODO or 0 */
+ if (tun_gifindex(this, &req.i.ifa_index)) {
+ return -1;
+ }
+
+ tun_nlattr(&req.n, sizeof(req), IFA_ADDRESS, addr, sizeof(addr));
+ tun_nlattr(&req.n, sizeof(req), IFA_LOCAL, dstaddr, sizeof(dstaddr));
+
+ if ((fd = socket(AF_NETLINK, SOCK_RAW, NETLINK_ROUTE)) < 0) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, errno,
+ "socket() failed");
+ return -1;
+ }
+
+ memset(&local, 0, sizeof(local));
+ local.nl_family = AF_NETLINK;
+ local.nl_groups = 0;
+
+ if (bind(fd, (struct sockaddr*)&local, sizeof(local)) < 0) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, errno,
+ "bind() failed");
+ close(fd);
+ return -1;
+ }
+
+ addr_len = sizeof(local);
+ if (getsockname(fd, (struct sockaddr*)&local, &addr_len) < 0) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, errno,
+ "getsockname() failed");
+ close(fd);
+ return -1;
+ }
+
+ if (addr_len != sizeof(local)) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, 0,
+ "Wrong address length %d", addr_len);
+ close(fd);
+ return -1;
+ }
+
+ if (local.nl_family != AF_NETLINK) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, 0,
+ "Wrong address family %d", local.nl_family);
+ close(fd);
+ return -1;
+ }
+
+ iov.iov_base = (void*)&req.n;
+ iov.iov_len = req.n.nlmsg_len;
+
+ msg.msg_name = (void*)&nladdr;
+ msg.msg_namelen = sizeof(nladdr),
+ msg.msg_iov = &iov;
+ msg.msg_iovlen = 1;
+ msg.msg_control = NULL;
+ msg.msg_controllen = 0;
+ msg.msg_flags = 0;
+
+ memset(&nladdr, 0, sizeof(nladdr));
+ nladdr.nl_family = AF_NETLINK;
+ nladdr.nl_pid = 0;
+ nladdr.nl_groups = 0;
+
+ req.n.nlmsg_seq = 0;
+ req.n.nlmsg_flags |= NLM_F_ACK;
+
+ status = sendmsg(fd, &msg, 0); /* TODO Error check */
+
+ tun_sifflags(this, IFF_UP | IFF_RUNNING);
+ close(fd);
+ this->addrs++;
+ return 0;
+}
+
+
+int tun_setaddr(struct tun_t *this,
+ struct in_addr *addr,
+ struct in_addr *dstaddr,
+ struct in_addr *netmask)
+{
+ struct ifreq ifr;
+ int fd;
+
+ memset (&ifr, '\0', sizeof (ifr));
+ ifr.ifr_addr.sa_family = AF_INET;
+ ifr.ifr_dstaddr.sa_family = AF_INET;
+ ifr.ifr_netmask.sa_family = AF_INET;
+ strncpy(ifr.ifr_name, this->devname, IFNAMSIZ);
+ ifr.ifr_name[IFNAMSIZ-1] = 0; /* Make sure to terminate */
+
+ /* Create a channel to the NET kernel. */
+ if ((fd = socket(AF_INET, SOCK_DGRAM, 0)) < 0) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, errno,
+ "socket() failed");
+ return -1;
+ }
+
+ if (addr) { /* Set the interface address */
+ this->addr.s_addr = addr->s_addr;
+ ((struct sockaddr_in *) &ifr.ifr_addr)->sin_addr.s_addr = addr->s_addr;
+ if (ioctl(fd, SIOCSIFADDR, (void *) &ifr) < 0) {
+ if (errno != EEXIST) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, errno,
+ "ioctl(SIOCSIFADDR) failed");
+ }
+ else {
+ sys_err(LOG_WARNING, __FILE__, __LINE__, errno,
+ "ioctl(SIOCSIFADDR): Address already exists");
+ }
+ close(fd);
+ return -1;
+ }
+ }
+
+ if (dstaddr) { /* Set the destination address */
+ this->dstaddr.s_addr = dstaddr->s_addr;
+ ((struct sockaddr_in *) &ifr.ifr_dstaddr)->sin_addr.s_addr =
+ dstaddr->s_addr;
+ if (ioctl(fd, SIOCSIFDSTADDR, (caddr_t) &ifr) < 0) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, errno,
+ "ioctl(SIOCSIFDSTADDR) failed");
+ close(fd);
+ return -1;
+ }
+ }
+
+ if (netmask) { /* Set the netmask */
+ this->netmask.s_addr = netmask->s_addr;
+ ((struct sockaddr_in *) &ifr.ifr_netmask)->sin_addr.s_addr =
+ netmask->s_addr;
+ if (ioctl(fd, SIOCSIFNETMASK, (void *) &ifr) < 0) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, errno,
+ "ioctl(SIOCSIFNETMASK) failed");
+ close(fd);
+ return -1;
+ }
+ }
+
+ close(fd);
+ this->addrs++;
+ return tun_sifflags(this, IFF_UP | IFF_RUNNING);
+}
+
+int tun_addroute(struct tun_t *this,
+ struct in_addr *dst,
+ struct in_addr *gateway,
+ struct in_addr *mask)
+{
+ struct rtentry r;
+ int fd;
+
+ memset (&r, '\0', sizeof (r));
+ r.rt_flags = RTF_UP | RTF_GATEWAY; /* RTF_HOST not set */
+
+ /* Create a channel to the NET kernel. */
+ if ((fd = socket(AF_INET, SOCK_DGRAM, 0)) < 0) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, errno,
+ "socket() failed");
+ return -1;
+ }
+
+ r.rt_dst.sa_family = AF_INET;
+ r.rt_gateway.sa_family = AF_INET;
+ r.rt_genmask.sa_family = AF_INET;
+ ((struct sockaddr_in *) &r.rt_dst)->sin_addr.s_addr = dst->s_addr;
+ ((struct sockaddr_in *) &r.rt_gateway)->sin_addr.s_addr = gateway->s_addr;
+ ((struct sockaddr_in *) &r.rt_genmask)->sin_addr.s_addr = mask->s_addr;
+
+ if (ioctl(fd, SIOCADDRT, (void *) &r) < 0) { /* SIOCDELRT */
+ sys_err(LOG_ERR, __FILE__, __LINE__, errno,
+ "ioctl(SIOCADDRT) failed");
+ close(fd);
+ return -1;
+ }
+ close(fd);
+ return 0;
+}
+
+
+int tun_new(struct tun_t **tun)
+{
+ struct ifreq ifr;
+
if (!(*tun = calloc(1, sizeof(struct tun_t)))) {
- syslog(LOG_ERR, "%s %d. calloc(nmemb=%d, size=%d) failed: Error = %s(%d)",
- __FILE__, __LINE__, 1, sizeof(struct tun_t),
- strerror(errno), errno);
+ sys_err(LOG_ERR, __FILE__, __LINE__, errno, "calloc() failed");
return EOF;
}
-
+
+ (*tun)->cb_ind = NULL;
+ (*tun)->addrs = 0;
+
if (((*tun)->fd = open("/dev/net/tun", O_RDWR)) < 0) {
- syslog(LOG_ERR, "TUN: open() failed");
+ sys_err(LOG_ERR, __FILE__, __LINE__, errno, "open() failed");
return -1;
}
-
+
memset(&ifr, 0, sizeof(ifr));
ifr.ifr_flags = IFF_TUN | IFF_NO_PI; /* Tun device, no packet info */
strncpy(ifr.ifr_name, (*tun)->devname, IFNAMSIZ);
-
+
if (ioctl((*tun)->fd, TUNSETIFF, (void *) &ifr) < 0) {
- syslog(LOG_ERR, "TUN: ioctl() failed");
+ sys_err(LOG_ERR, __FILE__, __LINE__, errno, "ioctl() failed");
close((*tun)->fd);
return -1;
}
-
+
ioctl((*tun)->fd, TUNSETNOCSUM, 1); /* Disable checksums */
-
+
strncpy((*tun)->devname, ifr.ifr_name, IFNAMSIZ);
-
- return (*tun)->fd;
+ (*tun)->devname[IFNAMSIZ] = 0;
+
+ return 0;
}
-int tun_freetun(struct tun_t *tun)
+int tun_free(struct tun_t *tun)
{
if (close(tun->fd)) {
- syslog(LOG_ERR, "%s %d. close(fd=%d) failed: Error = %s",
- __FILE__, __LINE__, tun->fd, strerror(errno));
- return EOF;
+ sys_err(LOG_ERR, __FILE__, __LINE__, errno, "close() failed");
}
+
free(tun);
return 0;
}
-int tun_decaps(struct tun_t *tun,
- int (*cb) (void *cl, struct tun_t*, void *pack, unsigned len),
- void *cl)
-{
- unsigned char buffer[PACKET_MAX + 64 /*TODO: ip header */ ];
- int status;
+int tun_set_cb_ind(struct tun_t *this,
+ int (*cb_ind) (struct tun_t *tun, void *pack, unsigned len)) {
+ this->cb_ind = cb_ind;
+ return 0;
+}
- if ((status = read(tun->fd, buffer, sizeof(buffer))) <= 0) {
- syslog(LOG_ERR, "TUN: read(fd=%d,buffer=%lx,len=%d) from network failed: status = %d error = %s",
- tun->fd, (unsigned long) buffer, sizeof(buffer), status, status ? strerror(errno) : "No error");
- return -1;
- }
+int tun_decaps(struct tun_t *this)
+{
+ unsigned char buffer[PACKET_MAX];
+ int status;
+
+ if ((status = read(this->fd, buffer, sizeof(buffer))) <= 0) {
+ sys_err(LOG_ERR, __FILE__, __LINE__, errno, "read() failed");
+ return -1;
+ }
+
+ if (this->cb_ind)
+ return this->cb_ind(this, buffer, status);
- /* Need to include code to verify packet src and dest addresses */
- return cb(cl, tun, buffer, status);
+ return 0;
}
int tun_encaps(struct tun_t *tun, void *pack, unsigned len)
{
- return write(tun->fd, pack, len);
+ return write(tun->fd, pack, len);
+}
+
+int tun_runscript(struct tun_t *tun, char* script) {
+
+ char buf[TUN_SCRIPTSIZE];
+ char snet[TUN_ADDRSIZE];
+ char smask[TUN_ADDRSIZE];
+
+ strncpy(snet, inet_ntoa(tun->addr), sizeof(snet));
+ snet[sizeof(snet)-1] = 0;
+ strncpy(smask, inet_ntoa(tun->netmask), sizeof(smask));
+ smask[sizeof(smask)-1] = 0;
+
+ /* system("ipup /dev/tun0 192.168.0.10 255.255.255.0"); */
+ snprintf(buf, sizeof(buf), "%s %s %s %s",
+ script, tun->devname, snet, smask);
+ buf[sizeof(buf)-1] = 0;
+ system(buf);
+ return 0;
}
diff --git a/sgsnemu/tun.h b/sgsnemu/tun.h
index 03dc7df..8d4618d 100644
--- a/sgsnemu/tun.h
+++ b/sgsnemu/tun.h
@@ -1,48 +1,78 @@
/*
- * OpenGGSN - Gateway GPRS Support Node
- * Copyright (C) 2002 Mondru AB.
+ * TUN interface functions.
+ * Copyright (C) 2002, 2003 Mondru AB.
*
- * The contents of this file may be used under the terms of the GNU
- * General Public License Version 2, provided that the above copyright
- * notice and this permission notice is included in all copies or
- * substantial portions of the software.
+ * The contents of this file may be used under the terms of the GNU
+ * General Public License Version 2, provided that the above copyright
+ * notice and this permission notice is included in all copies or
+ * substantial portions of the software.
*
- * The initial developer of the original code is
- * Jens Jakobsen <jj@openggsn.org>
+ * The initial developer of the original code is
+ * Jens Jakobsen <jj@openggsn.org>
*
- * Contributor(s):
+ * Contributor(s):
*
*/
#ifndef _TUN_H
#define _TUN_H
-#define hton8(x) (x)
-#define ntoh8(x) (x)
-#define hton16(x) htons(x)
-#define ntoh16(x) ntohs(x)
-#define hton32(x) htonl(x)
-#define ntoh32(x) ntohl(x)
+#define PACKET_MAX 8196 /* Maximum packet size we receive */
+#define TUN_SCRIPTSIZE 256
+#define TUN_ADDRSIZE 128
+#define TUN_NLBUFSIZE 1024
+
+struct tun_packet_t {
+ unsigned int ver:4;
+ unsigned int ihl:4;
+ unsigned int dscp:6;
+ unsigned int ecn:2;
+ unsigned int length:16;
+ unsigned int id:16;
+ unsigned int flags:3;
+ unsigned int fragment:13;
+ unsigned int ttl:8;
+ unsigned int protocol:8;
+ unsigned int check:16;
+ unsigned int src:32;
+ unsigned int dst:32;
+};
-#define PACKET_MAX 8196 /* TODO */
/* ***********************************************************
* Information storage for each tun instance
*************************************************************/
struct tun_t {
- int fd; /* File descriptor to network interface */
- struct in_addr addr; /* IP address of tun interface */
+ int fd; /* File descriptor to tun interface */
+ struct in_addr addr;
+ struct in_addr dstaddr;
+ struct in_addr netmask;
+ int addrs; /* Number of allocated IP addresses */
char devname[IFNAMSIZ];/* Name of the tun device */
+ int (*cb_ind) (struct tun_t *tun, void *pack, unsigned len);
};
-extern int tun_newtun(struct tun_t **tun);
-extern int tun_freetun(struct tun_t *tun);
-extern int tun_decaps(struct tun_t *tun,
- int (*cb) (void *cl, struct tun_t*, void *pack, unsigned len),
- void *cl);
+extern int tun_new(struct tun_t **tun);
+extern int tun_free(struct tun_t *tun);
+extern int tun_decaps(struct tun_t *this);
extern int tun_encaps(struct tun_t *tun, void *pack, unsigned len);
+extern int tun_addaddr(struct tun_t *this, struct in_addr *addr,
+ struct in_addr *dstaddr, struct in_addr *netmask);
+
+
+extern int tun_setaddr(struct tun_t *this, struct in_addr *our_adr,
+ struct in_addr *his_adr, struct in_addr *net_mask);
+
+int tun_addroute(struct tun_t *this, struct in_addr *dst,
+ struct in_addr *gateway, struct in_addr *mask);
+
+extern int tun_set_cb_ind(struct tun_t *this,
+ int (*cb_ind) (struct tun_t *tun, void *pack, unsigned len));
+
+
+extern int tun_runscript(struct tun_t *tun, char* script);
#endif /* !_TUN_H */
generated by cgit v1.2.3 (git 2.25.1) at 2024-05-22 15:57:32 +0000