X-Git-Url: http://git.sameswireless.fr/l2tpns.git/blobdiff_plain/b60aa5064b011de69da69335e1d66a5b65fe7a4f..59e6083b5ecbb2a8e9ab511ac2f8da40b5c82f66:/autothrottle.c?ds=sidebyside

diff --git a/autothrottle.c b/autothrottle.c
index d28c7cb..007f926 100644
--- a/autothrottle.c
+++ b/autothrottle.c
@@ -1,118 +1,159 @@
 #include <string.h>
+#include <sys/socket.h>
+#include <linux/rtnetlink.h>
+
 #include "l2tpns.h"
 #include "plugin.h"
 
 /* set up throttling based on RADIUS reply */
 
-char const *cvs_id = "$Id: autothrottle.c,v 1.11 2004/11/30 00:46:36 bodea Exp $";
+/*
+ * lcp:interface-config#1=service-policy input N
+ * lcp:interface-config#2=service-policy output N
+ *
+ * throttle=N
+ * throttle=yes (use throttle_speed from config)
+ * throttle=no
+ */
 
 int plugin_api_version = PLUGIN_API_VERSION;
-struct pluginfuncs *p;
+static struct pluginfuncs *f = 0;
 
 #define THROTTLE_KEY "lcp:interface-config"
 
 int plugin_radius_response(struct param_radius_response *data)
 {
-	char *t;
-	int i = 0;
+    if (!strncmp(data->key, THROTTLE_KEY, sizeof(THROTTLE_KEY) - 1))
+    {
+	char *sp = strchr(data->value, ' ');
+	char type;
+	int rate;
+
+	if (!sp || sp - data->value < 4 ||
+	    strncmp("service-policy", data->value, sp - data->value))
+	    return PLUGIN_RET_OK;
+
+	while (*sp == ' ') sp++;
+	data->value = sp;
+
+	if (!(sp = strchr(data->value, ' ')) ||
+	    (strncmp("input", data->value, sp - data->value) &&
+	    strncmp("output", data->value, sp - data->value)))
+	{
+	    f->log(3, f->get_id_by_session(data->s), data->s->tunnel,
+		"         Not throttling user (invalid type %.*s)\n",
+		sp - data->value, data->value);
+
+	    return PLUGIN_RET_OK;
+	}
+
+	type = *data->value;
+
+	while (*sp == ' ') sp++;
+	data->value = sp;
+
+	if ((rate = strtol(data->value, &sp, 10)) < 0 || *sp)
+	{
+	    f->log(3, f->get_id_by_session(data->s), data->s->tunnel,
+		"         Not throttling user (invalid rate %s)\n",
+		data->value);
+
+	    return PLUGIN_RET_OK;
+	}
+
+	if (type == 'i')
+	{
+	    data->s->throttle_in = rate;
+	    f->log(3, f->get_id_by_session(data->s), data->s->tunnel,
+		"         Throttling user input to %dkb/s\n", rate);
+	}
+	else
+	{
+	    data->s->throttle_out = rate;
+	    f->log(3, f->get_id_by_session(data->s), data->s->tunnel,
+		    "         Throttling user output to %dkb/s\n", rate);
+	}
+    }
+    else if (!strcmp(data->key, "throttle"))
+    {
+	char *e;
 	int rate;
 
-	if (strncmp(data->key, THROTTLE_KEY, sizeof(THROTTLE_KEY) - 1) == 0)
+	if ((rate = strtol(data->value, &e, 10)) < 0 || *e)
 	{
-		char *pt;
-
-		if (strncmp(data->value, "serv", 4))
-			return PLUGIN_RET_OK;
-
-		pt = strdup(data->value);
-		while ((t = strsep(&pt, " ")) != NULL)
-		{
-			if (strcmp(t, "serv") == 0)
-				i = 1;
-			else if (strcmp(t, "o") == 0 && i == 1)
-				i = 3;
-			else if (strcmp(t, "i") == 0 && i == 1)
-				i = 2;
-			else if (i > 1 )
-			{
-				if ((rate = strtol(t, (char **)NULL, 10)) < 0 )
-				{
-					p->log(3, p->get_id_by_session(data->s), data->s->tunnel,
-						 "Syntax Error: rate is not a number %s\n", t);
-					free(pt);
-					return PLUGIN_RET_OK;
-				}
-
-				switch (i)
-				{
-					case 2: // output
-						data->s->throttle_out = rate;
-						free(pt);
-						p->log(3, p->get_id_by_session(data->s), data->s->tunnel,
-							"      Set output throttle rate %dkb/s\n", rate);
-
-						return PLUGIN_RET_OK;
-
-					case 3: //input
-						data->s->throttle_in = rate;
-						free(pt);
-						p->log(3, p->get_id_by_session(data->s), data->s->tunnel,
-							"      Set input throttle rate %dkb/s\n", rate);
-
-						return PLUGIN_RET_OK;
-
-					default:
-						p->log(1, p->get_id_by_session(data->s), data->s->tunnel,
-							"Syntax error in rate limit AV pair: %s=%s\n", data->key, data->value);
-
-						free(pt);
-						return PLUGIN_RET_OK;
-				}
-			}
-		}
-
-		p->log(3, p->get_id_by_session(data->s), data->s->tunnel,
-			"Unknown lcp:interface-config AV pair %s=%s\n",data->key, data->value);
-		free(pt);
-		return PLUGIN_RET_OK;
-	} 
-	else if (strcmp(data->key, "throttle") == 0)
+	    rate = -1;
+	    if (!strcmp(data->value, "yes"))
+	    {
+		unsigned long *ts = f->getconfig("throttle_speed", UNSIGNED_LONG);
+		if (ts)
+		    rate = *ts;
+	    }
+	    else if (!strcmp(data->value, "no"))
+		rate = 0;
+	}
+
+	if (rate < 0)
+	    return PLUGIN_RET_OK;
+
+	if (rate)
+	    f->log(3, f->get_id_by_session(data->s), data->s->tunnel,
+		"         Throttling user to %dkb/s\n", rate);
+	else
+	    f->log(3, f->get_id_by_session(data->s), data->s->tunnel,
+		"         Not throttling user\n");
+
+	data->s->throttle_in = data->s->throttle_out = rate;
+    }
+
+    return PLUGIN_RET_OK;
+}
+
+int plugin_radius_reset(struct param_radius_reset *data)
+{
+    f->throttle(f->get_id_by_session(data->s), 0, 0);
+    return PLUGIN_RET_OK;
+}
+
+int plugin_radius_account(struct param_radius_account *data)
+{
+    if (data->s->throttle_in || data->s->throttle_out)
+    {
+	uint8_t *p = *data->packet;
+	int i = 1;
+
+	if (data->s->throttle_in)
+	{
+	    *p = 26;				// vendor-specific
+	    *(uint32_t *) (p + 2) = htonl(9);	// Cisco
+	    p[6] = 1;				// Cisco-AVPair
+	    p[7] = 2 + sprintf((char *) p + 8,
+		"lcp:interface-config#%d=service-policy input %d", i++,
+		data->s->throttle_in);
+
+	    p[1] = p[7] + 6;
+	    p += p[1];
+	}
+
+	if (data->s->throttle_out)
 	{
-		if (strcmp(data->value, "yes") == 0)
-		{
-		    	unsigned long *rate = p->getconfig("throttle_speed", UNSIGNED_LONG);
-			if (rate)
-			{
-				if (*rate)
-					p->log(3, p->get_id_by_session(data->s), data->s->tunnel,
-						"         Throttling user to %dkb/s\n", *rate);
-				else
-					p->log(3, p->get_id_by_session(data->s), data->s->tunnel,
-						"         Not throttling user (throttle_speed=0)\n");
-
-				data->s->throttle_in = data->s->throttle_out = *rate;
-			}
-			else
-				p->log(1, p->get_id_by_session(data->s), data->s->tunnel,
-					"Not throttling user (can't get throttle_speed)\n");
-		}
-		else if (strcmp(data->value, "no") == 0)
-		{
-			p->log(3, p->get_id_by_session(data->s), data->s->tunnel,
-				"         Not throttling user\n");
-
-			data->s->throttle_in = data->s->throttle_out = 0;
-		}
+	    *p = 26;				// vendor-specific
+	    *(uint32_t *) (p + 2) = htonl(9);	// Cisco
+	    p[6] = 1;				// Cisco-AVPair
+	    p[7] = 2 + sprintf((char *) p + 8,
+		"lcp:interface-config#%d=service-policy output %d", i++,
+		data->s->throttle_out);
+
+	    p[1] = p[7] + 6;
+	    p += p[1];
 	}
 
-	p->log(4, p->get_id_by_session(data->s), data->s->tunnel,
-		"autothrottle module ignoring AV pair %s=%s\n",
-		data->key, data->value);
+	*data->packet = p;
+    }
 
-	return PLUGIN_RET_OK;
+    return PLUGIN_RET_OK;
 }
 
 int plugin_init(struct pluginfuncs *funcs)
 {
-	return ((p = funcs)) ? 1 : 0;
+    return ((f = funcs)) ? 1 : 0;
 }