pdock 60 test task

2020-11-23 11:42:22 +01:00
parent dd4cacb538
commit fcb328393b
323 changed files with 132 additions and 41250 deletions
--- a/gomspace/libcsp/src/csp_iflist.c
+++ b/gomspace/libcsp/src/csp_iflist.c
@ -0,0 +1,100 @@
+/*
+Cubesat Space Protocol - A small network-layer protocol designed for Cubesats
+Copyright (C) 2012 GomSpace ApS (http://www.gomspace.com)
+Copyright (C) 2012 AAUSAT3 Project (http://aausat3.space.aau.dk)
+
+This library is free software; you can redistribute it and/or
+modify it under the terms of the GNU Lesser General Public
+License as published by the Free Software Foundation; either
+version 2.1 of the License, or (at your option) any later version.
+
+This library 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
+Lesser General Public License for more details.
+
+You should have received a copy of the GNU Lesser General Public
+License along with this library; if not, write to the Free Software
+Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301  USA
+*/
+
+#include <stdio.h>
+#include <csp/csp.h>
+
+/* Interfaces are stored in a linked list*/
+static csp_iface_t * interfaces = NULL;
+
+csp_iface_t * csp_iflist_get_by_name(const char *name) {
+	csp_iface_t *ifc = interfaces;
+	while(ifc) {
+		if (strncmp(ifc->name, name, 10) == 0)
+			break;
+		ifc = ifc->next;
+	}
+	return ifc;
+}
+
+void csp_iflist_add(csp_iface_t *ifc) {
+
+	/* Add interface to pool */
+	if (interfaces == NULL) {
+		/* This is the first interface to be added */
+		interfaces = ifc;
+		ifc->next = NULL;
+	} else {
+		/* One or more interfaces were already added */
+		csp_iface_t * i = interfaces;
+		while (i != ifc && i->next)
+			i = i->next;
+
+		/* Insert interface last if not already in pool */
+		if (i != ifc && i->next == NULL) {
+			i->next = ifc;
+			ifc->next = NULL;
+		}
+	}
+
+}
+
+csp_iface_t * csp_iflist_get(void)
+{
+    return interfaces;
+}
+
+#ifdef CSP_DEBUG
+static int csp_bytesize(char *buf, int len, unsigned long int n) {
+	char postfix;
+	double size;
+
+	if (n >= 1048576) {
+		size = n/1048576.0;
+		postfix = 'M';
+	} else if (n >= 1024) {
+		size = n/1024.;
+		postfix = 'K';
+	} else {
+		size = n;
+		postfix = 'B';
+ 	}
+ 
+	return snprintf(buf, len, "%.1f%c", size, postfix);
+}
+
+void csp_iflist_print(void) {
+	csp_iface_t * i = interfaces;
+	char txbuf[25], rxbuf[25];
+
+	while (i) {
+		csp_bytesize(txbuf, 25, i->txbytes);
+		csp_bytesize(rxbuf, 25, i->rxbytes);
+		printf("%-5s   tx: %05"PRIu32" rx: %05"PRIu32" txe: %05"PRIu32" rxe: %05"PRIu32"\r\n"
+		       "        drop: %05"PRIu32" autherr: %05"PRIu32 " frame: %05"PRIu32"\r\n"
+		       "        txb: %"PRIu32" (%s) rxb: %"PRIu32" (%s)\r\n\r\n",
+		       i->name, i->tx, i->rx, i->tx_error, i->rx_error, i->drop,
+		       i->autherr, i->frame, i->txbytes, txbuf, i->rxbytes, rxbuf);
+		i = i->next;
+	}
+
+}
+#endif
+