2010-05-22 10:46:20 +00:00
|
|
|
/* Layer 1 socket interface of layer2/3 stack */
|
|
|
|
|
|
|
|
/* (C) 2010 by Holger Hans Peter Freyther
|
|
|
|
* (C) 2010 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 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.
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
|
2010-07-27 18:44:46 +00:00
|
|
|
#include <osmocom/bb/common/osmocom_data.h>
|
|
|
|
#include <osmocom/bb/common/l1ctl.h>
|
|
|
|
#include <osmocom/bb/common/logging.h>
|
2010-05-22 10:46:20 +00:00
|
|
|
|
|
|
|
#include <sys/socket.h>
|
|
|
|
#include <sys/un.h>
|
|
|
|
|
|
|
|
#include <arpa/inet.h>
|
|
|
|
|
|
|
|
#define _GNU_SOURCE
|
|
|
|
#include <unistd.h>
|
|
|
|
#include <errno.h>
|
|
|
|
#include <string.h>
|
2010-05-24 00:21:24 +00:00
|
|
|
#include <stdlib.h>
|
2010-05-22 10:46:20 +00:00
|
|
|
|
|
|
|
#define GSM_L2_LENGTH 256
|
2010-07-25 08:16:46 +00:00
|
|
|
#define GSM_L2_HEADROOM 32
|
2010-05-22 10:46:20 +00:00
|
|
|
|
2010-05-24 00:21:24 +00:00
|
|
|
extern int quit;
|
|
|
|
|
2010-05-22 10:46:20 +00:00
|
|
|
static int layer2_read(struct bsc_fd *fd)
|
|
|
|
{
|
|
|
|
struct msgb *msg;
|
|
|
|
u_int16_t len;
|
|
|
|
int rc;
|
|
|
|
|
2010-07-25 08:16:46 +00:00
|
|
|
msg = msgb_alloc_headroom(GSM_L2_LENGTH+GSM_L2_HEADROOM, GSM_L2_HEADROOM, "Layer2");
|
2010-05-22 10:46:20 +00:00
|
|
|
if (!msg) {
|
|
|
|
LOGP(DL1C, LOGL_ERROR, "Failed to allocate msg.\n");
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
rc = read(fd->fd, &len, sizeof(len));
|
|
|
|
if (rc < sizeof(len)) {
|
2010-05-24 00:21:24 +00:00
|
|
|
fprintf(stderr, "Layer2 socket failed\n");
|
2010-05-24 14:46:11 +00:00
|
|
|
if (rc >= 0)
|
|
|
|
rc = -EIO;
|
2010-05-24 00:21:24 +00:00
|
|
|
quit = rc;
|
2010-05-22 10:46:20 +00:00
|
|
|
return rc;
|
|
|
|
}
|
|
|
|
|
|
|
|
len = ntohs(len);
|
|
|
|
if (len > GSM_L2_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;
|
|
|
|
}
|
|
|
|
|
|
|
|
l1ctl_recv((struct osmocom_ms *) fd->data, msg);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int layer2_write(struct bsc_fd *fd, struct msgb *msg)
|
|
|
|
{
|
|
|
|
int rc;
|
|
|
|
|
|
|
|
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 layer2_open(struct osmocom_ms *ms, const char *socket_path)
|
|
|
|
{
|
|
|
|
int rc;
|
|
|
|
struct sockaddr_un local;
|
|
|
|
|
|
|
|
ms->wq.bfd.fd = socket(AF_UNIX, SOCK_STREAM, 0);
|
|
|
|
if (ms->wq.bfd.fd < 0) {
|
|
|
|
fprintf(stderr, "Failed to create unix domain socket.\n");
|
|
|
|
return ms->wq.bfd.fd;
|
|
|
|
}
|
|
|
|
|
|
|
|
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->wq.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);
|
|
|
|
close(ms->wq.bfd.fd);
|
|
|
|
return rc;
|
|
|
|
}
|
|
|
|
|
|
|
|
write_queue_init(&ms->wq, 100);
|
|
|
|
ms->wq.bfd.data = ms;
|
|
|
|
ms->wq.bfd.when = BSC_FD_READ;
|
|
|
|
ms->wq.read_cb = layer2_read;
|
|
|
|
ms->wq.write_cb = layer2_write;
|
|
|
|
|
|
|
|
rc = bsc_register_fd(&ms->wq.bfd);
|
|
|
|
if (rc != 0) {
|
|
|
|
fprintf(stderr, "Failed to register fd.\n");
|
|
|
|
return rc;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
int layer2_close(struct osmocom_ms *ms)
|
|
|
|
{
|
|
|
|
close(ms->wq.bfd.fd);
|
|
|
|
bsc_unregister_fd(&ms->wq.bfd);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
int osmo_send_l1(struct osmocom_ms *ms, struct msgb *msg)
|
|
|
|
{
|
|
|
|
uint16_t *len;
|
|
|
|
|
|
|
|
DEBUGP(DL1C, "Sending: '%s'\n", hexdump(msg->data, msg->len));
|
|
|
|
|
|
|
|
if (msg->l1h != msg->data)
|
|
|
|
LOGP(DL1C, LOGL_ERROR, "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 (write_queue_enqueue(&ms->wq, msg) != 0) {
|
|
|
|
LOGP(DL1C, LOGL_ERROR, "Failed to enqueue msg.\n");
|
|
|
|
msgb_free(msg);
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
|