X-Git-Url: http://git.sameswireless.fr/l2tpns.git/blobdiff_plain/ec1507a6c2f477e81050e5540fceed50c7bf7432..4ac1a263960dd8d535dcc15f30856d07c01ac2e4:/l2tpns.c

diff --git a/l2tpns.c b/l2tpns.c
index 1a37a0a..527175c 100644
--- a/l2tpns.c
+++ b/l2tpns.c
@@ -1819,10 +1819,10 @@ static void send_ipout(sessionidt s, uint8_t *buf, int len)
 static void control16(controlt * c, uint16_t avp, uint16_t val, uint8_t m)
 {
 	uint16_t l = (m ? 0x8008 : 0x0008);
-	c->buf16[c->length/2 + 0] = htons(l);
-	c->buf16[c->length/2 + 1] = htons(0);
-	c->buf16[c->length/2 + 2] = htons(avp);
-	c->buf16[c->length/2 + 3] = htons(val);
+	*(uint16_t *) (c->buf + c->length + 0) = htons(l);
+	*(uint16_t *) (c->buf + c->length + 2) = htons(0);
+	*(uint16_t *) (c->buf + c->length + 4) = htons(avp);
+	*(uint16_t *) (c->buf + c->length + 6) = htons(val);
 	c->length += 8;
 }
 
@@ -1830,10 +1830,10 @@ static void control16(controlt * c, uint16_t avp, uint16_t val, uint8_t m)
 static void control32(controlt * c, uint16_t avp, uint32_t val, uint8_t m)
 {
 	uint16_t l = (m ? 0x800A : 0x000A);
-	c->buf16[c->length/2 + 0] = htons(l);
-	c->buf16[c->length/2 + 1] = htons(0);
-	c->buf16[c->length/2 + 2] = htons(avp);
-	*(uint32_t *) &c->buf[c->length + 6] = htonl(val);
+	*(uint16_t *) (c->buf + c->length + 0) = htons(l);
+	*(uint16_t *) (c->buf + c->length + 2) = htons(0);
+	*(uint16_t *) (c->buf + c->length + 4) = htons(avp);
+	*(uint32_t *) (c->buf + c->length + 6) = htonl(val);
 	c->length += 10;
 }
 
@@ -1841,10 +1841,10 @@ static void control32(controlt * c, uint16_t avp, uint32_t val, uint8_t m)
 static void controls(controlt * c, uint16_t avp, char *val, uint8_t m)
 {
 	uint16_t l = ((m ? 0x8000 : 0) + strlen(val) + 6);
-	c->buf16[c->length/2 + 0] = htons(l);
-	c->buf16[c->length/2 + 1] = htons(0);
-	c->buf16[c->length/2 + 2] = htons(avp);
-	memcpy(&c->buf[c->length + 6], val, strlen(val));
+	*(uint16_t *) (c->buf + c->length + 0) = htons(l);
+	*(uint16_t *) (c->buf + c->length + 2) = htons(0);
+	*(uint16_t *) (c->buf + c->length + 4) = htons(avp);
+	memcpy(c->buf + c->length + 6, val, strlen(val));
 	c->length += 6 + strlen(val);
 }
 
@@ -1852,10 +1852,10 @@ static void controls(controlt * c, uint16_t avp, char *val, uint8_t m)
 static void controlb(controlt * c, uint16_t avp, uint8_t *val, unsigned int len, uint8_t m)
 {
 	uint16_t l = ((m ? 0x8000 : 0) + len + 6);
-	c->buf16[c->length/2 + 0] = htons(l);
-	c->buf16[c->length/2 + 1] = htons(0);
-	c->buf16[c->length/2 + 2] = htons(avp);
-	memcpy(&c->buf[c->length + 6], val, len);
+	*(uint16_t *) (c->buf + c->length + 0) = htons(l);
+	*(uint16_t *) (c->buf + c->length + 2) = htons(0);
+	*(uint16_t *) (c->buf + c->length + 4) = htons(avp);
+	memcpy(c->buf + c->length + 6, val, len);
 	c->length += 6 + len;
 }
 
@@ -1872,7 +1872,8 @@ static controlt *controlnew(uint16_t mtype)
 	}
 	assert(c);
 	c->next = 0;
-	c->buf16[0] = htons(0xC802); // flags/ver
+	c->buf[0] = 0xC8; // flags
+	c->buf[1] = 0x02; // ver
 	c->length = 12;
 	control16(c, 0, mtype, 1);
 	return c;
@@ -1898,10 +1899,10 @@ static void controlnull(tunnelidt t)
 // add a control message to a tunnel, and send if within window
 static void controladd(controlt *c, sessionidt far, tunnelidt t)
 {
-	c->buf16[1] = htons(c->length); // length
-	c->buf16[2] = htons(tunnel[t].far); // tunnel
-	c->buf16[3] = htons(far); // session
-	c->buf16[4] = htons(tunnel[t].ns); // sequence
+	*(uint16_t *) (c->buf + 2) = htons(c->length); // length
+	*(uint16_t *) (c->buf + 4) = htons(tunnel[t].far); // tunnel
+	*(uint16_t *) (c->buf + 6) = htons(far); // session
+	*(uint16_t *) (c->buf + 8) = htons(tunnel[t].ns); // sequence
 	tunnel[t].ns++;              // advance sequence
 	// link in message in to queue
 	if (tunnel[t].controlc)