86 lines
2.2 KiB
C
86 lines
2.2 KiB
C
/* (C) 2016 by Harald Welte <laforge@gnumonks.org>
|
|
*
|
|
* All Rights Reserved
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU Affero General Public License as published by
|
|
* the Free Software Foundation; either version 3 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program 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 Affero General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU Affero General Public License
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
*
|
|
*/
|
|
|
|
|
|
#include <errno.h>
|
|
|
|
#include <osmocom/core/linuxlist.h>
|
|
#include <osmocom/core/talloc.h>
|
|
|
|
#include "gsup_server.h"
|
|
|
|
struct gsup_route {
|
|
struct llist_head list;
|
|
|
|
uint8_t *addr;
|
|
struct osmo_gsup_conn *conn;
|
|
};
|
|
|
|
/* find a route for the given address */
|
|
struct osmo_gsup_conn *gsup_route_find(struct osmo_gsup_server *gs,
|
|
const uint8_t *addr, size_t addrlen)
|
|
{
|
|
struct gsup_route *gr;
|
|
|
|
llist_for_each_entry(gr, &gs->routes, list) {
|
|
if (talloc_total_size(gr->addr) == addrlen &&
|
|
!memcmp(gr->addr, addr, addrlen))
|
|
return gr->conn;
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
/* add a new route for the given address to the given conn */
|
|
int gsup_route_add(struct osmo_gsup_conn *conn, const uint8_t *addr, size_t addrlen)
|
|
{
|
|
struct gsup_route *gr;
|
|
|
|
/* Check if we already have a route for this address */
|
|
if (gsup_route_find(conn->server, addr, addrlen))
|
|
return -EEXIST;
|
|
|
|
/* allocate new route and populate it */
|
|
gr = talloc_zero(conn->server, struct gsup_route);
|
|
if (!gr)
|
|
return -ENOMEM;
|
|
|
|
gr->addr = talloc_memdup(gr, addr, addrlen);
|
|
gr->conn = conn;
|
|
llist_add_tail(&gr->list, &conn->server->routes);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* delete all routes for the given connection */
|
|
int gsup_route_del_conn(struct osmo_gsup_conn *conn)
|
|
{
|
|
struct gsup_route *gr, *gr2;
|
|
unsigned int num_deleted = 0;
|
|
|
|
llist_for_each_entry_safe(gr, gr2, &conn->server->routes, list) {
|
|
if (gr->conn == conn) {
|
|
llist_del(&gr->list);
|
|
talloc_free(gr);
|
|
num_deleted++;
|
|
}
|
|
}
|
|
|
|
return num_deleted;
|
|
}
|