ppp: implement address/control and protocol field compression

1 files changed, 99 insertions, 45 deletions

diff --git a/accel-pppd/ppp/lcp_opt_pcomp.c b/accel-pppd/ppp/lcp_opt_pcomp.c
index fec5e7b..e034622 100644
--- a/accel-pppd/ppp/lcp_opt_pcomp.c
+++ b/accel-pppd/ppp/lcp_opt_pcomp.c
@@ -1,107 +1,161 @@
 #include <stdlib.h>
 #include <string.h>
+#include <errno.h>
 #include <arpa/inet.h>
+#include <sys/ioctl.h>
+#include "linux_ppp.h"
 
 #include "ppp.h"
 #include "ppp_lcp.h"
 #include "log.h"
+#include "events.h"
 
 #include "memdebug.h"
 
+static int conf_pcomp = 0;
+
 static struct lcp_option_t *pcomp_init(struct ppp_lcp_t *lcp);
 static void pcomp_free(struct ppp_lcp_t *lcp, struct lcp_option_t *opt);
 static int pcomp_send_conf_req(struct ppp_lcp_t *lcp, struct lcp_option_t *opt, uint8_t *ptr);
-static int pcomp_send_conf_nak(struct ppp_lcp_t *lcp, struct lcp_option_t *opt, uint8_t *ptr);
 static int pcomp_recv_conf_req(struct ppp_lcp_t *lcp, struct lcp_option_t *opt, uint8_t *ptr);
-static void pcomp_print(void (*print)(const char *fmt,...),struct lcp_option_t*, uint8_t *ptr);
+static int pcomp_recv_conf_rej(struct ppp_lcp_t *lcp, struct lcp_option_t *opt, uint8_t *ptr);
+static int pcomp_recv_conf_nak(struct ppp_lcp_t *lcp, struct lcp_option_t *opt, uint8_t *ptr);
+static int pcomp_recv_conf_ack(struct ppp_lcp_t *lcp, struct lcp_option_t *opt, uint8_t *ptr);
+static void pcomp_print(void (*print)(const char *fmt, ...), struct lcp_option_t *opt, uint8_t *ptr);
 
 struct pcomp_option_t
 {
 	struct lcp_option_t opt;
 	int pcomp; // 0 - disabled, 1 - enabled, 2 - allow,disabled, 3 - allow,enabled
-	int require;
 };
 
