lib/libsdp/session.c

   1 /*
   2  * session.c
   3  *
   4  * Copyright (c) 2001-2003 Maksim Yevmenkin <m_evmenkin@yahoo.com>
   5  * All rights reserved.
   6  *
   7  * Redistribution and use in source and binary forms, with or without
   8  * modification, are permitted provided that the following conditions
   9  * are met:
  10  * 1. Redistributions of source code must retain the above copyright
  11  *    notice, this list of conditions and the following disclaimer.
  12  * 2. Redistributions in binary form must reproduce the above copyright
  13  *    notice, this list of conditions and the following disclaimer in the
  14  *    documentation and/or other materials provided with the distribution.
  15  *
  16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  17  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  18  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  19  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  20  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  21  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  22  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  23  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  24  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  25  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  26  * SUCH DAMAGE.
  27  *
  28  * $Id: session.c,v 1.2 2003/09/04 22:12:13 max Exp $
  29  * $FreeBSD$
  30  */
  31
  32 #include <bluetooth.h>
  33 #include <errno.h>
  34 #include <stdlib.h>
  35 #include <string.h>
  36 #include <unistd.h>
  37
  38 #include <sdp-int.h>
  39 #include <sdp.h>
  40
  41 void *
  42 sdp_open(bdaddr_t const *l, bdaddr_t const *r)
  43 {
  44         sdp_session_p           ss = NULL;
  45         struct sockaddr_l2cap   sa;
  46         socklen_t               size;
  47
  48         if ((ss = calloc(1, sizeof(*ss))) == NULL)
  49                 goto fail;
  50
  51         if (l == NULL || r == NULL) {
  52                 ss->error = EINVAL;
  53                 goto fail;
  54         }
  55
  56         ss->s = socket(PF_BLUETOOTH, SOCK_SEQPACKET, BLUETOOTH_PROTO_L2CAP);
  57         if (ss->s < 0) {
  58                 ss->error = errno;
  59                 goto fail;
  60         }
  61
  62         sa.l2cap_len = sizeof(sa);
  63         sa.l2cap_family = AF_BLUETOOTH;
  64         sa.l2cap_psm = 0;
  65         memcpy(&sa.l2cap_bdaddr, l, sizeof(sa.l2cap_bdaddr));
  66         if (bind(ss->s, (struct sockaddr *) &sa, sizeof(sa)) < 0) {
  67                 ss->error = errno;
  68                 goto fail;
  69         }
  70
  71         sa.l2cap_psm = htole16(NG_L2CAP_PSM_SDP);
  72         memcpy(&sa.l2cap_bdaddr, r, sizeof(sa.l2cap_bdaddr));
  73         if (connect(ss->s, (struct sockaddr *) &sa, sizeof(sa)) < 0) {
  74                 ss->error = errno;
  75                 goto fail;
  76         }
  77
  78         size = sizeof(ss->omtu);
  79         if (getsockopt(ss->s, SOL_L2CAP, SO_L2CAP_OMTU, &ss->omtu, &size) < 0) {
  80                 ss->error = errno;
  81                 goto fail;
  82         }
  83         if ((ss->req = malloc(ss->omtu)) == NULL) {
  84                 ss->error = ENOMEM;
  85                 goto fail;
  86         }
  87         ss->req_e = ss->req + ss->omtu;
  88
  89         size = sizeof(ss->imtu);
  90         if (getsockopt(ss->s, SOL_L2CAP, SO_L2CAP_IMTU, &ss->imtu, &size) < 0) {
  91                 ss->error = errno;
  92                 goto fail;
  93         }
  94         if ((ss->rsp = malloc(ss->imtu)) == NULL) {
  95                 ss->error = ENOMEM;
  96                 goto fail;
  97         }
  98         ss->rsp_e = ss->rsp + ss->imtu;
  99         ss->error = 0;
 100 fail:
 101         return ((void *) ss);
 102 }
 103
 104 void *
 105 sdp_open_local(char const *control)
 106 {
 107         sdp_session_p           ss = NULL;
 108         struct sockaddr_un      sa;
 109
 110         if ((ss = calloc(1, sizeof(*ss))) == NULL)
 111                 goto fail;
 112
 113         ss->s = socket(PF_UNIX, SOCK_STREAM, 0);
 114         if (ss->s < 0) {
 115                 ss->error = errno;
 116                 goto fail;
 117         }
 118
 119         if (control == NULL)
 120                 control = SDP_LOCAL_PATH;
 121
 122         sa.sun_len = sizeof(sa);
 123         sa.sun_family = AF_UNIX;
 124         strlcpy(sa.sun_path, control, sizeof(sa.sun_path));
 125
 126         if (connect(ss->s, (struct sockaddr *) &sa, sizeof(sa)) < 0) {
 127                 ss->error = errno;
 128                 goto fail;
 129         }
 130
 131         ss->flags |= SDP_SESSION_LOCAL;
 132         ss->imtu = ss->omtu = SDP_LOCAL_MTU;
 133
 134         if ((ss->req = malloc(ss->omtu)) == NULL) {
 135                 ss->error = ENOMEM;
 136                 goto fail;
 137         }
 138         ss->req_e = ss->req + ss->omtu;
 139
 140         if ((ss->rsp = malloc(ss->imtu)) == NULL) {
 141                 ss->error = ENOMEM;
 142                 goto fail;
 143         }
 144         ss->rsp_e = ss->rsp + ss->imtu;
 145         ss->error = 0;
 146 fail:
 147         return ((void *) ss);
 148 }
 149
 150 int32_t
 151 sdp_close(void *xss)
 152 {
 153         sdp_session_p   ss = (sdp_session_p) xss;
 154
 155         if (ss != NULL) {
 156                 if (ss->s >= 0)
 157                         close(ss->s);
 158
 159                 if (ss->req != NULL)
 160                         free(ss->req);
 161                 if (ss->rsp != NULL)
 162                         free(ss->rsp);
 163
 164                 memset(ss, 0, sizeof(*ss));
 165                 free(ss);
 166         }
 167
 168         return (0);
 169 }
 170
 171 int32_t
 172 sdp_error(void *xss)
 173 {
 174         sdp_session_p   ss = (sdp_session_p) xss;
 175
 176         return ((ss != NULL)? ss->error : EINVAL);
 177 }