src/host/layer23/src/common/sap_interface.c

   1 /* BTSAP socket interface of layer2/3 stack */
   2
   3 /* (C) 2010 by Holger Hans Peter Freyther
   4  * (C) 2010 by Harald Welte <laforge@gnumonks.org>
   5  * (C) 2010 by Andreas Eversberg <jolly@eversberg.eu>
   6  *
   7  * All Rights Reserved
   8  *
   9  * This program is free software; you can redistribute it and/or modify
  10  * it under the terms of the GNU General Public License as published by
  11  * the Free Software Foundation; either version 2 of the License, or
  12  * (at your option) any later version.
  13  *
  14  * This program is distributed in the hope that it will be useful,
  15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17  * GNU General Public License for more details.
  18  *
  19  * You should have received a copy of the GNU General Public License along
  20  * with this program; if not, write to the Free Software Foundation, Inc.,
  21  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  22  *
  23  */
  24
  25 #include <osmocom/bb/common/osmocom_data.h>
  26 #include <osmocom/bb/common/logging.h>
  27
  28 #include <osmocore/util.h>
  29
  30 #include <sys/socket.h>
  31 #include <sys/un.h>
  32
  33 #include <arpa/inet.h>
  34
  35 #define _GNU_SOURCE
  36 #include <unistd.h>
  37 #include <errno.h>
  38 #include <string.h>
  39 #include <stdlib.h>
  40
  41 #define GSM_SAP_LENGTH 300
  42 #define GSM_SAP_HEADROOM 32
  43
  44 extern int quit;
  45
  46 static int sap_read(struct bsc_fd *fd)
  47 {
  48         struct msgb *msg;
  49         u_int16_t len;
  50         int rc;
  51         struct osmocom_ms *ms = (struct osmocom_ms *) fd->data;
  52
  53         msg = msgb_alloc_headroom(GSM_SAP_LENGTH+GSM_SAP_HEADROOM, GSM_SAP_HEADROOM, "Layer2");
  54         if (!msg) {
  55                 LOGP(DSAP, LOGL_ERROR, "Failed to allocate msg.\n");
  56                 return -ENOMEM;
  57         }
  58
  59         rc = read(fd->fd, &len, sizeof(len));
  60         if (rc < sizeof(len)) {
  61                 fprintf(stderr, "SAP socket failed\n");
  62                 if (rc >= 0)
  63                         rc = -EIO;
  64                 quit = rc;
  65                 return rc;
  66         }
  67
  68         len = ntohs(len);
  69         if (len > GSM_SAP_LENGTH) {
  70                 LOGP(DSAP, LOGL_ERROR, "Length is too big: %u\n", len);
  71                 msgb_free(msg);
  72                 return -EINVAL;
  73         }
  74
  75
  76         msg->l1h = msgb_put(msg, len);
  77         rc = read(fd->fd, msg->l1h, msgb_l1len(msg));
  78         if (rc != msgb_l1len(msg)) {
  79                 LOGP(DSAP, LOGL_ERROR, "Can not read data: len=%d rc=%d "
  80                      "errno=%d\n", len, rc, errno);
  81                 msgb_free(msg);
  82                 return rc;
  83         }
  84
  85         if (ms->sap_entity.msg_handler)
  86                 ms->sap_entity.msg_handler(msg, ms);
  87
  88         return 0;
  89 }
  90
  91 static int sap_write(struct bsc_fd *fd, struct msgb *msg)
  92 {
  93         int rc;
  94
  95         rc = write(fd->fd, msg->data, msg->len);
  96         if (rc != msg->len) {
  97                 LOGP(DSAP, LOGL_ERROR, "Failed to write data: rc: %d\n", rc);
  98                 return rc;
  99         }
 100
 101         return 0;
 102 }
 103
 104 int sap_open(struct osmocom_ms *ms, const char *socket_path)
 105 {
 106         int rc;
 107         struct sockaddr_un local;
 108
 109         ms->sap_wq.bfd.fd = socket(AF_UNIX, SOCK_STREAM, 0);
 110         if (ms->sap_wq.bfd.fd < 0) {
 111                 fprintf(stderr, "Failed to create unix domain socket.\n");
 112                 return ms->sap_wq.bfd.fd;
 113         }
 114
 115         local.sun_family = AF_UNIX;
 116         strncpy(local.sun_path, socket_path, sizeof(local.sun_path));
 117         local.sun_path[sizeof(local.sun_path) - 1] = '\0';
 118
 119         rc = connect(ms->sap_wq.bfd.fd, (struct sockaddr *) &local,
 120                      sizeof(local.sun_family) + strlen(local.sun_path));
 121         if (rc < 0) {
 122                 fprintf(stderr, "Failed to connect to '%s'.\n", local.sun_path);
 123                 close(ms->sap_wq.bfd.fd);
 124                 return rc;
 125         }
 126
 127         write_queue_init(&ms->sap_wq, 100);
 128         ms->sap_wq.bfd.data = ms;
 129         ms->sap_wq.bfd.when = BSC_FD_READ;
 130         ms->sap_wq.read_cb = sap_read;
 131         ms->sap_wq.write_cb = sap_write;
 132
 133         rc = bsc_register_fd(&ms->sap_wq.bfd);
 134         if (rc != 0) {
 135                 fprintf(stderr, "Failed to register fd.\n");
 136                 return rc;
 137         }
 138
 139         return 0;
 140 }
 141
 142 int sap_close(struct osmocom_ms *ms)
 143 {
 144         if (ms->sap_wq.bfd.fd <= 0)
 145                 return -EINVAL;
 146
 147         close(ms->sap_wq.bfd.fd);
 148         bsc_unregister_fd(&ms->sap_wq.bfd);
 149
 150         return 0;
 151 }
 152
 153 int osmosap_send(struct osmocom_ms *ms, struct msgb *msg)
 154 {
 155         uint16_t *len;
 156
 157         if (ms->sap_wq.bfd.fd <= 0)
 158                 return -EINVAL;
 159
 160         DEBUGP(DSAP, "Sending: '%s'\n", hexdump(msg->data, msg->len));
 161
 162         if (msg->l1h != msg->data)
 163                 LOGP(DSAP, LOGL_ERROR, "Message SAP header != Message Data\n");
 164
 165         /* prepend 16bit length before sending */
 166         len = (uint16_t *) msgb_push(msg, sizeof(*len));
 167         *len = htons(msg->len - sizeof(*len));
 168
 169         if (write_queue_enqueue(&ms->sap_wq, msg) != 0) {
 170                 LOGP(DSAP, LOGL_ERROR, "Failed to enqueue msg.\n");
 171                 msgb_free(msg);
 172                 return -1;
 173         }
 174
 175         return 0;
 176 }
 177
 178 /* register message handler for messages that are sent from L2->L3 */
 179 int osmosap_register_handler(struct osmocom_ms *ms, osmosap_cb_t cb)
 180 {
 181         ms->sap_entity.msg_handler = cb;
 182
 183         return 0;
 184 }
 185