diff options
Diffstat (limited to 'src/host/layer23/src/transceiver/l1ctl_link.c')
-rw-r--r-- | src/host/layer23/src/transceiver/l1ctl_link.c | 187 |
1 files changed, 187 insertions, 0 deletions
diff --git a/src/host/layer23/src/transceiver/l1ctl_link.c b/src/host/layer23/src/transceiver/l1ctl_link.c new file mode 100644 index 00000000..5ec83e42 --- /dev/null +++ b/src/host/layer23/src/transceiver/l1ctl_link.c @@ -0,0 +1,187 @@ +/* + * l1ctl_link.c + * + * L1CTL link handling + * + * Copyright (C) 2013 Sylvain Munaut <tnt@246tNt.com> + * + * 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 <string.h> +#include <unistd.h> + +#include <sys/socket.h> +#include <sys/un.h> +#include <arpa/inet.h> + +#include <osmocom/core/write_queue.h> + +#include <osmocom/bb/common/logging.h> + +#include "l1ctl_link.h" + + +#define L1CTL_LENGTH 256 +#define L1CTL_HEADROOM 32 + +static int +_l1l_read(struct osmo_fd *fd) +{ + struct l1ctl_link *l1l = fd->data; + struct msgb *msg; + uint16_t len; + int rc; + + msg = msgb_alloc_headroom(L1CTL_LENGTH+L1CTL_HEADROOM, L1CTL_HEADROOM, "L1CTL"); + if (!msg) { + LOGP(DL1C, LOGL_ERROR, "Failed to allocate msg.\n"); + return -ENOMEM; + } + + rc = read(fd->fd, &len, sizeof(len)); + if (rc < sizeof(len)) { + LOGP(DL1C, LOGL_ERROR, "l1ctl socket failed\n"); + msgb_free(msg); + if (rc >= 0) + rc = -EIO; + l1l_close(l1l); + return rc; + } + + len = ntohs(len); + if (len > L1CTL_LENGTH) { + LOGP(DL1C, LOGL_ERROR, "Length is too big: %u\n", len); + msgb_free(msg); + return -EINVAL; + } + + + msg->l1h = msgb_put(msg, len); + rc = read(fd->fd, msg->l1h, msgb_l1len(msg)); + if (rc != msgb_l1len(msg)) { + LOGP(DL1C, LOGL_ERROR, "Can not read data: len=%d rc=%d " + "errno=%d\n", len, rc, errno); + msgb_free(msg); + return rc; + } + + return l1l->cb(l1l->cb_data, msg); +} + +static int +_l1l_write(struct osmo_fd *fd, struct msgb *msg) +{ + int rc; + + if (fd->fd <= 0) + return -EINVAL; + + rc = write(fd->fd, msg->data, msg->len); + if (rc != msg->len) { + LOGP(DL1C, LOGL_ERROR, "Failed to write data: rc: %d\n", rc); + return rc; + } + + return 0; +} + + +int +l1l_open(struct l1ctl_link *l1l, + const char *path, l1ctl_cb_t cb, void *cb_data) +{ + int rc, fd; + struct sockaddr_un local; + + l1l->cb = cb; + l1l->cb_data = cb_data; + + fd = socket(AF_UNIX, SOCK_STREAM, 0); + if (fd < 0) { + LOGP(DL1C, LOGL_ERROR, "Failed to create unix domain socket.\n"); + return fd; + } + + l1l->wq.bfd.fd = fd; + + local.sun_family = AF_UNIX; + strncpy(local.sun_path, path, sizeof(local.sun_path)); + local.sun_path[sizeof(local.sun_path) - 1] = '\0'; + + rc = connect(fd, (struct sockaddr *) &local, sizeof(local)); + if (rc < 0) { + LOGP(DL1C, LOGL_ERROR, "Failed to connect to '%s': %s\n", + local.sun_path, strerror(errno)); + close(fd); + return rc; + } + + osmo_wqueue_init(&l1l->wq, 100); + l1l->wq.bfd.data = l1l; + l1l->wq.bfd.when = BSC_FD_READ; + l1l->wq.read_cb = _l1l_read; + l1l->wq.write_cb = _l1l_write; + + rc = osmo_fd_register(&l1l->wq.bfd); + if (rc != 0) { + LOGP(DL1C, LOGL_ERROR, "Failed to register fd.\n"); + close(fd); + return rc; + } + + return 0; +} + +int +l1l_close(struct l1ctl_link *l1l) +{ + if (l1l->wq.bfd.fd <= 0) + return -EINVAL; + + osmo_fd_unregister(&l1l->wq.bfd); + + close(l1l->wq.bfd.fd); + l1l->wq.bfd.fd = -1; + + osmo_wqueue_clear(&l1l->wq); + + return 0; +} + +int +l1l_send(struct l1ctl_link *l1l, struct msgb *msg) +{ + uint16_t *len; + + DEBUGP(DL1C, "Sending: '%s'\n", osmo_hexdump(msg->data, msg->len)); + + if (msg->l1h != msg->data) + LOGP(DL1C, LOGL_NOTICE, "Message L1 header != Message Data\n"); + + /* prepend 16bit length before sending */ + len = (uint16_t *) msgb_push(msg, sizeof(*len)); + *len = htons(msg->len - sizeof(*len)); + + if (osmo_wqueue_enqueue(&l1l->wq, msg) != 0) { + LOGP(DL1C, LOGL_ERROR, "Failed to enqueue msg.\n"); + msgb_free(msg); + return -EIO; + } + + return 0; +} |