Initial commit

FossilOrigin-Name: c53d95729c009f8f80a7d63847cef7668ff73f8af0523ab65f7734696f85399c

src/capwap/conn_q_add_packet.c

@@ -0,0 +1,50 @@
+/*
+    This file is part of libcapwap.
+
+    libcapwap is free software: you can redistribute it and/or modify
+    it under the terms of the GNU General Public License as published by
+    the Free Software Foundation, either version 3 of the License, or
+    (at your option) any later version.
+
+    libcapwap is distributed in the hope that it will be useful,
+    but WITHOUT ANY WARRANTY; without even the implied warranty of
+    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+    GNU General Public License for more details.
+
+    You should have received a copy of the GNU General Public License
+    along with Foobar.  If not, see <http://www.gnu.org/licenses/>.
+
+*/
+
+#include <stdlib.h>
+#include <string.h>
+
+#include "cw_log.h"
+#include "conn.h"
+
+
+void conn_q_add_packet(struct conn * conn,uint8_t *packet,int len)
+{
+	int qwpos = conn->qwpos;
+	if (qwpos==conn->qsize)
+		qwpos=0;
+
+	if (conn->qrpos==qwpos){
+		/* no buffers, discard packet */
+		cw_log_debug0( "Discarding packet, no queu buffers left");
+		return;
+	}
+
+	conn->q[qwpos]=malloc(len+4);
+	if (conn->q[qwpos]==NULL)
+		return;
+	
+	*((uint32_t*)(conn->q[qwpos]))=len;
+	memcpy(conn->q[qwpos]+4,packet,len);	
+	conn->qwpos=qwpos+1;
+
+	sem_post(&conn->q_sem);
+}
+
+
+