diff options
Diffstat (limited to 'src/host/layer2/src/layer2_main.c')
-rw-r--r-- | src/host/layer2/src/layer2_main.c | 205 |
1 files changed, 205 insertions, 0 deletions
diff --git a/src/host/layer2/src/layer2_main.c b/src/host/layer2/src/layer2_main.c new file mode 100644 index 00000000..c84cce49 --- /dev/null +++ b/src/host/layer2/src/layer2_main.c @@ -0,0 +1,205 @@ +/* Main method of the layer2 stack */ +/* (C) 2010 by Holger Hans Peter Freyther + * + * All Rights Reserved + * + * This program 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 2 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 General Public License for more details. + * + * You should have received a copy of the GNU General Public License along + * with this program; if not, write to the Free Software Foundation, Inc., + * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. + * + */ + +#include <osmocom/osmocom_layer2.h> +#include <osmocom/osmocom_data.h> + +#include <osmocom/debug.h> +#include <osmocom/msgb.h> +#include <osmocom/talloc.h> + +#include <arpa/inet.h> + +#include <sys/socket.h> +#include <sys/un.h> + +#define _GNU_SOURCE +#include <getopt.h> +#include <stdlib.h> +#include <unistd.h> +#include <errno.h> +#include <fcntl.h> + +#define GSM_L2_LENGTH 256 + +static void *l2_ctx = NULL; +static char *socket_path = "/tmp/osmocom_l2"; +static struct osmocom_ms *ms = NULL; + +static int layer2_read(struct bsc_fd *fd, unsigned int flags) +{ + struct msgb *msg; + u_int16_t len; + int rc; + + msg = msgb_alloc(GSM_L2_LENGTH, "Layer2"); + if (!msg) { + fprintf(stderr, "Failed to allocate msg.\n"); + return -1; + } + + rc = read(fd->fd, &len, sizeof(len)); + if (rc < sizeof(len)) { + fprintf(stderr, "Short read. Error.\n"); + exit(2); + } + + if (ntohs(len) > GSM_L2_LENGTH) { + fprintf(stderr, "Length is too big: %u\n", ntohs(len)); + msgb_free(msg); + return -1; + } + + + /* blocking read for the poor... we can starve in here... */ + msg->l2h = msgb_put(msg, ntohs(len)); + rc = read(fd->fd, msg->l2h, msgb_l2len(msg)); + if (rc != msgb_l2len(msg)) { + fprintf(stderr, "Can not read data: rc: %d errno: %d\n", rc, errno); + msgb_free(msg); + return -1; + } + + osmo_recv((struct osmocom_ms *) fd->data, msg); + msgb_free(msg); + return 0; +} + +int osmo_send_l1(struct osmocom_ms *ms, struct msgb *msg) +{ + int rc; + uint16_t *len; + + LOGP(DMUX, LOGL_INFO, "Sending: '%s'\n", hexdump(msg->data, msg->len)); + + + len = (uint16_t *) msgb_push(msg, sizeof(*len)); + *len = htons(msg->len - sizeof(*len)); + + /* TODO: just enqueue the message and wait for ready write.. */ + rc = write(ms->bfd.fd, msg->data, msg->len); + if (rc != msg->len) { + fprintf(stderr, "Failed to write data: rc: %d\n", rc); + msgb_free(msg); + return -1; + } + + msgb_free(msg); + return 0; +} + +static void print_usage() +{ + printf("Usage: ./layer2\n"); +} + +static void print_help() +{ + printf(" Some help...\n"); + printf(" -h --help this text\n"); + printf(" -s --socket /tmp/osmocom_l2. Path to the unix domain socket\n"); + printf(" -a --arfcn NR. The ARFCN to be used for layer2.\n"); +} + +static void handle_options(int argc, char **argv) +{ + while (1) { + int option_index = 0, c; + static struct option long_options[] = { + {"help", 0, 0, 'h'}, + {"socket", 1, 0, 's'}, + {"arfcn", 1, 0, 'a'}, + {0, 0, 0, 0}, + }; + + c = getopt_long(argc, argv, "hs:a:", + long_options, &option_index); + if (c == -1) + break; + + switch (c) { + case 'h': + print_usage(); + print_help(); + exit(0); + break; + case 's': + socket_path = talloc_strdup(l2_ctx, optarg); + break; + case 'a': + ms->arfcn = atoi(optarg); + break; + default: + break; + } + } +} + +int main(int argc, char **argv) +{ + int rc; + struct sockaddr_un local; + + l2_ctx = talloc_named_const(NULL, 1, "layer2 context"); + + ms = talloc_zero(l2_ctx, struct osmocom_ms); + if (!ms) { + fprintf(stderr, "Failed to allocate MS\n"); + exit(1); + } + + ms->arfcn = 871; + + handle_options(argc, argv); + + ms->bfd.fd = socket(AF_UNIX, SOCK_STREAM, 0); + if (ms->bfd.fd < 0) { + fprintf(stderr, "Failed to create unix domain socket.\n"); + exit(1); + } + + local.sun_family = AF_UNIX; + strncpy(local.sun_path, socket_path, sizeof(local.sun_path)); + local.sun_path[sizeof(local.sun_path) - 1] = '\0'; + + rc = connect(ms->bfd.fd, (struct sockaddr *) &local, + sizeof(local.sun_family) + strlen(local.sun_path)); + if (rc < 0) { + fprintf(stderr, "Failed to connect to '%s'.\n", local.sun_path); + exit(1); + } + + ms->bfd.when = BSC_FD_READ; + ms->bfd.cb = layer2_read; + ms->bfd.data = ms; + + if (bsc_register_fd(&ms->bfd) != 0) { + fprintf(stderr, "Failed to register fd.\n"); + exit(1); + } + + while (1) { + bsc_select_main(0); + } + + + return 0; +} |