106 lines
2.6 KiB
C
106 lines
2.6 KiB
C
|
/*
|
||
|
|
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;
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
|