From 98dd096e46c3e936e9850531fae22bcb0bc8c059 Mon Sep 17 00:00:00 2001
From: "7u83@mail.ru" <7u83@mail.ru@noemail.net>
Date: Mon, 23 Mar 2015 21:31:59 +0000
Subject: [PATCH] Tmp ...

FossilOrigin-Name: f70c860593b308486ebee367077241a847581e6ec5a27550eb7410ababdcd3a4
---
 src/capwap/lw_addelem.c | 61 +++++++++++++++++++++++++++++++++++++++++
 1 file changed, 61 insertions(+)
 create mode 100644 src/capwap/lw_addelem.c

diff --git a/src/capwap/lw_addelem.c b/src/capwap/lw_addelem.c
new file mode 100644
index 00000000..3f5a1b6a
--- /dev/null
+++ b/src/capwap/lw_addelem.c
@@ -0,0 +1,61 @@
+#include <string.h>
+
+
+#include "lwapp.h"
+#include "lwapp_cisco.h"
+
+
+
+int lw_addelem(uint8_t*dst, uint8_t type, uint8_t *msgelem, uint16_t len)
+{
+	*dst = type;
+	*((uint16_t*)(dst+1)) = htons(len);
+	memcpy(dst,msgelem,len);
+	return len+3;
+}
+
+
+
+int lw_addelem_vendor_specific(uint8_t *dst,uint32_t vendor_id,uint16_t elem_id, uint8_t *value, int len)
+{
+	lw_put_dword(dst+3,vendor_id);
+	lw_put_word(dst+7,elem_id);
+	memcpy(dst+9,value,len);
+	int l = len+9;
+	*dst=LW_ELEM_VENDOR_SPECIFIC;
+	lw_put_word(dst+1,l);	
+	return l;	
+}
+
+/**
+ * Add the vendor specific elem Cisco Padding
+ * @param dst destination
+ */ 
+int lw_addelem_cisco_padding(uint8_t *dst, int len)
+{
+	lw_put_dword(dst+3,LW_VENDOR_CISCO);
+	lw_put_word(dst+7,LW_ELEM_CISCO_PATH_MTU);
+	lw_put_word(dst+9,len);
+	memset(dst+11,0,len);
+	return lw_put_elem_hdr(dst,LW_ELEM_VENDOR_SPECIFIC,11+len);
+}
+
+int lw_put_cisco_path_mtu(uint8_t *dst, uint16_t max, uint16_t padding)
+{
+	lw_put_dword(dst,LW_VENDOR_CISCO);
+	lw_put_word(dst+4,LW_ELEM_CISCO_PATH_MTU);
+	lw_put_word(dst+6,max);
+	lw_put_word(dst+8,padding+4);
+	memset(dst+10,0,padding);
+	return padding+10;
+}
+
+
+/*
+int lw_addelem_cisco_path_mtu(uint8_t *dst,uint16_t max, uint16_t padding)
+{
+	lw_put_cisco_path_mtu(dst+3,max,padding);
+}
+
+*/
+