-static struct lcp_option_handler_t pcomp_opt_hnd=
+static struct lcp_option_handler_t pcomp_opt_hnd =
 {
-	.init=pcomp_init,
-	.send_conf_req=pcomp_send_conf_req,
-	.send_conf_nak=pcomp_send_conf_nak,
-	.recv_conf_req=pcomp_recv_conf_req,
-	.free=pcomp_free,
-	.print=pcomp_print,
+	.init = pcomp_init,
+	.send_conf_req = pcomp_send_conf_req,
+	.recv_conf_req = pcomp_recv_conf_req,
+	.recv_conf_rej = pcomp_recv_conf_rej,
+	.recv_conf_nak = pcomp_recv_conf_nak,
+	.recv_conf_ack = pcomp_recv_conf_ack,
+	.free = pcomp_free,
+	.print = pcomp_print,
 };
 
 static struct lcp_option_t *pcomp_init(struct ppp_lcp_t *lcp)
 {
-	struct pcomp_option_t *pcomp_opt=_malloc(sizeof(*pcomp_opt));
-	memset(pcomp_opt,0,sizeof(*pcomp_opt));
-	pcomp_opt->pcomp=0;
-	pcomp_opt->opt.id=CI_PCOMP;
-	pcomp_opt->opt.len=2;
+	struct pcomp_option_t *pcomp_opt = _malloc(sizeof(*pcomp_opt));
+
+	memset(pcomp_opt, 0, sizeof(*pcomp_opt));
+	pcomp_opt->pcomp = conf_pcomp;
+	pcomp_opt->opt.id = CI_PCOMP;
+	pcomp_opt->opt.len = 2;
 
 	return &pcomp_opt->opt;
 }
 
 static void pcomp_free(struct ppp_lcp_t *lcp, struct lcp_option_t *opt)
 {
-	struct pcomp_option_t *pcomp_opt=container_of(opt,typeof(*pcomp_opt),opt);
+	struct pcomp_option_t *pcomp_opt = container_of(opt, typeof(*pcomp_opt), opt);
 
 	_free(pcomp_opt);
 }
 
 static int pcomp_send_conf_req(struct ppp_lcp_t *lcp, struct lcp_option_t *opt, uint8_t *ptr)
 {
-	struct pcomp_option_t *pcomp_opt=container_of(opt,typeof(*pcomp_opt),opt);
-	struct lcp_opt_hdr_t *opt0=(struct lcp_opt_hdr_t*)ptr;
-	if (pcomp_opt->pcomp==1 || pcomp_opt->pcomp==3)
-	{
-		opt0->id=CI_PCOMP;
-		opt0->len=2;
+	struct pcomp_option_t *pcomp_opt = container_of(opt, typeof(*pcomp_opt), opt);
+	struct lcp_opt_hdr_t *opt0 = (struct lcp_opt_hdr_t*)ptr;
+
+	if (pcomp_opt->pcomp & 1) {
+		opt0->id = CI_PCOMP;
+		opt0->len = 2;
 		return 2;
 	}
 	return 0;
 }
 
-static int pcomp_send_conf_nak(struct ppp_lcp_t *lcp, struct lcp_option_t *opt, uint8_t *ptr)
-{
-	struct pcomp_option_t *pcomp_opt=container_of(opt,typeof(*pcomp_opt),opt);
-	struct lcp_opt_hdr_t *opt0=(struct lcp_opt_hdr_t*)ptr;
-	opt0->id=CI_PCOMP;
-	opt0->len=2;
-	return 2;
-}
-
 static int pcomp_recv_conf_req(struct ppp_lcp_t *lcp, struct lcp_option_t *opt, uint8_t *ptr)
 {
-	struct pcomp_option_t *pcomp_opt=container_of(opt,typeof(*pcomp_opt),opt);
-	struct lcp_opt_hdr_t *opt0=(struct lcp_opt_hdr_t*)ptr;
+	struct pcomp_option_t *pcomp_opt = container_of(opt, typeof(*pcomp_opt), opt);
+	struct lcp_opt_hdr_t *opt0 = (struct lcp_opt_hdr_t*)ptr;
 
-	/*if (!ptr) {
-		if (pcomp_opt->require)
-			return LCP_OPT_NAK;
-		pcomp_opt->pcomp=0;
-		return LCP_OPT_ACK;
-	}*/
-	
 	if (opt0->len != 2)
 		return LCP_OPT_REJ;
 
-	if (pcomp_opt->pcomp>0)
-	{
-		pcomp_opt->pcomp=1;
+	if (pcomp_opt->pcomp & 2)
 		return LCP_OPT_ACK;
-	}else return LCP_OPT_REJ;
+	else
+		return LCP_OPT_REJ;
 }
 
-static void pcomp_print(void (*print)(const char *fmt,...),struct lcp_option_t *opt, uint8_t *ptr)
+static int pcomp_recv_conf_rej(struct ppp_lcp_t *lcp, struct lcp_option_t *opt, uint8_t *ptr)
+{
+	struct pcomp_option_t *pcomp_opt = container_of(opt, typeof(*pcomp_opt), opt);
+
+	pcomp_opt->pcomp &= ~1;
+	return 0;
+}
+
+static int pcomp_recv_conf_nak(struct ppp_lcp_t *lcp, struct lcp_option_t *opt, uint8_t *ptr)
+{
+	struct pcomp_option_t *pcomp_opt = container_of(opt, typeof(*pcomp_opt), opt);
+	struct lcp_opt_hdr_t *opt0 = (struct lcp_opt_hdr_t*)ptr;
+
+	if (opt0->len != 2)
+		return -1;
+
+	/* treat as reject */
+	return pcomp_recv_conf_rej(lcp, opt, ptr);
+}
+
+static int pcomp_recv_conf_ack(struct ppp_lcp_t *lcp, struct lcp_option_t *opt, uint8_t *ptr)
+{
+	struct pcomp_option_t *pcomp_opt = container_of(opt, typeof(*pcomp_opt), opt);
+	int flags;
+
+	if (ioctl(lcp->ppp->chan_fd, PPPIOCGFLAGS, &flags))
+		goto err;
+
+	flags &= ~SC_COMP_AC;
+	if (pcomp_opt->pcomp & 1)
+		flags |= SC_COMP_AC;
+
+	if (ioctl(lcp->ppp->chan_fd, PPPIOCSFLAGS, &flags))
+		goto err;
+
+	return 0;
+
+err:
+	if (errno != EIO)
+		log_ppp_error("lcp:pcomp: failed to set channel ACCOMP: %s\n", strerror(errno));
+	return -1;
+}
+
+static void pcomp_print(void (*print)(const char *fmt, ...), struct lcp_option_t *opt, uint8_t *ptr)
 {
 	print("<pcomp>");
 }
 
+static void load_config(void)
+{
+	char *opt;
+	
+	opt = conf_get_opt("ppp", "pcomp");
+	if (opt) {
+		if (!strcmp(opt, "deny"))
+			conf_pcomp = 0;
+		else if (!strcmp(opt, "allow"))
+			conf_pcomp = 1 | 2;
+		else
+			conf_pcomp = atoi(opt);
+	}
+}
+
 static void pcomp_opt_init()
 {
 	lcp_option_register(&pcomp_opt_hnd);
+
+	load_config();
+	triton_event_register_handler(EV_CONFIG_RELOAD, (triton_event_func)load_config);
 }
 
 DEFINE_INIT(4, pcomp_opt_init);