issue with makefile
This commit is contained in:
105
libcsp/src/csp_port.c
Normal file
105
libcsp/src/csp_port.c
Normal file
@ -0,0 +1,105 @@
|
||||
/*
|
||||
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 <stdlib.h>
|
||||
#include <stdio.h>
|
||||
#include <string.h>
|
||||
|
||||
/* CSP includes */
|
||||
#include <csp/csp.h>
|
||||
#include <csp/csp_error.h>
|
||||
|
||||
#include <csp/arch/csp_thread.h>
|
||||
#include <csp/arch/csp_queue.h>
|
||||
#include <csp/arch/csp_semaphore.h>
|
||||
|
||||
#include "csp_port.h"
|
||||
#include "csp_conn.h"
|
||||
|
||||
/* Allocation of ports */
|
||||
static csp_port_t ports[CSP_MAX_BIND_PORT + 2];
|
||||
|
||||
csp_socket_t * csp_port_get_socket(unsigned int port) {
|
||||
|
||||
csp_socket_t * ret = NULL;
|
||||
|
||||
if (port >= CSP_ANY)
|
||||
return NULL;
|
||||
|
||||
/* Match dport to socket or local "catch all" port number */
|
||||
if (ports[port].state == PORT_OPEN)
|
||||
ret = ports[port].socket;
|
||||
else if (ports[CSP_ANY].state == PORT_OPEN)
|
||||
ret = ports[CSP_ANY].socket;
|
||||
|
||||
return ret;
|
||||
|
||||
}
|
||||
|
||||
int csp_port_init(void) {
|
||||
|
||||
memset(ports, PORT_CLOSED, sizeof(csp_port_t) * (CSP_MAX_BIND_PORT + 2));
|
||||
|
||||
return CSP_ERR_NONE;
|
||||
|
||||
}
|
||||
|
||||
int csp_listen(csp_socket_t * socket, size_t conn_queue_length) {
|
||||
|
||||
if (socket == NULL)
|
||||
return CSP_ERR_INVAL;
|
||||
|
||||
socket->socket = csp_queue_create(conn_queue_length, sizeof(csp_conn_t *));
|
||||
if (socket->socket == NULL)
|
||||
return CSP_ERR_NOMEM;
|
||||
|
||||
socket->opts |= CSP_SO_INTERNAL_LISTEN;
|
||||
|
||||
return CSP_ERR_NONE;
|
||||
|
||||
}
|
||||
|
||||
int csp_bind(csp_socket_t * socket, uint8_t port) {
|
||||
|
||||
if (socket == NULL)
|
||||
return CSP_ERR_INVAL;
|
||||
|
||||
if (port > CSP_ANY) {
|
||||
csp_log_error("Only ports from 0-%u (and CSP_ANY for default) are available for incoming ports", CSP_ANY);
|
||||
return CSP_ERR_INVAL;
|
||||
}
|
||||
|
||||
/* Check if port number is valid */
|
||||
if (ports[port].state != PORT_CLOSED) {
|
||||
csp_log_error("Port %d is already in use", port);
|
||||
return CSP_ERR_USED;
|
||||
}
|
||||
|
||||
csp_log_info("Binding socket %p to port %u", socket, port);
|
||||
|
||||
/* Save listener */
|
||||
ports[port].socket = socket;
|
||||
ports[port].state = PORT_OPEN;
|
||||
|
||||
return CSP_ERR_NONE;
|
||||
|
||||
}
|
||||
|
||||
|
Reference in New Issue
Block a user