10986ab12SMaksim Yevmenkin /* 20986ab12SMaksim Yevmenkin * session.c 30986ab12SMaksim Yevmenkin * 40986ab12SMaksim Yevmenkin * Copyright (c) 2001-2003 Maksim Yevmenkin <m_evmenkin@yahoo.com> 50986ab12SMaksim Yevmenkin * All rights reserved. 60986ab12SMaksim Yevmenkin * 70986ab12SMaksim Yevmenkin * Redistribution and use in source and binary forms, with or without 80986ab12SMaksim Yevmenkin * modification, are permitted provided that the following conditions 90986ab12SMaksim Yevmenkin * are met: 100986ab12SMaksim Yevmenkin * 1. Redistributions of source code must retain the above copyright 110986ab12SMaksim Yevmenkin * notice, this list of conditions and the following disclaimer. 120986ab12SMaksim Yevmenkin * 2. Redistributions in binary form must reproduce the above copyright 130986ab12SMaksim Yevmenkin * notice, this list of conditions and the following disclaimer in the 140986ab12SMaksim Yevmenkin * documentation and/or other materials provided with the distribution. 150986ab12SMaksim Yevmenkin * 160986ab12SMaksim Yevmenkin * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 170986ab12SMaksim Yevmenkin * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 180986ab12SMaksim Yevmenkin * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 190986ab12SMaksim Yevmenkin * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 200986ab12SMaksim Yevmenkin * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 210986ab12SMaksim Yevmenkin * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 220986ab12SMaksim Yevmenkin * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 230986ab12SMaksim Yevmenkin * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 240986ab12SMaksim Yevmenkin * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 250986ab12SMaksim Yevmenkin * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 260986ab12SMaksim Yevmenkin * SUCH DAMAGE. 270986ab12SMaksim Yevmenkin * 280986ab12SMaksim Yevmenkin * $Id: session.c,v 1.2 2003/09/04 22:12:13 max Exp $ 290986ab12SMaksim Yevmenkin * $FreeBSD$ 300986ab12SMaksim Yevmenkin */ 310986ab12SMaksim Yevmenkin 320986ab12SMaksim Yevmenkin #include <bluetooth.h> 330986ab12SMaksim Yevmenkin #include <errno.h> 340986ab12SMaksim Yevmenkin #include <stdlib.h> 350986ab12SMaksim Yevmenkin #include <string.h> 360986ab12SMaksim Yevmenkin #include <unistd.h> 370986ab12SMaksim Yevmenkin 380986ab12SMaksim Yevmenkin #include <sdp-int.h> 390986ab12SMaksim Yevmenkin #include <sdp.h> 400986ab12SMaksim Yevmenkin 410986ab12SMaksim Yevmenkin void * 420986ab12SMaksim Yevmenkin sdp_open(bdaddr_t const *l, bdaddr_t const *r) 430986ab12SMaksim Yevmenkin { 440986ab12SMaksim Yevmenkin sdp_session_p ss = NULL; 450986ab12SMaksim Yevmenkin struct sockaddr_l2cap sa; 460986ab12SMaksim Yevmenkin socklen_t size; 470986ab12SMaksim Yevmenkin 480986ab12SMaksim Yevmenkin if ((ss = calloc(1, sizeof(*ss))) == NULL) 490986ab12SMaksim Yevmenkin goto fail; 500986ab12SMaksim Yevmenkin 510986ab12SMaksim Yevmenkin if (l == NULL || r == NULL) { 520986ab12SMaksim Yevmenkin ss->error = EINVAL; 530986ab12SMaksim Yevmenkin goto fail; 540986ab12SMaksim Yevmenkin } 550986ab12SMaksim Yevmenkin 560986ab12SMaksim Yevmenkin ss->s = socket(PF_BLUETOOTH, SOCK_SEQPACKET, BLUETOOTH_PROTO_L2CAP); 570986ab12SMaksim Yevmenkin if (ss->s < 0) { 580986ab12SMaksim Yevmenkin ss->error = errno; 590986ab12SMaksim Yevmenkin goto fail; 600986ab12SMaksim Yevmenkin } 610986ab12SMaksim Yevmenkin 620986ab12SMaksim Yevmenkin sa.l2cap_len = sizeof(sa); 630986ab12SMaksim Yevmenkin sa.l2cap_family = AF_BLUETOOTH; 640986ab12SMaksim Yevmenkin sa.l2cap_psm = 0; 650986ab12SMaksim Yevmenkin memcpy(&sa.l2cap_bdaddr, l, sizeof(sa.l2cap_bdaddr)); 660986ab12SMaksim Yevmenkin if (bind(ss->s, (struct sockaddr *) &sa, sizeof(sa)) < 0) { 670986ab12SMaksim Yevmenkin ss->error = errno; 680986ab12SMaksim Yevmenkin goto fail; 690986ab12SMaksim Yevmenkin } 700986ab12SMaksim Yevmenkin 710986ab12SMaksim Yevmenkin sa.l2cap_psm = htole16(NG_L2CAP_PSM_SDP); 720986ab12SMaksim Yevmenkin memcpy(&sa.l2cap_bdaddr, r, sizeof(sa.l2cap_bdaddr)); 730986ab12SMaksim Yevmenkin if (connect(ss->s, (struct sockaddr *) &sa, sizeof(sa)) < 0) { 740986ab12SMaksim Yevmenkin ss->error = errno; 750986ab12SMaksim Yevmenkin goto fail; 760986ab12SMaksim Yevmenkin } 770986ab12SMaksim Yevmenkin 780986ab12SMaksim Yevmenkin size = sizeof(ss->omtu); 790986ab12SMaksim Yevmenkin if (getsockopt(ss->s, SOL_L2CAP, SO_L2CAP_OMTU, &ss->omtu, &size) < 0) { 800986ab12SMaksim Yevmenkin ss->error = errno; 810986ab12SMaksim Yevmenkin goto fail; 820986ab12SMaksim Yevmenkin } 830986ab12SMaksim Yevmenkin if ((ss->req = malloc(ss->omtu)) == NULL) { 840986ab12SMaksim Yevmenkin ss->error = ENOMEM; 850986ab12SMaksim Yevmenkin goto fail; 860986ab12SMaksim Yevmenkin } 870986ab12SMaksim Yevmenkin ss->req_e = ss->req + ss->omtu; 880986ab12SMaksim Yevmenkin 890986ab12SMaksim Yevmenkin size = sizeof(ss->imtu); 900986ab12SMaksim Yevmenkin if (getsockopt(ss->s, SOL_L2CAP, SO_L2CAP_IMTU, &ss->imtu, &size) < 0) { 910986ab12SMaksim Yevmenkin ss->error = errno; 920986ab12SMaksim Yevmenkin goto fail; 930986ab12SMaksim Yevmenkin } 940986ab12SMaksim Yevmenkin if ((ss->rsp = malloc(ss->imtu)) == NULL) { 950986ab12SMaksim Yevmenkin ss->error = ENOMEM; 960986ab12SMaksim Yevmenkin goto fail; 970986ab12SMaksim Yevmenkin } 980986ab12SMaksim Yevmenkin ss->rsp_e = ss->rsp + ss->imtu; 990986ab12SMaksim Yevmenkin ss->error = 0; 1000986ab12SMaksim Yevmenkin fail: 1010986ab12SMaksim Yevmenkin return ((void *) ss); 1020986ab12SMaksim Yevmenkin } 1030986ab12SMaksim Yevmenkin 1040986ab12SMaksim Yevmenkin void * 105a4b187faSMaksim Yevmenkin sdp_open_local(char const *control) 1060986ab12SMaksim Yevmenkin { 1070986ab12SMaksim Yevmenkin sdp_session_p ss = NULL; 1080986ab12SMaksim Yevmenkin struct sockaddr_un sa; 1090986ab12SMaksim Yevmenkin 1100986ab12SMaksim Yevmenkin if ((ss = calloc(1, sizeof(*ss))) == NULL) 1110986ab12SMaksim Yevmenkin goto fail; 1120986ab12SMaksim Yevmenkin 1130986ab12SMaksim Yevmenkin ss->s = socket(PF_UNIX, SOCK_STREAM, 0); 1140986ab12SMaksim Yevmenkin if (ss->s < 0) { 1150986ab12SMaksim Yevmenkin ss->error = errno; 1160986ab12SMaksim Yevmenkin goto fail; 1170986ab12SMaksim Yevmenkin } 1180986ab12SMaksim Yevmenkin 119a4b187faSMaksim Yevmenkin if (control == NULL) 120a4b187faSMaksim Yevmenkin control = SDP_LOCAL_PATH; 121a4b187faSMaksim Yevmenkin 1220986ab12SMaksim Yevmenkin sa.sun_len = sizeof(sa); 1230986ab12SMaksim Yevmenkin sa.sun_family = AF_UNIX; 124a4b187faSMaksim Yevmenkin strlcpy(sa.sun_path, control, sizeof(sa.sun_path)); 1250986ab12SMaksim Yevmenkin 1260986ab12SMaksim Yevmenkin if (connect(ss->s, (struct sockaddr *) &sa, sizeof(sa)) < 0) { 1270986ab12SMaksim Yevmenkin ss->error = errno; 1280986ab12SMaksim Yevmenkin goto fail; 1290986ab12SMaksim Yevmenkin } 1300986ab12SMaksim Yevmenkin 1310986ab12SMaksim Yevmenkin ss->flags |= SDP_SESSION_LOCAL; 1326aae6f7eSMaksim Yevmenkin ss->imtu = ss->omtu = SDP_LOCAL_MTU; 1330986ab12SMaksim Yevmenkin 1340986ab12SMaksim Yevmenkin if ((ss->req = malloc(ss->omtu)) == NULL) { 1350986ab12SMaksim Yevmenkin ss->error = ENOMEM; 1360986ab12SMaksim Yevmenkin goto fail; 1370986ab12SMaksim Yevmenkin } 1380986ab12SMaksim Yevmenkin ss->req_e = ss->req + ss->omtu; 1390986ab12SMaksim Yevmenkin 1400986ab12SMaksim Yevmenkin if ((ss->rsp = malloc(ss->imtu)) == NULL) { 1410986ab12SMaksim Yevmenkin ss->error = ENOMEM; 1420986ab12SMaksim Yevmenkin goto fail; 1430986ab12SMaksim Yevmenkin } 1440986ab12SMaksim Yevmenkin ss->rsp_e = ss->rsp + ss->imtu; 1450986ab12SMaksim Yevmenkin ss->error = 0; 1460986ab12SMaksim Yevmenkin fail: 1470986ab12SMaksim Yevmenkin return ((void *) ss); 1480986ab12SMaksim Yevmenkin } 1490986ab12SMaksim Yevmenkin 1500986ab12SMaksim Yevmenkin int32_t 1510986ab12SMaksim Yevmenkin sdp_close(void *xss) 1520986ab12SMaksim Yevmenkin { 1530986ab12SMaksim Yevmenkin sdp_session_p ss = (sdp_session_p) xss; 1540986ab12SMaksim Yevmenkin 1550986ab12SMaksim Yevmenkin if (ss != NULL) { 1560986ab12SMaksim Yevmenkin if (ss->s >= 0) 1570986ab12SMaksim Yevmenkin close(ss->s); 1580986ab12SMaksim Yevmenkin 1590986ab12SMaksim Yevmenkin if (ss->req != NULL) 1600986ab12SMaksim Yevmenkin free(ss->req); 1610986ab12SMaksim Yevmenkin if (ss->rsp != NULL) 1620986ab12SMaksim Yevmenkin free(ss->rsp); 1630986ab12SMaksim Yevmenkin 1640986ab12SMaksim Yevmenkin memset(ss, 0, sizeof(*ss)); 1650986ab12SMaksim Yevmenkin free(ss); 1660986ab12SMaksim Yevmenkin } 1670986ab12SMaksim Yevmenkin 1680986ab12SMaksim Yevmenkin return (0); 1690986ab12SMaksim Yevmenkin } 1700986ab12SMaksim Yevmenkin 1710986ab12SMaksim Yevmenkin int32_t 1720986ab12SMaksim Yevmenkin sdp_error(void *xss) 1730986ab12SMaksim Yevmenkin { 1740986ab12SMaksim Yevmenkin sdp_session_p ss = (sdp_session_p) xss; 1750986ab12SMaksim Yevmenkin 1760986ab12SMaksim Yevmenkin return ((ss != NULL)? ss->error : EINVAL); 1770986ab12SMaksim Yevmenkin } 178